signal_gen_pwm.c 9.8 KB

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