You can not select more than 25 topics Topics must start with a letter or number, can include dashes ('-') and can be up to 35 characters long.

171 lines
5.3 KiB

  1. /* Copyright 2021 Jasper Chan
  2. * 2023 Huckies <https://github.com/Huckies>
  3. *
  4. * This program is free software: you can redistribute it and/or modify
  5. * it under the terms of the GNU General Public License as published by
  6. * the Free Software Foundation, either version 2 of the License, or
  7. * (at your option) any later version.
  8. *
  9. * This program is distributed in the hope that it will be useful,
  10. * but WITHOUT ANY WARRANTY; without even the implied warranty of
  11. * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
  12. * GNU General Public License for more details.
  13. *
  14. * You should have received a copy of the GNU General Public License
  15. * along with this program. If not, see <http://www.gnu.org/licenses/>.
  16. */
  17. #include "aw20216s.h"
  18. #include "wait.h"
  19. #include "spi_master.h"
  20. #define AW20216S_PWM_REGISTER_COUNT 216
  21. #ifndef AW20216S_CONFIGURATION
  22. # define AW20216S_CONFIGURATION (AW20216S_CONFIGURATION_SWSEL_1_12 | AW20216S_CONFIGURATION_CHIPEN)
  23. #endif
  24. #ifndef AW20216S_MIX_FUNCTION
  25. # define AW20216S_MIX_FUNCTION (AW20216S_MIX_FUNCTION_LPEN)
  26. #endif
  27. #ifndef AW20216S_SCALING_MAX
  28. # define AW20216S_SCALING_MAX 150
  29. #endif
  30. #ifndef AW20216S_GLOBAL_CURRENT_MAX
  31. # define AW20216S_GLOBAL_CURRENT_MAX 150
  32. #endif
  33. #ifndef AW20216S_SPI_MODE
  34. # define AW20216S_SPI_MODE 0
  35. #endif
  36. #ifndef AW20216S_SPI_DIVISOR
  37. # define AW20216S_SPI_DIVISOR 4
  38. #endif
  39. typedef struct aw20216s_driver_t {
  40. uint8_t pwm_buffer[AW20216S_PWM_REGISTER_COUNT];
  41. bool pwm_buffer_dirty;
  42. } PACKED aw20216s_driver_t;
  43. aw20216s_driver_t driver_buffers[AW20216S_DRIVER_COUNT] = {{
  44. .pwm_buffer = {0},
  45. .pwm_buffer_dirty = false,
  46. }};
  47. bool aw20216s_write(pin_t cs_pin, uint8_t page, uint8_t reg, uint8_t* data, uint8_t len) {
  48. static uint8_t s_spi_transfer_buffer[2] = {0};
  49. if (!spi_start(cs_pin, false, AW20216S_SPI_MODE, AW20216S_SPI_DIVISOR)) {
  50. spi_stop();
  51. return false;
  52. }
  53. s_spi_transfer_buffer[0] = (AW20216S_ID | page | AW20216S_WRITE);
  54. s_spi_transfer_buffer[1] = reg;
  55. if (spi_transmit(s_spi_transfer_buffer, 2) != SPI_STATUS_SUCCESS) {
  56. spi_stop();
  57. return false;
  58. }
  59. if (spi_transmit(data, len) != SPI_STATUS_SUCCESS) {
  60. spi_stop();
  61. return false;
  62. }
  63. spi_stop();
  64. return true;
  65. }
  66. static inline bool aw20216s_write_register(pin_t cs_pin, uint8_t page, uint8_t reg, uint8_t value) {
  67. // Little wrapper so callers need not care about sending a buffer
  68. return aw20216s_write(cs_pin, page, reg, &value, 1);
  69. }
  70. void aw20216s_soft_reset(pin_t cs_pin) {
  71. aw20216s_write_register(cs_pin, AW20216S_PAGE_FUNCTION, AW20216S_FUNCTION_REG_RESET, AW20216S_RESET_MAGIC);
  72. }
  73. static void aw20216s_init_scaling(pin_t cs_pin) {
  74. // Set constant current to the max, control brightness with PWM
  75. for (uint8_t i = 0; i < AW20216S_PWM_REGISTER_COUNT; i++) {
  76. aw20216s_write_register(cs_pin, AW20216S_PAGE_SCALING, i, AW20216S_SCALING_MAX);
  77. }
  78. }
  79. static inline void aw20216s_init_current_limit(pin_t cs_pin) {
  80. // Push config
  81. aw20216s_write_register(cs_pin, AW20216S_PAGE_FUNCTION, AW20216S_FUNCTION_REG_GLOBAL_CURRENT, AW20216S_GLOBAL_CURRENT_MAX);
  82. }
  83. static inline void aw20216s_soft_enable(pin_t cs_pin) {
  84. // Push config
  85. aw20216s_write_register(cs_pin, AW20216S_PAGE_FUNCTION, AW20216S_FUNCTION_REG_CONFIGURATION, AW20216S_CONFIGURATION);
  86. }
  87. static inline void aw20216s_auto_lowpower(pin_t cs_pin) {
  88. aw20216s_write_register(cs_pin, AW20216S_PAGE_FUNCTION, AW20216S_FUNCTION_REG_MIX_FUNCTION, AW20216S_MIX_FUNCTION);
  89. }
  90. void aw20216s_init_drivers(void) {
  91. spi_init();
  92. #if defined(AW20216S_EN_PIN)
  93. gpio_set_pin_output(AW20216S_EN_PIN);
  94. gpio_write_pin_high(AW20216S_EN_PIN);
  95. #endif
  96. aw20216s_init(AW20216S_CS_PIN_1);
  97. #if defined(AW20216S_CS_PIN_2)
  98. aw20216s_init(AW20216S_CS_PIN_2);
  99. #endif
  100. }
  101. void aw20216s_init(pin_t cs_pin) {
  102. aw20216s_soft_reset(cs_pin);
  103. wait_ms(2);
  104. // Drivers should start with all scaling and PWM registers as off
  105. aw20216s_init_current_limit(cs_pin);
  106. aw20216s_init_scaling(cs_pin);
  107. aw20216s_soft_enable(cs_pin);
  108. aw20216s_auto_lowpower(cs_pin);
  109. }
  110. void aw20216s_set_color(int index, uint8_t red, uint8_t green, uint8_t blue) {
  111. aw20216s_led_t led;
  112. memcpy_P(&led, (&g_aw20216s_leds[index]), sizeof(led));
  113. if (driver_buffers[led.driver].pwm_buffer[led.r] == red && driver_buffers[led.driver].pwm_buffer[led.g] == green && driver_buffers[led.driver].pwm_buffer[led.b] == blue) {
  114. return;
  115. }
  116. driver_buffers[led.driver].pwm_buffer[led.r] = red;
  117. driver_buffers[led.driver].pwm_buffer[led.g] = green;
  118. driver_buffers[led.driver].pwm_buffer[led.b] = blue;
  119. driver_buffers[led.driver].pwm_buffer_dirty = true;
  120. }
  121. void aw20216s_set_color_all(uint8_t red, uint8_t green, uint8_t blue) {
  122. for (uint8_t i = 0; i < AW20216S_LED_COUNT; i++) {
  123. aw20216s_set_color(i, red, green, blue);
  124. }
  125. }
  126. void aw20216s_update_pwm_buffers(pin_t cs_pin, uint8_t index) {
  127. if (driver_buffers[index].pwm_buffer_dirty) {
  128. aw20216s_write(cs_pin, AW20216S_PAGE_PWM, 0, driver_buffers[index].pwm_buffer, AW20216S_PWM_REGISTER_COUNT);
  129. driver_buffers[index].pwm_buffer_dirty = false;
  130. }
  131. }
  132. void aw20216s_flush(void) {
  133. aw20216s_update_pwm_buffers(AW20216S_CS_PIN_1, 0);
  134. #if defined(AW20216S_CS_PIN_2)
  135. aw20216s_update_pwm_buffers(AW20216S_CS_PIN_2, 1);
  136. #endif
  137. }