signal_gen_pwm.c 9.9 KB

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