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.
39 lines
793 B
39 lines
793 B
//
|
|
// Created by MightyPork on 2017/06/08.
|
|
//
|
|
|
|
#include <stdint.h>
|
|
#include "lib/color.h"
|
|
#include "lib/wsrgb.h"
|
|
#include "display.h"
|
|
#include <math.h>
|
|
#include <string.h>
|
|
|
|
#include "leds.h"
|
|
|
|
volatile uint8_t led_brightness_mul = 255;
|
|
static uint32_t leds[4];
|
|
|
|
void leds_set(const uint32_t *new_leds)
|
|
{
|
|
memcpy(leds, new_leds, 4*sizeof(uint32_t));
|
|
}
|
|
|
|
void leds_show(void)
|
|
{
|
|
xrgb_t arr[4];
|
|
|
|
float db = (float)disp_brightness / 255.0f;
|
|
if (db < 0.10) db = 0.10;
|
|
float db2 = (float)led_brightness_mul / 255.0f;
|
|
db *= db2;
|
|
|
|
for (uint8_t i = 0; i < 4; i++) {
|
|
arr[i].r = (uint8_t) ((float)rgb24_r(leds[i]) * db);
|
|
arr[i].g = (uint8_t) ((float)rgb24_g(leds[i]) * db);
|
|
arr[i].b = (uint8_t) ((float)rgb24_b(leds[i]) * db);
|
|
}
|
|
|
|
ws_send_xrgb_array(arr, 4);
|
|
//ws_send_rgb24_array(leds, 4);
|
|
}
|
|
|