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.
67 lines
1.3 KiB
67 lines
1.3 KiB
9 years ago
|
#include "colorled.h"
|
||
|
|
#include "utils/timebase.h"
|
||
|
|
|
||
|
|
#define LONG_DELAY() for (volatile uint32_t __j = 4; __j > 0; __j--)
|
||
|
|
#define SHORT_DELAY() for (volatile uint32_t __j = 1; __j > 0; __j--)
|
||
|
|
|
||
|
|
static inline
|
||
|
|
__attribute__((always_inline))
|
||
|
|
void colorled_byte(uint8_t b)
|
||
|
|
{
|
||
|
|
for (register volatile uint8_t i = 0; i < 8; i++) {
|
||
|
|
COLORLED_GPIO->BSRR = COLORLED_PIN; // set pin high
|
||
|
|
|
||
|
|
// duty cycle determines bit value
|
||
|
|
if (b & 0x80) {
|
||
|
|
LONG_DELAY();
|
||
|
|
COLORLED_GPIO->BRR = COLORLED_PIN; // set pin low
|
||
|
|
SHORT_DELAY();
|
||
|
|
} else {
|
||
|
|
SHORT_DELAY();
|
||
|
|
COLORLED_GPIO->BRR = COLORLED_PIN; // set pin low
|
||
|
|
LONG_DELAY();
|
||
|
|
}
|
||
|
|
|
||
|
|
b <<= 1; // shift to next bit
|
||
|
|
}
|
||
|
|
}
|
||
|
|
|
||
|
|
|
||
|
|
/** Set one RGB LED color */
|
||
|
|
void colorled_set(uint32_t rgb)
|
||
|
|
{
|
||
|
|
__disable_irq(); // SysTick interrupt when sending data would break the timing
|
||
|
|
|
||
|
|
colorled_byte((rgb & 0x00FF00) >> 8);
|
||
|
|
colorled_byte((rgb & 0xFF0000) >> 16);
|
||
|
|
colorled_byte(rgb & 0x0000FF);
|
||
|
|
|
||
|
|
__enable_irq();
|
||
|
|
|
||
|
|
delay_us(50); // show
|
||
|
|
}
|
||
|
|
|
||
|
|
|
||
|
|
/** Set many RGBs */
|
||
|
|
void colorled_set_many(uint32_t *rgbs, int count)
|
||
|
|
{
|
||
|
|
__disable_irq();
|
||
|
|
|
||
|
|
for (int i = 0; i < count; i++) {
|
||
|
|
uint32_t rgb = *rgbs++;
|
||
|
|
colorled_byte((rgb & 0x00FF00) >> 8);
|
||
|
|
colorled_byte((rgb & 0xFF0000) >> 16);
|
||
|
|
colorled_byte(rgb & 0x0000FF);
|
||
|
|
}
|
||
|
|
|
||
|
|
__enable_irq();
|
||
|
|
|
||
|
|
delay_us(50); // show
|
||
|
|
}
|
||
|
|
|
||
|
|
|
||
|
|
void colorled_off(void)
|
||
|
|
{
|
||
|
|
colorled_set(RGB_BLACK);
|
||
|
|
}
|