pulse_sequencer.cpp 2.4 KB

1234567891011121314151617181920212223242526272829303132333435363738394041424344454647484950515253545556575859606162636465666768697071727374757677787980818283848586
  1. #include "pulse_sequencer.h"
  2. #include <furi.h>
  3. #include <callback-connector.h>
  4. #include <furi_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. period_index = 1;
  17. init_timer(periods[period_index]);
  18. pin_state = pin_start_state;
  19. hal_gpio_write(&ibutton_gpio, pin_state);
  20. pin_state = !pin_state;
  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_EnableIRQ(TIM1_UP_TIM16_IRQn);
  48. hal_gpio_init(&ibutton_gpio, GpioModeOutputOpenDrain, GpioPullNo, GpioSpeedVeryHigh);
  49. }
  50. void PulseSequencer::deinit_timer() {
  51. }
  52. void PulseSequencer::timer_elapsed_callback(void* hw, void* context) {
  53. PulseSequencer* _this = static_cast<PulseSequencer*>(context);
  54. TIM_HandleTypeDef* htim = static_cast<TIM_HandleTypeDef*>(hw);
  55. if(htim->Instance == TIM1) {
  56. htim->Instance->ARR = _this->periods[_this->period_index];
  57. if(_this->period_index == 0) {
  58. _this->pin_state = _this->pin_start_state;
  59. } else {
  60. _this->pin_state = !_this->pin_state;
  61. }
  62. hal_gpio_write(&ibutton_gpio, _this->pin_state);
  63. _this->period_index++;
  64. if(_this->period_index == _this->periods_count) {
  65. _this->period_index = 0;
  66. }
  67. }
  68. }