mirror of
https://github.com/Next-Flip/Momentum-Firmware.git
synced 2026-04-25 03:29:58 -07:00
105 lines
3.5 KiB
C
105 lines
3.5 KiB
C
/*
|
|
SK6805 FlipperZero driver
|
|
Copyright (C) 2022-2023 Victor Nikitchuk (https://github.com/quen0n)
|
|
|
|
This program is free software: you can redistribute it and/or modify
|
|
it under the terms of the GNU General Public License as published by
|
|
the Free Software Foundation, either version 3 of the License, or
|
|
(at your option) any later version.
|
|
|
|
This program is distributed in the hope that it will be useful,
|
|
but WITHOUT ANY WARRANTY; without even the implied warranty of
|
|
MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
|
|
GNU General Public License for more details.
|
|
|
|
You should have received a copy of the GNU General Public License
|
|
along with this program. If not, see <https://www.gnu.org/licenses/>.
|
|
*/
|
|
|
|
#include "SK6805.h"
|
|
#include <furi_hal.h>
|
|
|
|
#define TAG "SK6805"
|
|
|
|
/* Настройки */
|
|
#define SK6805_LED_PIN &led_pin // LED connection port
|
|
|
|
#if false
|
|
#define DEBUG_PIN &gpio_ext_pa7
|
|
#define DEBUG_INIT() \
|
|
furi_hal_gpio_init(DEBUG_PIN, GpioModeOutputPushPull, GpioPullNo, GpioSpeedVeryHigh)
|
|
#define DEBUG_SET_HIGH() furi_hal_gpio_write(DEBUG_PIN, true)
|
|
#define DEBUG_SET_LOW() furi_hal_gpio_write(DEBUG_PIN, false)
|
|
#else
|
|
#define DEBUG_INIT()
|
|
#define DEBUG_SET_HIGH()
|
|
#define DEBUG_SET_LOW()
|
|
#endif
|
|
|
|
static const GpioPin led_pin = {.port = GPIOA, .pin = LL_GPIO_PIN_8};
|
|
static uint8_t led_buffer[SK6805_LED_COUNT][3];
|
|
|
|
void SK6805_init() {
|
|
DEBUG_INIT();
|
|
furi_hal_gpio_write(SK6805_LED_PIN, false);
|
|
furi_hal_gpio_init(SK6805_LED_PIN, GpioModeOutputPushPull, GpioPullNo, GpioSpeedVeryHigh);
|
|
}
|
|
|
|
uint8_t SK6805_get_led_count() {
|
|
return (const uint8_t)SK6805_LED_COUNT;
|
|
}
|
|
void SK6805_set_led_color(uint8_t led_index, uint8_t r, uint8_t g, uint8_t b) {
|
|
FURI_LOG_T(TAG, "led: %d, r: %d, g: %d, b: %d", led_index, r, g, b);
|
|
furi_check(led_index < SK6805_LED_COUNT);
|
|
|
|
led_buffer[led_index][0] = g;
|
|
led_buffer[led_index][1] = r;
|
|
led_buffer[led_index][2] = b;
|
|
}
|
|
|
|
void SK6805_update() {
|
|
FURI_LOG_T(TAG, "update");
|
|
SK6805_init();
|
|
furi_kernel_lock();
|
|
uint32_t end;
|
|
// Sequential sending LEDs
|
|
for(uint8_t lednumber = 0; lednumber < SK6805_LED_COUNT; lednumber++) {
|
|
// Sequential sending colors
|
|
for(uint8_t color = 0; color < 3; color++) {
|
|
// Sequentially sending color bits
|
|
uint8_t i = 0b10000000;
|
|
while(i != 0) {
|
|
if(led_buffer[lednumber][color] & (i)) {
|
|
furi_hal_gpio_write(SK6805_LED_PIN, true);
|
|
DEBUG_SET_HIGH();
|
|
end = DWT->CYCCNT + 30;
|
|
//T1H 600 us (615 us)
|
|
while(DWT->CYCCNT < end) {
|
|
}
|
|
furi_hal_gpio_write(SK6805_LED_PIN, false);
|
|
DEBUG_SET_LOW();
|
|
end = DWT->CYCCNT + 26;
|
|
//T1L 600 us (587 us)
|
|
while(DWT->CYCCNT < end) {
|
|
}
|
|
} else {
|
|
furi_hal_gpio_write(SK6805_LED_PIN, true);
|
|
DEBUG_SET_HIGH();
|
|
end = DWT->CYCCNT + 11;
|
|
//T0H 300 ns (312 ns)
|
|
while(DWT->CYCCNT < end) {
|
|
}
|
|
furi_hal_gpio_write(SK6805_LED_PIN, false);
|
|
DEBUG_SET_LOW();
|
|
end = DWT->CYCCNT + 43;
|
|
//T0L 900 ns (890 ns)
|
|
while(DWT->CYCCNT < end) {
|
|
}
|
|
}
|
|
i >>= 1;
|
|
}
|
|
}
|
|
}
|
|
furi_kernel_unlock();
|
|
}
|