diff options
Diffstat (limited to 'platforms/chibios/drivers/ws2812.c')
| -rw-r--r-- | platforms/chibios/drivers/ws2812.c | 109 | 
1 files changed, 0 insertions, 109 deletions
| diff --git a/platforms/chibios/drivers/ws2812.c b/platforms/chibios/drivers/ws2812.c deleted file mode 100644 index 55ac333b1e..0000000000 --- a/platforms/chibios/drivers/ws2812.c +++ /dev/null @@ -1,109 +0,0 @@ -#include "quantum.h" -#include "ws2812.h" -#include <ch.h> -#include <hal.h> - -/* Adapted from https://github.com/bigjosh/SimpleNeoPixelDemo/ */ - -#ifndef NOP_FUDGE -#    if defined(STM32F0XX) || defined(STM32F1XX) || defined(GD32VF103) || defined(STM32F3XX) || defined(STM32F4XX) || defined(STM32L0XX) || defined(WB32F3G71xx) || defined(WB32FQ95xx) -#        define NOP_FUDGE 0.4 -#    else -#        error("NOP_FUDGE configuration required") -#        define NOP_FUDGE 1 // this just pleases the compile so the above error is easier to spot -#    endif -#endif - -// Push Pull or Open Drain Configuration -// Default Push Pull -#ifndef WS2812_EXTERNAL_PULLUP -#    define WS2812_OUTPUT_MODE PAL_MODE_OUTPUT_PUSHPULL -#else -#    define WS2812_OUTPUT_MODE PAL_MODE_OUTPUT_OPENDRAIN -#endif - -// The reset gap can be 6000 ns, but depending on the LED strip it may have to be increased -// to values like 600000 ns. If it is too small, the pixels will show nothing most of the time. -#ifndef WS2812_RES -#    define WS2812_RES (1000 * WS2812_TRST_US) // Width of the low gap between bits to cause a frame to latch -#endif - -#define NUMBER_NOPS 6 -#define CYCLES_PER_SEC (CPU_CLOCK / NUMBER_NOPS * NOP_FUDGE) -#define NS_PER_SEC (1000000000L) // Note that this has to be SIGNED since we want to be able to check for negative values of derivatives -#define NS_PER_CYCLE (NS_PER_SEC / CYCLES_PER_SEC) -#define NS_TO_CYCLES(n) ((n) / NS_PER_CYCLE) - -#define wait_ns(x)                                  \ -    do {                                            \ -        for (int i = 0; i < NS_TO_CYCLES(x); i++) { \ -            __asm__ volatile("nop\n\t"              \ -                             "nop\n\t"              \ -                             "nop\n\t"              \ -                             "nop\n\t"              \ -                             "nop\n\t"              \ -                             "nop\n\t");            \ -        }                                           \ -    } while (0) - -void sendByte(uint8_t byte) { -    // WS2812 protocol wants most significant bits first -    for (unsigned char bit = 0; bit < 8; bit++) { -        bool is_one = byte & (1 << (7 - bit)); -        // using something like wait_ns(is_one ? T1L : T0L) here throws off timings -        if (is_one) { -            // 1 -            writePinHigh(RGB_DI_PIN); -            wait_ns(WS2812_T1H); -            writePinLow(RGB_DI_PIN); -            wait_ns(WS2812_T1L); -        } else { -            // 0 -            writePinHigh(RGB_DI_PIN); -            wait_ns(WS2812_T0H); -            writePinLow(RGB_DI_PIN); -            wait_ns(WS2812_T0L); -        } -    } -} - -void ws2812_init(void) { -    palSetLineMode(RGB_DI_PIN, WS2812_OUTPUT_MODE); -} - -// Setleds for standard RGB -void ws2812_setleds(LED_TYPE *ledarray, uint16_t leds) { -    static bool s_init = false; -    if (!s_init) { -        ws2812_init(); -        s_init = true; -    } - -    // this code is very time dependent, so we need to disable interrupts -    chSysLock(); - -    for (uint8_t i = 0; i < leds; i++) { -        // WS2812 protocol dictates grb order -#if (WS2812_BYTE_ORDER == WS2812_BYTE_ORDER_GRB) -        sendByte(ledarray[i].g); -        sendByte(ledarray[i].r); -        sendByte(ledarray[i].b); -#elif (WS2812_BYTE_ORDER == WS2812_BYTE_ORDER_RGB) -        sendByte(ledarray[i].r); -        sendByte(ledarray[i].g); -        sendByte(ledarray[i].b); -#elif (WS2812_BYTE_ORDER == WS2812_BYTE_ORDER_BGR) -        sendByte(ledarray[i].b); -        sendByte(ledarray[i].g); -        sendByte(ledarray[i].r); -#endif - -#ifdef RGBW -        sendByte(ledarray[i].w); -#endif -    } - -    wait_ns(WS2812_RES); - -    chSysUnlock(); -} | 
