pulse-sequencer.cpp 2.4 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687
  1. #include "pulse-sequencer.h"
  2. #include <furi.h>
  3. #include <callback-connector.h>
  4. #include <api-hal-resources.h>
  5. void PulseSequencer::set_periods(
  6. uint32_t* _periods,
  7. uint16_t _periods_count,
  8. bool _pin_start_state) {
  9. periods = _periods;
  10. periods_count = _periods_count;
  11. pin_start_state = _pin_start_state;
  12. }
  13. void PulseSequencer::start() {
  14. callback_pointer = cbc::obtain_connector(this, &PulseSequencer::timer_elapsed_callback);
  15. api_interrupt_add(callback_pointer, InterruptTypeTimerUpdate, this);
  16. init_timer(periods[period_index]);
  17. pin_state = pin_start_state;
  18. hal_gpio_write(&ibutton_gpio, pin_state);
  19. pin_state = !pin_state;
  20. period_index = 1;
  21. HAL_TIM_Base_Start_IT(&htim1);
  22. }
  23. void PulseSequencer::stop() {
  24. HAL_TIM_Base_Stop_IT(&htim1);
  25. api_interrupt_remove(callback_pointer, InterruptTypeTimerUpdate);
  26. deinit_timer();
  27. }
  28. PulseSequencer::~PulseSequencer() {
  29. stop();
  30. }
  31. void PulseSequencer::init_timer(uint32_t period) {
  32. TIM_ClockConfigTypeDef sClockSourceConfig = {0};
  33. htim1.Instance = TIM1;
  34. htim1.Init.Prescaler = 0;
  35. htim1.Init.CounterMode = TIM_COUNTERMODE_UP;
  36. htim1.Init.Period = period;
  37. htim1.Init.ClockDivision = TIM_CLOCKDIVISION_DIV1;
  38. htim1.Init.RepetitionCounter = 0;
  39. htim1.Init.AutoReloadPreload = TIM_AUTORELOAD_PRELOAD_DISABLE;
  40. if(HAL_TIM_Base_Init(&htim1) != HAL_OK) {
  41. Error_Handler();
  42. }
  43. sClockSourceConfig.ClockSource = TIM_CLOCKSOURCE_INTERNAL;
  44. if(HAL_TIM_ConfigClockSource(&htim1, &sClockSourceConfig) != HAL_OK) {
  45. Error_Handler();
  46. }
  47. HAL_NVIC_SetPriority(TIM1_UP_TIM16_IRQn, 5, 0);
  48. HAL_NVIC_EnableIRQ(TIM1_UP_TIM16_IRQn);
  49. hal_gpio_init(&ibutton_gpio, GpioModeOutputOpenDrain, GpioPullNo, GpioSpeedLow);
  50. }
  51. void PulseSequencer::deinit_timer() {
  52. }
  53. void PulseSequencer::timer_elapsed_callback(void* hw, void* context) {
  54. PulseSequencer* _this = static_cast<PulseSequencer*>(context);
  55. TIM_HandleTypeDef* htim = static_cast<TIM_HandleTypeDef*>(hw);
  56. if(htim->Instance == TIM1) {
  57. htim->Instance->ARR = _this->periods[_this->period_index];
  58. if(_this->period_index == 0) {
  59. _this->pin_state = _this->pin_start_state;
  60. } else {
  61. _this->pin_state = !_this->pin_state;
  62. }
  63. hal_gpio_write(&ibutton_gpio, _this->pin_state);
  64. _this->period_index++;
  65. if(_this->period_index == _this->periods_count) {
  66. _this->period_index = 0;
  67. }
  68. }
  69. }