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.

266 lines
9.8 KiB

  1. /* Copyright 2021 @ Keychron (https://www.keychron.com)
  2. *
  3. * This program is free software: you can redistribute it and/or modify
  4. * it under the terms of the GNU General Public License as published by
  5. * the Free Software Foundation, either version 2 of the License, or
  6. * (at your option) any later version.
  7. *
  8. * This program is distributed in the hope that it will be useful,
  9. * but WITHOUT ANY WARRANTY; without even the implied warranty of
  10. * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
  11. * GNU General Public License for more details.
  12. *
  13. * You should have received a copy of the GNU General Public License
  14. * along with this program. If not, see <http://www.gnu.org/licenses/>.
  15. */
  16. #include "snled27351.h"
  17. #include "i2c_master.h"
  18. #include "gpio.h"
  19. #define SNLED27351_PWM_REGISTER_COUNT 192
  20. #define SNLED27351_LED_CONTROL_REGISTER_COUNT 24
  21. #ifndef SNLED27351_I2C_TIMEOUT
  22. # define SNLED27351_I2C_TIMEOUT 100
  23. #endif
  24. #ifndef SNLED27351_I2C_PERSISTENCE
  25. # define SNLED27351_I2C_PERSISTENCE 0
  26. #endif
  27. #ifndef SNLED27351_PHASE_CHANNEL
  28. # define SNLED27351_PHASE_CHANNEL SNLED27351_SCAN_PHASE_12_CHANNEL
  29. #endif
  30. #ifndef SNLED27351_CURRENT_TUNE
  31. # define SNLED27351_CURRENT_TUNE \
  32. { 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF }
  33. #endif
  34. const uint8_t i2c_addresses[SNLED27351_DRIVER_COUNT] = {
  35. SNLED27351_I2C_ADDRESS_1,
  36. #ifdef SNLED27351_I2C_ADDRESS_2
  37. SNLED27351_I2C_ADDRESS_2,
  38. # ifdef SNLED27351_I2C_ADDRESS_3
  39. SNLED27351_I2C_ADDRESS_3,
  40. # ifdef SNLED27351_I2C_ADDRESS_4
  41. SNLED27351_I2C_ADDRESS_4,
  42. # endif
  43. # endif
  44. #endif
  45. };
  46. // These buffers match the SNLED27351 PWM registers.
  47. // The control buffers match the PG0 LED On/Off registers.
  48. // Storing them like this is optimal for I2C transfers to the registers.
  49. // We could optimize this and take out the unused registers from these
  50. // buffers and the transfers in snled27351_write_pwm_buffer() but it's
  51. // probably not worth the extra complexity.
  52. typedef struct snled27351_driver_t {
  53. uint8_t pwm_buffer[SNLED27351_PWM_REGISTER_COUNT];
  54. bool pwm_buffer_dirty;
  55. uint8_t led_control_buffer[SNLED27351_LED_CONTROL_REGISTER_COUNT];
  56. bool led_control_buffer_dirty;
  57. } PACKED snled27351_driver_t;
  58. snled27351_driver_t driver_buffers[SNLED27351_DRIVER_COUNT] = {{
  59. .pwm_buffer = {0},
  60. .pwm_buffer_dirty = false,
  61. .led_control_buffer = {0},
  62. .led_control_buffer_dirty = false,
  63. }};
  64. void snled27351_write_register(uint8_t index, uint8_t reg, uint8_t data) {
  65. #if SNLED27351_I2C_PERSISTENCE > 0
  66. for (uint8_t i = 0; i < SNLED27351_I2C_PERSISTENCE; i++) {
  67. if (i2c_write_register(i2c_addresses[index] << 1, reg, &data, 1, SNLED27351_I2C_TIMEOUT) == I2C_STATUS_SUCCESS) break;
  68. }
  69. #else
  70. i2c_write_register(i2c_addresses[index] << 1, reg, &data, 1, SNLED27351_I2C_TIMEOUT);
  71. #endif
  72. }
  73. void snled27351_select_page(uint8_t index, uint8_t page) {
  74. snled27351_write_register(index, SNLED27351_REG_COMMAND, page);
  75. }
  76. void snled27351_write_pwm_buffer(uint8_t index) {
  77. // Assumes PG1 is already selected.
  78. // Transmit PWM registers in 12 transfers of 16 bytes.
  79. // Iterate over the pwm_buffer contents at 16 byte intervals.
  80. for (uint8_t i = 0; i < SNLED27351_PWM_REGISTER_COUNT; i += 16) {
  81. #if SNLED27351_I2C_PERSISTENCE > 0
  82. for (uint8_t j = 0; j < SNLED27351_I2C_PERSISTENCE; j++) {
  83. if (i2c_write_register(i2c_addresses[index] << 1, i, driver_buffers[index].pwm_buffer + i, 16, SNLED27351_I2C_TIMEOUT) == I2C_STATUS_SUCCESS) break;
  84. }
  85. #else
  86. i2c_write_register(i2c_addresses[index] << 1, i, driver_buffers[index].pwm_buffer + i, 16, SNLED27351_I2C_TIMEOUT);
  87. #endif
  88. }
  89. }
  90. void snled27351_init_drivers(void) {
  91. i2c_init();
  92. #if defined(SNLED27351_SDB_PIN)
  93. gpio_set_pin_output(SNLED27351_SDB_PIN);
  94. gpio_write_pin_high(SNLED27351_SDB_PIN);
  95. #endif
  96. for (uint8_t i = 0; i < SNLED27351_DRIVER_COUNT; i++) {
  97. snled27351_init(i);
  98. }
  99. for (int i = 0; i < SNLED27351_LED_COUNT; i++) {
  100. snled27351_set_led_control_register(i, true, true, true);
  101. }
  102. for (uint8_t i = 0; i < SNLED27351_DRIVER_COUNT; i++) {
  103. snled27351_update_led_control_registers(i);
  104. }
  105. }
  106. void snled27351_init(uint8_t index) {
  107. snled27351_select_page(index, SNLED27351_COMMAND_FUNCTION);
  108. // Setting LED driver to shutdown mode
  109. snled27351_write_register(index, SNLED27351_FUNCTION_REG_SOFTWARE_SHUTDOWN, SNLED27351_SOFTWARE_SHUTDOWN_SSD_SHUTDOWN);
  110. // Setting internal channel pulldown/pullup
  111. snled27351_write_register(index, SNLED27351_FUNCTION_REG_PULLDOWNUP, SNLED27351_PULLDOWNUP_ALL_ENABLED);
  112. // Select number of scan phase
  113. snled27351_write_register(index, SNLED27351_FUNCTION_REG_SCAN_PHASE, SNLED27351_PHASE_CHANNEL);
  114. // Setting PWM Delay Phase
  115. snled27351_write_register(index, SNLED27351_FUNCTION_REG_SLEW_RATE_CONTROL_MODE_1, SNLED27351_SLEW_RATE_CONTROL_MODE_1_PDP_ENABLE);
  116. // Setting Driving/Sinking Channel Slew Rate
  117. snled27351_write_register(index, SNLED27351_FUNCTION_REG_SLEW_RATE_CONTROL_MODE_2, SNLED27351_SLEW_RATE_CONTROL_MODE_2_DSL_ENABLE | SNLED27351_SLEW_RATE_CONTROL_MODE_2_SSL_ENABLE);
  118. // Setting Iref
  119. snled27351_write_register(index, SNLED27351_FUNCTION_REG_SOFTWARE_SLEEP, 0);
  120. snled27351_select_page(index, SNLED27351_COMMAND_LED_CONTROL);
  121. for (int i = 0; i < SNLED27351_LED_CONTROL_ON_OFF_LENGTH; i++) {
  122. snled27351_write_register(index, i, 0x00);
  123. }
  124. snled27351_select_page(index, SNLED27351_COMMAND_PWM);
  125. for (int i = 0; i < SNLED27351_LED_CURRENT_TUNE_LENGTH; i++) {
  126. snled27351_write_register(index, i, 0x00);
  127. }
  128. snled27351_select_page(index, SNLED27351_COMMAND_CURRENT_TUNE);
  129. uint8_t current_tune_reg_list[SNLED27351_LED_CURRENT_TUNE_LENGTH] = SNLED27351_CURRENT_TUNE;
  130. for (int i = 0; i < SNLED27351_LED_CURRENT_TUNE_LENGTH; i++) {
  131. snled27351_write_register(index, i, current_tune_reg_list[i]);
  132. }
  133. snled27351_select_page(index, SNLED27351_COMMAND_LED_CONTROL);
  134. for (int i = 0; i < SNLED27351_LED_CONTROL_ON_OFF_LENGTH; i++) {
  135. snled27351_write_register(index, i, 0xFF);
  136. }
  137. snled27351_select_page(index, SNLED27351_COMMAND_FUNCTION);
  138. // Setting LED driver to normal mode
  139. snled27351_write_register(index, SNLED27351_FUNCTION_REG_SOFTWARE_SHUTDOWN, SNLED27351_SOFTWARE_SHUTDOWN_SSD_NORMAL);
  140. }
  141. void snled27351_set_color(int index, uint8_t red, uint8_t green, uint8_t blue) {
  142. snled27351_led_t led;
  143. if (index >= 0 && index < SNLED27351_LED_COUNT) {
  144. memcpy_P(&led, (&g_snled27351_leds[index]), sizeof(led));
  145. 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) {
  146. return;
  147. }
  148. driver_buffers[led.driver].pwm_buffer[led.r] = red;
  149. driver_buffers[led.driver].pwm_buffer[led.g] = green;
  150. driver_buffers[led.driver].pwm_buffer[led.b] = blue;
  151. driver_buffers[led.driver].pwm_buffer_dirty = true;
  152. }
  153. }
  154. void snled27351_set_color_all(uint8_t red, uint8_t green, uint8_t blue) {
  155. for (int i = 0; i < SNLED27351_LED_COUNT; i++) {
  156. snled27351_set_color(i, red, green, blue);
  157. }
  158. }
  159. void snled27351_set_led_control_register(uint8_t index, bool red, bool green, bool blue) {
  160. snled27351_led_t led;
  161. memcpy_P(&led, (&g_snled27351_leds[index]), sizeof(led));
  162. uint8_t control_register_r = led.r / 8;
  163. uint8_t control_register_g = led.g / 8;
  164. uint8_t control_register_b = led.b / 8;
  165. uint8_t bit_r = led.r % 8;
  166. uint8_t bit_g = led.g % 8;
  167. uint8_t bit_b = led.b % 8;
  168. if (red) {
  169. driver_buffers[led.driver].led_control_buffer[control_register_r] |= (1 << bit_r);
  170. } else {
  171. driver_buffers[led.driver].led_control_buffer[control_register_r] &= ~(1 << bit_r);
  172. }
  173. if (green) {
  174. driver_buffers[led.driver].led_control_buffer[control_register_g] |= (1 << bit_g);
  175. } else {
  176. driver_buffers[led.driver].led_control_buffer[control_register_g] &= ~(1 << bit_g);
  177. }
  178. if (blue) {
  179. driver_buffers[led.driver].led_control_buffer[control_register_b] |= (1 << bit_b);
  180. } else {
  181. driver_buffers[led.driver].led_control_buffer[control_register_b] &= ~(1 << bit_b);
  182. }
  183. driver_buffers[led.driver].led_control_buffer_dirty = true;
  184. }
  185. void snled27351_update_pwm_buffers(uint8_t index) {
  186. if (driver_buffers[index].pwm_buffer_dirty) {
  187. snled27351_select_page(index, SNLED27351_COMMAND_PWM);
  188. snled27351_write_pwm_buffer(index);
  189. driver_buffers[index].pwm_buffer_dirty = false;
  190. }
  191. }
  192. void snled27351_update_led_control_registers(uint8_t index) {
  193. if (driver_buffers[index].led_control_buffer_dirty) {
  194. snled27351_select_page(index, SNLED27351_COMMAND_LED_CONTROL);
  195. for (uint8_t i = 0; i < SNLED27351_LED_CONTROL_REGISTER_COUNT; i++) {
  196. snled27351_write_register(index, i, driver_buffers[index].led_control_buffer[i]);
  197. }
  198. driver_buffers[index].led_control_buffer_dirty = false;
  199. }
  200. }
  201. void snled27351_flush(void) {
  202. for (uint8_t i = 0; i < SNLED27351_DRIVER_COUNT; i++) {
  203. snled27351_update_pwm_buffers(i);
  204. }
  205. }
  206. void snled27351_sw_return_normal(uint8_t index) {
  207. snled27351_select_page(index, SNLED27351_COMMAND_FUNCTION);
  208. // Setting LED driver to normal mode
  209. snled27351_write_register(index, SNLED27351_FUNCTION_REG_SOFTWARE_SHUTDOWN, SNLED27351_SOFTWARE_SHUTDOWN_SSD_NORMAL);
  210. }
  211. void snled27351_sw_shutdown(uint8_t index) {
  212. snled27351_select_page(index, SNLED27351_COMMAND_FUNCTION);
  213. // Setting LED driver to shutdown mode
  214. snled27351_write_register(index, SNLED27351_FUNCTION_REG_SOFTWARE_SHUTDOWN, SNLED27351_SOFTWARE_SHUTDOWN_SSD_SHUTDOWN);
  215. // Write SW Sleep Register
  216. snled27351_write_register(index, SNLED27351_FUNCTION_REG_SOFTWARE_SLEEP, SNLED27351_SOFTWARE_SLEEP_ENABLE);
  217. }