muse.c 3.8 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131
  1. /*
  2. YOUR LICENSE
  3. */
  4. #include <string.h>
  5. #include <esp_log.h>
  6. #include <esp_types.h>
  7. #include <esp_system.h>
  8. #include <freertos/FreeRTOS.h>
  9. #include <freertos/task.h>
  10. #include "driver/rmt.h"
  11. #include "monitor.h"
  12. #include "targets.h"
  13. /////////////////////////////////////////////////////////////////
  14. //*********************** NeoPixels ***************************
  15. ////////////////////////////////////////////////////////////////
  16. #define NUM_LEDS 1
  17. #define LED_RMT_TX_CHANNEL 0
  18. #define LED_RMT_TX_GPIO 22
  19. #define BITS_PER_LED_CMD 24
  20. #define LED_BUFFER_ITEMS ((NUM_LEDS * BITS_PER_LED_CMD))
  21. // These values are determined by measuring pulse timing with logic analyzer and adjusting to match datasheet.
  22. #define T0H 14 // 0 bit high time
  23. #define T1H 52 // 1 bit high time
  24. #define TL 52 // low time for either bit
  25. // sets a color based on RGB from 0..255 and a brightness in % from 0..100
  26. #define RGB(R,G,B,BR) (((G*BR)/100) << 16) | (((R*BR)/100) << 8) | ((B*BR)/100)
  27. #define RED RGB(255,0,0,10)
  28. #define GREEN RGB(0,255,0,10)
  29. #define BLUE RGB(0,0,255,10)
  30. #define WHITE RGB(255,255,255,10)
  31. #define YELLOW RGB(255,118,13,10)
  32. struct led_state {
  33. uint32_t leds[NUM_LEDS];
  34. };
  35. void ws2812_control_init(void);
  36. void ws2812_write_leds(struct led_state new_state);
  37. ///////////////////////////////////////////////////////////////////
  38. static const char TAG[] = "muse";
  39. static void (*battery_handler_chain)(float value);
  40. static void battery_svc(float value);
  41. static bool init(void);
  42. static void set_battery_led(float value);
  43. const struct target_s target_muse = { .model = "muse", .init = init };
  44. static bool init(void) {
  45. battery_handler_chain = battery_handler_svc;
  46. battery_handler_svc = battery_svc;
  47. ws2812_control_init();
  48. float value = battery_value_svc();
  49. set_battery_led(value);
  50. ESP_LOGI(TAG, "Initializing for Muse %f", value);
  51. return true;
  52. }
  53. #define VGREEN 4.0
  54. #define VRED 3.6
  55. static void set_battery_led(float value) {
  56. struct led_state new_state;
  57. if (value > VGREEN) new_state.leds[0] = GREEN;
  58. else if (value < VRED) new_state.leds[0] = RED;
  59. else new_state.leds[0] = YELLOW;
  60. ws2812_write_leds(new_state);
  61. }
  62. static void battery_svc(float value) {
  63. set_battery_led(value);
  64. ESP_LOGI(TAG, "Called for battery service with %f", value);
  65. if (battery_handler_chain) battery_handler_chain(value);
  66. }
  67. // This is the buffer which the hw peripheral will access while pulsing the output pin
  68. rmt_item32_t led_data_buffer[LED_BUFFER_ITEMS];
  69. void setup_rmt_data_buffer(struct led_state new_state);
  70. void ws2812_control_init(void)
  71. {
  72. rmt_config_t config;
  73. config.rmt_mode = RMT_MODE_TX;
  74. config.channel = LED_RMT_TX_CHANNEL;
  75. config.gpio_num = LED_RMT_TX_GPIO;
  76. config.mem_block_num = 3;
  77. config.tx_config.loop_en = false;
  78. config.tx_config.carrier_en = false;
  79. config.tx_config.idle_output_en = true;
  80. config.tx_config.idle_level = 0;
  81. config.clk_div = 2;
  82. ESP_ERROR_CHECK(rmt_config(&config));
  83. ESP_ERROR_CHECK(rmt_driver_install(config.channel, 0, 0));
  84. }
  85. void ws2812_write_leds(struct led_state new_state) {
  86. setup_rmt_data_buffer(new_state);
  87. ESP_ERROR_CHECK(rmt_write_items(LED_RMT_TX_CHANNEL, led_data_buffer, LED_BUFFER_ITEMS, false));
  88. ESP_ERROR_CHECK(rmt_wait_tx_done(LED_RMT_TX_CHANNEL, portMAX_DELAY));
  89. }
  90. void setup_rmt_data_buffer(struct led_state new_state)
  91. {
  92. for (uint32_t led = 0; led < NUM_LEDS; led++) {
  93. uint32_t bits_to_send = new_state.leds[led];
  94. uint32_t mask = 1 << (BITS_PER_LED_CMD - 1);
  95. for (uint32_t bit = 0; bit < BITS_PER_LED_CMD; bit++) {
  96. uint32_t bit_is_set = bits_to_send & mask;
  97. led_data_buffer[led * BITS_PER_LED_CMD + bit] = bit_is_set ?
  98. (rmt_item32_t){{{T1H, 1, TL, 0}}} :
  99. (rmt_item32_t){{{T0H, 1, TL, 0}}};
  100. mask >>= 1;
  101. }
  102. }
  103. }