signal_gen_pwm.c 9.9 KB

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