apa102.c 5.5 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148
  1. /* Copyright 2020 Aldehir Rojas
  2. * Copyright 2017 Mikkel (Duckle29)
  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 "apa102.h"
  18. #include "gpio.h"
  19. #ifndef APA102_NOPS
  20. # if defined(__AVR__)
  21. # define APA102_NOPS 0 // AVR at 16 MHz already spends 62.5 ns per clock, so no extra delay is needed
  22. # elif defined(PROTOCOL_CHIBIOS)
  23. # include "hal.h"
  24. # include "chibios_config.h"
  25. # if defined(STM32F0XX) || defined(STM32F1XX) || defined(STM32F3XX) || defined(STM32F4XX) || defined(STM32L0XX) || defined(GD32VF103) || defined(MCU_RP)
  26. # define APA102_NOPS (100 / (1000000000L / (CPU_CLOCK / 4))) // This calculates how many loops of 4 nops to run to delay 100 ns
  27. # else
  28. # error APA102_NOPS configuration required
  29. # define APA102_NOPS 0 // this just pleases the compile so the above error is easier to spot
  30. # endif
  31. # endif
  32. #endif
  33. #define io_wait \
  34. do { \
  35. for (int i = 0; i < APA102_NOPS; i++) { \
  36. __asm__ volatile("nop\n\t" \
  37. "nop\n\t" \
  38. "nop\n\t" \
  39. "nop\n\t"); \
  40. } \
  41. } while (0)
  42. #define APA102_SEND_BIT(byte, bit) \
  43. do { \
  44. writePin(APA102_DI_PIN, (byte >> bit) & 1); \
  45. io_wait; \
  46. writePinHigh(APA102_CI_PIN); \
  47. io_wait; \
  48. writePinLow(APA102_CI_PIN); \
  49. io_wait; \
  50. } while (0)
  51. uint8_t apa102_led_brightness = APA102_DEFAULT_BRIGHTNESS;
  52. void static apa102_start_frame(void);
  53. void static apa102_end_frame(uint16_t num_leds);
  54. void static apa102_send_frame(uint8_t red, uint8_t green, uint8_t blue, uint8_t brightness);
  55. void static apa102_send_byte(uint8_t byte);
  56. void apa102_setleds(rgb_led_t *start_led, uint16_t num_leds) {
  57. rgb_led_t *end = start_led + num_leds;
  58. apa102_start_frame();
  59. for (rgb_led_t *led = start_led; led < end; led++) {
  60. apa102_send_frame(led->r, led->g, led->b, apa102_led_brightness);
  61. }
  62. apa102_end_frame(num_leds);
  63. }
  64. void static apa102_init(void) {
  65. setPinOutput(APA102_DI_PIN);
  66. setPinOutput(APA102_CI_PIN);
  67. writePinLow(APA102_DI_PIN);
  68. writePinLow(APA102_CI_PIN);
  69. }
  70. void apa102_set_brightness(uint8_t brightness) {
  71. if (brightness > APA102_MAX_BRIGHTNESS) {
  72. apa102_led_brightness = APA102_MAX_BRIGHTNESS;
  73. } else if (brightness < 0) {
  74. apa102_led_brightness = 0;
  75. } else {
  76. apa102_led_brightness = brightness;
  77. }
  78. }
  79. void static apa102_send_frame(uint8_t red, uint8_t green, uint8_t blue, uint8_t brightness) {
  80. apa102_send_byte(0b11100000 | brightness);
  81. apa102_send_byte(blue);
  82. apa102_send_byte(green);
  83. apa102_send_byte(red);
  84. }
  85. void static apa102_start_frame(void) {
  86. apa102_init();
  87. for (uint16_t i = 0; i < 4; i++) {
  88. apa102_send_byte(0);
  89. }
  90. }
  91. void static apa102_end_frame(uint16_t num_leds) {
  92. // This function has been taken from: https://github.com/pololu/apa102-arduino/blob/master/APA102.h
  93. // and adapted. The code is MIT licensed. I think thats compatible?
  94. //
  95. // The data stream seen by the last LED in the chain will be delayed by
  96. // (count - 1) clock edges, because each LED before it inverts the clock
  97. // line and delays the data by one clock edge. Therefore, to make sure
  98. // the last LED actually receives the data we wrote, the number of extra
  99. // edges we send at the end of the frame must be at least (count - 1).
  100. //
  101. // Assuming we only want to send these edges in groups of size K, the
  102. // C/C++ expression for the minimum number of groups to send is:
  103. //
  104. // ((count - 1) + (K - 1)) / K
  105. //
  106. // The C/C++ expression above is just (count - 1) divided by K,
  107. // rounded up to the nearest whole number if there is a remainder.
  108. //
  109. // We set K to 16 and use the formula above as the number of frame-end
  110. // bytes to transfer. Each byte has 16 clock edges.
  111. //
  112. // We are ignoring the specification for the end frame in the APA102
  113. // datasheet, which says to send 0xFF four times, because it does not work
  114. // when you have 66 LEDs or more, and also it results in unwanted white
  115. // pixels if you try to update fewer LEDs than are on your LED strip.
  116. uint16_t iterations = (num_leds + 14) / 16;
  117. for (uint16_t i = 0; i < iterations; i++) {
  118. apa102_send_byte(0);
  119. }
  120. apa102_init();
  121. }
  122. void static apa102_send_byte(uint8_t byte) {
  123. APA102_SEND_BIT(byte, 7);
  124. APA102_SEND_BIT(byte, 6);
  125. APA102_SEND_BIT(byte, 5);
  126. APA102_SEND_BIT(byte, 4);
  127. APA102_SEND_BIT(byte, 3);
  128. APA102_SEND_BIT(byte, 2);
  129. APA102_SEND_BIT(byte, 1);
  130. APA102_SEND_BIT(byte, 0);
  131. }