signal_gen_pwm.c 9.8 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309
  1. #include "../signal_gen_app_i.h"
  2. #include "furi_hal.h"
  3. #include <gui/elements.h>
  4. typedef enum {
  5. LineIndexChannel,
  6. LineIndexFrequency,
  7. LineIndexDuty,
  8. LineIndexTotalCount
  9. } LineIndex;
  10. static const char* const pwm_ch_names[] = {"2(A7)", "4(A4)"};
  11. struct SignalGenPwm {
  12. View* view;
  13. SignalGenPwmViewCallback callback;
  14. void* context;
  15. };
  16. typedef struct {
  17. LineIndex line_sel;
  18. bool edit_mode;
  19. uint8_t edit_digit;
  20. uint8_t channel_id;
  21. uint32_t freq;
  22. uint8_t duty;
  23. } SignalGenPwmViewModel;
  24. #define ITEM_H 64 / 3
  25. #define ITEM_W 128
  26. #define VALUE_X 100
  27. #define VALUE_W 45
  28. #define FREQ_VALUE_X 62
  29. #define FREQ_MAX 1000000UL
  30. #define FREQ_DIGITS_NB 7
  31. static void pwm_set_config(SignalGenPwm* pwm) {
  32. FuriHalPwmOutputId channel;
  33. uint32_t freq;
  34. uint8_t duty;
  35. with_view_model(
  36. pwm->view,
  37. SignalGenPwmViewModel * model,
  38. {
  39. channel = model->channel_id;
  40. freq = model->freq;
  41. duty = model->duty;
  42. },
  43. false);
  44. furi_assert(pwm->callback);
  45. pwm->callback(channel, freq, duty, pwm->context);
  46. }
  47. static void pwm_channel_change(SignalGenPwmViewModel* model, InputEvent* event) {
  48. if(event->key == InputKeyLeft) {
  49. if(model->channel_id > 0) {
  50. model->channel_id--;
  51. }
  52. } else if(event->key == InputKeyRight) {
  53. if(model->channel_id < (COUNT_OF(pwm_ch_names) - 1)) {
  54. model->channel_id++;
  55. }
  56. }
  57. }
  58. static void pwm_duty_change(SignalGenPwmViewModel* model, InputEvent* event) {
  59. if(event->key == InputKeyLeft) {
  60. if(model->duty > 0) {
  61. model->duty--;
  62. }
  63. } else if(event->key == InputKeyRight) {
  64. if(model->duty < 100) {
  65. model->duty++;
  66. }
  67. }
  68. }
  69. static bool pwm_freq_edit(SignalGenPwmViewModel* model, InputEvent* event) {
  70. bool consumed = false;
  71. if((event->type == InputTypeShort) || (event->type == InputTypeRepeat)) {
  72. if(event->key == InputKeyRight) {
  73. if(model->edit_digit > 0) {
  74. model->edit_digit--;
  75. }
  76. consumed = true;
  77. } else if(event->key == InputKeyLeft) {
  78. if(model->edit_digit < (FREQ_DIGITS_NB - 1)) {
  79. model->edit_digit++;
  80. }
  81. consumed = true;
  82. } else if(event->key == InputKeyUp) {
  83. uint32_t step = 1;
  84. for(uint8_t i = 0; i < model->edit_digit; i++) {
  85. step *= 10;
  86. }
  87. if((model->freq + step) < FREQ_MAX) {
  88. model->freq += step;
  89. } else {
  90. model->freq = FREQ_MAX;
  91. }
  92. consumed = true;
  93. } else if(event->key == InputKeyDown) {
  94. uint32_t step = 1;
  95. for(uint8_t i = 0; i < model->edit_digit; i++) {
  96. step *= 10;
  97. }
  98. if(model->freq > (step + 1)) {
  99. model->freq -= step;
  100. } else {
  101. model->freq = 1;
  102. }
  103. consumed = true;
  104. }
  105. }
  106. return consumed;
  107. }
  108. static void signal_gen_pwm_draw_callback(Canvas* canvas, void* _model) {
  109. SignalGenPwmViewModel* model = _model;
  110. char* line_label = NULL;
  111. char val_text[16];
  112. for(uint8_t line = 0; line < LineIndexTotalCount; line++) {
  113. if(line == LineIndexChannel) {
  114. line_label = "GPIO Pin";
  115. } else if(line == LineIndexFrequency) {
  116. line_label = "Frequency";
  117. } else if(line == LineIndexDuty) {
  118. line_label = "Pulse width";
  119. }
  120. canvas_set_color(canvas, ColorBlack);
  121. if(line == model->line_sel) {
  122. elements_slightly_rounded_box(canvas, 0, ITEM_H * line + 1, ITEM_W, ITEM_H - 1);
  123. canvas_set_color(canvas, ColorWhite);
  124. }
  125. uint8_t text_y = ITEM_H * line + ITEM_H / 2 + 2;
  126. canvas_draw_str_aligned(canvas, 6, text_y, AlignLeft, AlignCenter, line_label);
  127. if(line == LineIndexChannel) {
  128. snprintf(val_text, sizeof(val_text), "%s", pwm_ch_names[model->channel_id]);
  129. canvas_draw_str_aligned(canvas, VALUE_X, text_y, AlignCenter, AlignCenter, val_text);
  130. if(model->channel_id != 0) {
  131. canvas_draw_str_aligned(
  132. canvas, VALUE_X - VALUE_W / 2, text_y, AlignCenter, AlignCenter, "<");
  133. }
  134. if(model->channel_id != (COUNT_OF(pwm_ch_names) - 1)) {
  135. canvas_draw_str_aligned(
  136. canvas, VALUE_X + VALUE_W / 2, text_y, AlignCenter, AlignCenter, ">");
  137. }
  138. } else if(line == LineIndexFrequency) {
  139. snprintf(val_text, sizeof(val_text), "%7lu Hz", model->freq);
  140. canvas_set_font(canvas, FontKeyboard);
  141. canvas_draw_str_aligned(
  142. canvas, FREQ_VALUE_X, text_y, AlignLeft, AlignCenter, val_text);
  143. canvas_set_font(canvas, FontSecondary);
  144. if(model->edit_mode) {
  145. uint8_t icon_x = (FREQ_VALUE_X) + (FREQ_DIGITS_NB - model->edit_digit - 1) * 6;
  146. canvas_draw_icon(canvas, icon_x, text_y - 9, &I_SmallArrowUp_3x5);
  147. canvas_draw_icon(canvas, icon_x, text_y + 5, &I_SmallArrowDown_3x5);
  148. }
  149. } else if(line == LineIndexDuty) {
  150. snprintf(val_text, sizeof(val_text), "%d%%", model->duty);
  151. canvas_draw_str_aligned(canvas, VALUE_X, text_y, AlignCenter, AlignCenter, val_text);
  152. if(model->duty != 0) {
  153. canvas_draw_str_aligned(
  154. canvas, VALUE_X - VALUE_W / 2, text_y, AlignCenter, AlignCenter, "<");
  155. }
  156. if(model->duty != 100) {
  157. canvas_draw_str_aligned(
  158. canvas, VALUE_X + VALUE_W / 2, text_y, AlignCenter, AlignCenter, ">");
  159. }
  160. }
  161. }
  162. }
  163. static bool signal_gen_pwm_input_callback(InputEvent* event, void* context) {
  164. furi_assert(context);
  165. SignalGenPwm* pwm = context;
  166. bool consumed = false;
  167. bool need_update = false;
  168. with_view_model(
  169. pwm->view,
  170. SignalGenPwmViewModel * model,
  171. {
  172. if(model->edit_mode == false) {
  173. if((event->type == InputTypeShort) || (event->type == InputTypeRepeat)) {
  174. if(event->key == InputKeyUp) {
  175. if(model->line_sel == 0) {
  176. model->line_sel = LineIndexTotalCount - 1;
  177. } else {
  178. model->line_sel =
  179. CLAMP(model->line_sel - 1, LineIndexTotalCount - 1, 0);
  180. }
  181. consumed = true;
  182. } else if(event->key == InputKeyDown) {
  183. if(model->line_sel == LineIndexTotalCount - 1) {
  184. model->line_sel = 0;
  185. } else {
  186. model->line_sel =
  187. CLAMP(model->line_sel + 1, LineIndexTotalCount - 1, 0);
  188. }
  189. consumed = true;
  190. } else if((event->key == InputKeyLeft) || (event->key == InputKeyRight)) {
  191. if(model->line_sel == LineIndexChannel) {
  192. pwm_channel_change(model, event);
  193. need_update = true;
  194. } else if(model->line_sel == LineIndexDuty) {
  195. pwm_duty_change(model, event);
  196. need_update = true;
  197. } else if(model->line_sel == LineIndexFrequency) {
  198. model->edit_mode = true;
  199. }
  200. consumed = true;
  201. } else if(event->key == InputKeyOk) {
  202. if(model->line_sel == LineIndexFrequency) {
  203. model->edit_mode = true;
  204. }
  205. consumed = true;
  206. }
  207. }
  208. } else {
  209. if((event->key == InputKeyOk) || (event->key == InputKeyBack)) {
  210. if(event->type == InputTypeShort) {
  211. model->edit_mode = false;
  212. consumed = true;
  213. }
  214. } else {
  215. if(model->line_sel == LineIndexFrequency) {
  216. consumed = pwm_freq_edit(model, event);
  217. need_update = consumed;
  218. }
  219. }
  220. }
  221. },
  222. true);
  223. if(need_update) {
  224. pwm_set_config(pwm);
  225. }
  226. return consumed;
  227. }
  228. SignalGenPwm* signal_gen_pwm_alloc() {
  229. SignalGenPwm* pwm = malloc(sizeof(SignalGenPwm));
  230. pwm->view = view_alloc();
  231. view_allocate_model(pwm->view, ViewModelTypeLocking, sizeof(SignalGenPwmViewModel));
  232. view_set_context(pwm->view, pwm);
  233. view_set_draw_callback(pwm->view, signal_gen_pwm_draw_callback);
  234. view_set_input_callback(pwm->view, signal_gen_pwm_input_callback);
  235. return pwm;
  236. }
  237. void signal_gen_pwm_free(SignalGenPwm* pwm) {
  238. furi_assert(pwm);
  239. view_free(pwm->view);
  240. free(pwm);
  241. }
  242. View* signal_gen_pwm_get_view(SignalGenPwm* pwm) {
  243. furi_assert(pwm);
  244. return pwm->view;
  245. }
  246. void signal_gen_pwm_set_callback(
  247. SignalGenPwm* pwm,
  248. SignalGenPwmViewCallback callback,
  249. void* context) {
  250. furi_assert(pwm);
  251. furi_assert(callback);
  252. with_view_model(
  253. pwm->view,
  254. SignalGenPwmViewModel * model,
  255. {
  256. UNUSED(model);
  257. pwm->callback = callback;
  258. pwm->context = context;
  259. },
  260. false);
  261. }
  262. void signal_gen_pwm_set_params(SignalGenPwm* pwm, uint8_t channel_id, uint32_t freq, uint8_t duty) {
  263. with_view_model(
  264. pwm->view,
  265. SignalGenPwmViewModel * model,
  266. {
  267. model->channel_id = channel_id;
  268. model->freq = freq;
  269. model->duty = duty;
  270. },
  271. true);
  272. furi_assert(pwm->callback);
  273. pwm->callback(channel_id, freq, duty, pwm->context);
  274. }