diff options
author | XScorpion2 <rcalt2vt@gmail.com> | 2019-04-02 19:24:14 -0500 |
---|---|---|
committer | Drashna Jaelre <drashna@live.com> | 2019-04-02 17:24:14 -0700 |
commit | c98247e3dd2958bd2d8969dc75170e7e2757b895 (patch) | |
tree | a566de223a9501809e1059c522b52adf7d37fe74 | |
parent | 68d8bb2b3fb8a35fda164539d27754b3f74e0819 (diff) | |
download | qmk_firmware-c98247e3dd2958bd2d8969dc75170e7e2757b895.tar.gz qmk_firmware-c98247e3dd2958bd2d8969dc75170e7e2757b895.zip |
RGB Matrix Overhaul (#5372)
* RGB Matrix overhaul
Breakout of animations to separate files
Integration of optimized int based math lib
Overhaul of rgb_matrix.c and animations for performance
* Updating effect function api for future extensions
* Combined the keypresses || keyreleases define checks into a single define so I stop forgetting it where necessary
* Moving define RGB_MATRIX_KEYREACTIVE_ENABLED earlier in the include chain
37 files changed, 3887 insertions, 1018 deletions
diff --git a/docs/feature_rgb_matrix.md b/docs/feature_rgb_matrix.md index 8d1efb12a..ec1218954 100644 --- a/docs/feature_rgb_matrix.md +++ b/docs/feature_rgb_matrix.md | |||
@@ -10,39 +10,45 @@ If you want to use single color LED's you should use the [LED Matrix Subsystem]( | |||
10 | 10 | ||
11 | There is basic support for addressable RGB matrix lighting with the I2C IS31FL3731 RGB controller. To enable it, add this to your `rules.mk`: | 11 | There is basic support for addressable RGB matrix lighting with the I2C IS31FL3731 RGB controller. To enable it, add this to your `rules.mk`: |
12 | 12 | ||
13 | RGB_MATRIX_ENABLE = IS31FL3731 | 13 | ```C |
14 | RGB_MATRIX_ENABLE = IS31FL3731 | ||
15 | ``` | ||
14 | 16 | ||
15 | Configure the hardware via your `config.h`: | 17 | Configure the hardware via your `config.h`: |
16 | 18 | ||
17 | // This is a 7-bit address, that gets left-shifted and bit 0 | 19 | ```C |
18 | // set to 0 for write, 1 for read (as per I2C protocol) | 20 | // This is a 7-bit address, that gets left-shifted and bit 0 |
19 | // The address will vary depending on your wiring: | 21 | // set to 0 for write, 1 for read (as per I2C protocol) |
20 | // 0b1110100 AD <-> GND | 22 | // The address will vary depending on your wiring: |
21 | // 0b1110111 AD <-> VCC | 23 | // 0b1110100 AD <-> GND |
22 | // 0b1110101 AD <-> SCL | 24 | // 0b1110111 AD <-> VCC |
23 | // 0b1110110 AD <-> SDA | 25 | // 0b1110101 AD <-> SCL |
24 | #define DRIVER_ADDR_1 0b1110100 | 26 | // 0b1110110 AD <-> SDA |
25 | #define DRIVER_ADDR_2 0b1110110 | 27 | #define DRIVER_ADDR_1 0b1110100 |
26 | 28 | #define DRIVER_ADDR_2 0b1110110 | |
27 | #define DRIVER_COUNT 2 | 29 | |
28 | #define DRIVER_1_LED_TOTAL 25 | 30 | #define DRIVER_COUNT 2 |
29 | #define DRIVER_2_LED_TOTAL 24 | 31 | #define DRIVER_1_LED_TOTAL 25 |
30 | #define DRIVER_LED_TOTAL DRIVER_1_LED_TOTAL + DRIVER_2_LED_TOTAL | 32 | #define DRIVER_2_LED_TOTAL 24 |
33 | #define DRIVER_LED_TOTAL DRIVER_1_LED_TOTAL + DRIVER_2_LED_TOTAL | ||
34 | ``` | ||
31 | 35 | ||
32 | Currently only 2 drivers are supported, but it would be trivial to support all 4 combinations. | 36 | Currently only 2 drivers are supported, but it would be trivial to support all 4 combinations. |
33 | 37 | ||
34 | Define these arrays listing all the LEDs in your `<keyboard>.c`: | 38 | Define these arrays listing all the LEDs in your `<keyboard>.c`: |
35 | 39 | ||
36 | const is31_led g_is31_leds[DRIVER_LED_TOTAL] = { | 40 | ```C |
37 | /* Refer to IS31 manual for these locations | 41 | const is31_led g_is31_leds[DRIVER_LED_TOTAL] = { |
38 | * driver | 42 | /* Refer to IS31 manual for these locations |
39 | * | R location | 43 | * driver |
40 | * | | G location | 44 | * | R location |
41 | * | | | B location | 45 | * | | G location |
42 | * | | | | */ | 46 | * | | | B location |
43 | {0, C1_3, C2_3, C3_3}, | 47 | * | | | | */ |
44 | .... | 48 | {0, C1_3, C2_3, C3_3}, |
45 | } | 49 | .... |
50 | } | ||
51 | ``` | ||
46 | 52 | ||
47 | Where `Cx_y` is the location of the LED in the matrix defined by [the datasheet](http://www.issi.com/WW/pdf/31FL3731.pdf) and the header file `drivers/issi/is31fl3731.h`. The `driver` is the index of the driver you defined in your `config.h` (`0` or `1` right now). | 53 | Where `Cx_y` is the location of the LED in the matrix defined by [the datasheet](http://www.issi.com/WW/pdf/31FL3731.pdf) and the header file `drivers/issi/is31fl3731.h`. The `driver` is the index of the driver you defined in your `config.h` (`0` or `1` right now). |
48 | 54 | ||
@@ -50,60 +56,70 @@ Where `Cx_y` is the location of the LED in the matrix defined by [the datasheet] | |||
50 | 56 | ||
51 | There is basic support for addressable RGB matrix lighting with the I2C IS31FL3733 RGB controller. To enable it, add this to your `rules.mk`: | 57 | There is basic support for addressable RGB matrix lighting with the I2C IS31FL3733 RGB controller. To enable it, add this to your `rules.mk`: |
52 | 58 | ||
53 | RGB_MATRIX_ENABLE = IS31FL3733 | 59 | ```C |
60 | RGB_MATRIX_ENABLE = IS31FL3733 | ||
61 | ``` | ||
54 | 62 | ||
55 | Configure the hardware via your `config.h`: | 63 | Configure the hardware via your `config.h`: |
56 | 64 | ||
57 | // This is a 7-bit address, that gets left-shifted and bit 0 | 65 | ```C |
58 | // set to 0 for write, 1 for read (as per I2C protocol) | 66 | // This is a 7-bit address, that gets left-shifted and bit 0 |
59 | // The address will vary depending on your wiring: | 67 | // set to 0 for write, 1 for read (as per I2C protocol) |
60 | // 00 <-> GND | 68 | // The address will vary depending on your wiring: |
61 | // 01 <-> SCL | 69 | // 00 <-> GND |
62 | // 10 <-> SDA | 70 | // 01 <-> SCL |
63 | // 11 <-> VCC | 71 | // 10 <-> SDA |
64 | // ADDR1 represents A1:A0 of the 7-bit address. | 72 | // 11 <-> VCC |
65 | // ADDR2 represents A3:A2 of the 7-bit address. | 73 | // ADDR1 represents A1:A0 of the 7-bit address. |
66 | // The result is: 0b101(ADDR2)(ADDR1) | 74 | // ADDR2 represents A3:A2 of the 7-bit address. |
67 | #define DRIVER_ADDR_1 0b1010000 | 75 | // The result is: 0b101(ADDR2)(ADDR1) |
68 | #define DRIVER_ADDR_2 0b1010000 // this is here for compliancy reasons. | 76 | #define DRIVER_ADDR_1 0b1010000 |
69 | 77 | #define DRIVER_ADDR_2 0b1010000 // this is here for compliancy reasons. | |
70 | #define DRIVER_COUNT 2 | 78 | |
71 | #define DRIVER_1_LED_TOTAL 64 | 79 | #define DRIVER_COUNT 2 |
72 | #define DRIVER_LED_TOTAL DRIVER_1_LED_TOTAL | 80 | #define DRIVER_1_LED_TOTAL 64 |
81 | #define DRIVER_LED_TOTAL DRIVER_1_LED_TOTAL | ||
82 | ``` | ||
73 | 83 | ||
74 | Currently only a single drivers is supported, but it would be trivial to support all 4 combinations. For now define `DRIVER_ADDR_2` as `DRIVER_ADDR_1` | 84 | Currently only a single drivers is supported, but it would be trivial to support all 4 combinations. For now define `DRIVER_ADDR_2` as `DRIVER_ADDR_1` |
75 | 85 | ||
76 | Define these arrays listing all the LEDs in your `<keyboard>.c`: | 86 | Define these arrays listing all the LEDs in your `<keyboard>.c`: |
77 | 87 | ||
78 | const is31_led g_is31_leds[DRIVER_LED_TOTAL] = { | 88 | ```C |
79 | /* Refer to IS31 manual for these locations | 89 | const is31_led g_is31_leds[DRIVER_LED_TOTAL] = { |
80 | * driver | 90 | /* Refer to IS31 manual for these locations |
81 | * | R location | 91 | * driver |
82 | * | | G location | 92 | * | R location |
83 | * | | | B location | 93 | * | | G location |
84 | * | | | | */ | 94 | * | | | B location |
85 | {0, B_1, A_1, C_1}, | 95 | * | | | | */ |
86 | .... | 96 | {0, B_1, A_1, C_1}, |
87 | } | 97 | .... |
98 | } | ||
99 | ``` | ||
88 | 100 | ||
89 | Where `X_Y` is the location of the LED in the matrix defined by [the datasheet](http://www.issi.com/WW/pdf/31FL3733.pdf) and the header file `drivers/issi/is31fl3733.h`. The `driver` is the index of the driver you defined in your `config.h` (Only `0` right now). | 101 | Where `X_Y` is the location of the LED in the matrix defined by [the datasheet](http://www.issi.com/WW/pdf/31FL3733.pdf) and the header file `drivers/issi/is31fl3733.h`. The `driver` is the index of the driver you defined in your `config.h` (Only `0` right now). |
90 | 102 | ||
91 | From this point forward the configuration is the same for all the drivers. | 103 | From this point forward the configuration is the same for all the drivers. |
92 | 104 | ||
93 | const rgb_led g_rgb_leds[DRIVER_LED_TOTAL] = { | 105 | ```C |
94 | /* {row | col << 4} | 106 | const rgb_led g_rgb_leds[DRIVER_LED_TOTAL] = { |
95 | * | {x=0..224, y=0..64} | 107 | /* {row | col << 4} |
96 | * | | modifier | 108 | * | {x=0..224, y=0..64} |
97 | * | | | */ | 109 | * | | modifier |
98 | {{0|(0<<4)}, {20.36*0, 21.33*0}, 1}, | 110 | * | | | */ |
99 | {{0|(1<<4)}, {20.36*1, 21.33*0}, 1}, | 111 | {{0|(0<<4)}, {20.36*0, 21.33*0}, 1}, |
100 | .... | 112 | {{0|(1<<4)}, {20.36*1, 21.33*0}, 1}, |
101 | } | 113 | .... |
114 | } | ||
115 | ``` | ||
102 | 116 | ||
103 | The format for the matrix position used in this array is `{row | (col << 4)}`. The `x` is between (inclusive) 0-224, and `y` is between (inclusive) 0-64. The easiest way to calculate these positions is: | 117 | The format for the matrix position used in this array is `{row | (col << 4)}`. The `x` is between (inclusive) 0-224, and `y` is between (inclusive) 0-64. The easiest way to calculate these positions is: |
104 | 118 | ||
105 | x = 224 / ( NUMBER_OF_COLS - 1 ) * ROW_POSITION | 119 | ```C |
106 | y = 64 / (NUMBER_OF_ROWS - 1 ) * COL_POSITION | 120 | x = 224 / ( NUMBER_OF_COLS - 1 ) * ROW_POSITION |
121 | y = 64 / (NUMBER_OF_ROWS - 1 ) * COL_POSITION | ||
122 | ``` | ||
107 | 123 | ||
108 | Where all variables are decimels/floats. | 124 | Where all variables are decimels/floats. |
109 | 125 | ||
@@ -113,48 +129,50 @@ Where all variables are decimels/floats. | |||
113 | 129 | ||
114 | All RGB keycodes are currently shared with the RGBLIGHT system: | 130 | All RGB keycodes are currently shared with the RGBLIGHT system: |
115 | 131 | ||
116 | * `RGB_TOG` - toggle | 132 | * `RGB_TOG` - toggle |
117 | * `RGB_MOD` - cycle through modes | 133 | * `RGB_MOD` - cycle through modes |
118 | * `RGB_HUI` - increase hue | 134 | * `RGB_HUI` - increase hue |
119 | * `RGB_HUD` - decrease hue | 135 | * `RGB_HUD` - decrease hue |
120 | * `RGB_SAI` - increase saturation | 136 | * `RGB_SAI` - increase saturation |
121 | * `RGB_SAD` - decrease saturation | 137 | * `RGB_SAD` - decrease saturation |
122 | * `RGB_VAI` - increase value | 138 | * `RGB_VAI` - increase value |
123 | * `RGB_VAD` - decrease value | 139 | * `RGB_VAD` - decrease value |
124 | * `RGB_SPI` - increase speed effect (no EEPROM support) | 140 | * `RGB_SPI` - increase speed effect (no EEPROM support) |
125 | * `RGB_SPD` - decrease speed effect (no EEPROM support) | 141 | * `RGB_SPD` - decrease speed effect (no EEPROM support) |
126 | 142 | * `RGB_MODE_*` keycodes will generally work, but are not currently mapped to the correct effects for the RGB Matrix system | |
127 | |||
128 | * `RGB_MODE_*` keycodes will generally work, but are not currently mapped to the correct effects for the RGB Matrix system | ||
129 | 143 | ||
130 | ## RGB Matrix Effects | 144 | ## RGB Matrix Effects |
131 | 145 | ||
132 | These are the effects that are currently available: | 146 | All effects have been configured to support current configuration values (Hue, Saturation, Value, & Speed) unless otherwise noted below. These are the effects that are currently available: |
133 | 147 | ||
134 | enum rgb_matrix_effects { | 148 | ```C |
135 | RGB_MATRIX_SOLID_COLOR = 1, | 149 | enum rgb_matrix_effects { |
136 | RGB_MATRIX_ALPHAS_MODS, | 150 | RGB_MATRIX_NONE = 0, |
137 | RGB_MATRIX_DUAL_BEACON, | 151 | RGB_MATRIX_SOLID_COLOR = 1, // Static single hue, no speed support |
138 | RGB_MATRIX_GRADIENT_UP_DOWN, | 152 | RGB_MATRIX_ALPHAS_MODS, // Static dual hue, speed is hue for secondary hue |
139 | RGB_MATRIX_RAINDROPS, | 153 | RGB_MATRIX_GRADIENT_UP_DOWN, // Static gradient top to bottom, speed controls how much gradient changes |
140 | RGB_MATRIX_CYCLE_ALL, | 154 | RGB_MATRIX_BREATHING, // Single hue brightness cycling animation |
141 | RGB_MATRIX_CYCLE_LEFT_RIGHT, | 155 | RGB_MATRIX_CYCLE_ALL, // Full keyboard solid hue cycling through full gradient |
142 | RGB_MATRIX_CYCLE_UP_DOWN, | 156 | RGB_MATRIX_CYCLE_LEFT_RIGHT, // Full gradient scrolling left to right |
143 | RGB_MATRIX_RAINBOW_BEACON, | 157 | RGB_MATRIX_CYCLE_UP_DOWN, // Full gradient scrolling top to bottom |
144 | RGB_MATRIX_RAINBOW_PINWHEELS, | 158 | RGB_MATRIX_RAINBOW_MOVING_CHEVRON, // Full gradent Chevron shapped scrolling left to right |
145 | RGB_MATRIX_RAINBOW_MOVING_CHEVRON, | 159 | RGB_MATRIX_DUAL_BEACON, // Full gradient spinning around center of keyboard |
146 | RGB_MATRIX_JELLYBEAN_RAINDROPS, | 160 | RGB_MATRIX_RAINBOW_BEACON, // Full tighter gradient spinning around center of keyboard |
147 | RGB_MATRIX_DIGITAL_RAIN, | 161 | RGB_MATRIX_RAINBOW_PINWHEELS, // Full dual gradients spinning two halfs of keyboard |
148 | #ifdef RGB_MATRIX_KEYPRESSES | 162 | RGB_MATRIX_RAINDROPS, // Randomly changes a single key's hue |
149 | RGB_MATRIX_SOLID_REACTIVE, | 163 | RGB_MATRIX_JELLYBEAN_RAINDROPS, // Randomly changes a single key's hue and saturation |
150 | RGB_MATRIX_REACTIVE_SIMPLE, | 164 | RGB_MATRIX_DIGITAL_RAIN, // That famous computer simulation |
151 | RGB_MATRIX_SPLASH, | 165 | #if defined(RGB_MATRIX_KEYPRESSES) || defined(RGB_MATRIX_KEYRELEASES) |
152 | RGB_MATRIX_MULTISPLASH, | 166 | RGB_MATRIX_SOLID_REACTIVE_SIMPLE, // Pulses keys hit to hue & value then fades value out |
153 | RGB_MATRIX_SOLID_SPLASH, | 167 | RGB_MATRIX_SOLID_REACTIVE, // Static single hue, pulses keys hit to shifted hue then fades to current hue |
154 | RGB_MATRIX_SOLID_MULTISPLASH, | 168 | RGB_MATRIX_SPLASH, // Full gradient & value pulse away from a single key hit then fades value out |
155 | #endif | 169 | RGB_MATRIX_MULTISPLASH, // Full gradient & value pulse away from multiple key hits then fades value out |
156 | RGB_MATRIX_EFFECT_MAX | 170 | RGB_MATRIX_SOLID_SPLASH, // Hue & value pulse away from a single key hit then fades value out |
157 | }; | 171 | RGB_MATRIX_SOLID_MULTISPLASH, // Hue & value pulse away from multiple key hits then fades value out |
172 | #endif | ||
173 | RGB_MATRIX_EFFECT_MAX | ||
174 | }; | ||
175 | ``` | ||
158 | 176 | ||
159 | You can disable a single effect by defining `DISABLE_[EFFECT_NAME]` in your `config.h`: | 177 | You can disable a single effect by defining `DISABLE_[EFFECT_NAME]` in your `config.h`: |
160 | 178 | ||
@@ -162,19 +180,20 @@ You can disable a single effect by defining `DISABLE_[EFFECT_NAME]` in your `con | |||
162 | |Define |Description | | 180 | |Define |Description | |
163 | |---------------------------------------------------|--------------------------------------------| | 181 | |---------------------------------------------------|--------------------------------------------| |
164 | |`#define DISABLE_RGB_MATRIX_ALPHAS_MODS` |Disables `RGB_MATRIX_ALPHAS_MODS` | | 182 | |`#define DISABLE_RGB_MATRIX_ALPHAS_MODS` |Disables `RGB_MATRIX_ALPHAS_MODS` | |
165 | |`#define DISABLE_RGB_MATRIX_DUAL_BEACON` |Disables `RGB_MATRIX_DUAL_BEACON` | | ||
166 | |`#define DISABLE_RGB_MATRIX_GRADIENT_UP_DOWN` |Disables `RGB_MATRIX_GRADIENT_UP_DOWN` | | 183 | |`#define DISABLE_RGB_MATRIX_GRADIENT_UP_DOWN` |Disables `RGB_MATRIX_GRADIENT_UP_DOWN` | |
167 | |`#define DISABLE_RGB_MATRIX_RAINDROPS` |Disables `RGB_MATRIX_RAINDROPS` | | 184 | |`#define DISABLE_RGB_MATRIX_BREATHING` |Disables `RGB_MATRIX_BREATHING` | |
168 | |`#define DISABLE_RGB_MATRIX_CYCLE_ALL` |Disables `RGB_MATRIX_CYCLE_ALL` | | 185 | |`#define DISABLE_RGB_MATRIX_CYCLE_ALL` |Disables `RGB_MATRIX_CYCLE_ALL` | |
169 | |`#define DISABLE_RGB_MATRIX_CYCLE_LEFT_RIGHT` |Disables `RGB_MATRIX_CYCLE_LEFT_RIGHT` | | 186 | |`#define DISABLE_RGB_MATRIX_CYCLE_LEFT_RIGHT` |Disables `RGB_MATRIX_CYCLE_LEFT_RIGHT` | |
170 | |`#define DISABLE_RGB_MATRIX_CYCLE_UP_DOWN` |Disables `RGB_MATRIX_CYCLE_UP_DOWN` | | 187 | |`#define DISABLE_RGB_MATRIX_CYCLE_UP_DOWN` |Disables `RGB_MATRIX_CYCLE_UP_DOWN` | |
188 | |`#define DISABLE_RGB_MATRIX_RAINBOW_MOVING_CHEVRON`|Disables `RGB_MATRIX_RAINBOW_MOVING_CHEVRON`| | ||
189 | |`#define DISABLE_RGB_MATRIX_DUAL_BEACON` |Disables `RGB_MATRIX_DUAL_BEACON` | | ||
171 | |`#define DISABLE_RGB_MATRIX_RAINBOW_BEACON` |Disables `RGB_MATRIX_RAINBOW_BEACON` | | 190 | |`#define DISABLE_RGB_MATRIX_RAINBOW_BEACON` |Disables `RGB_MATRIX_RAINBOW_BEACON` | |
172 | |`#define DISABLE_RGB_MATRIX_RAINBOW_PINWHEELS` |Disables `RGB_MATRIX_RAINBOW_PINWHEELS` | | 191 | |`#define DISABLE_RGB_MATRIX_RAINBOW_PINWHEELS` |Disables `RGB_MATRIX_RAINBOW_PINWHEELS` | |
173 | |`#define DISABLE_RGB_MATRIX_RAINBOW_MOVING_CHEVRON`|Disables `RGB_MATRIX_RAINBOW_MOVING_CHEVRON`| | 192 | |`#define DISABLE_RGB_MATRIX_RAINDROPS` |Disables `RGB_MATRIX_RAINDROPS` | |
174 | |`#define DISABLE_RGB_MATRIX_JELLYBEAN_RAINDROPS` |Disables `RGB_MATRIX_JELLYBEAN_RAINDROPS` | | 193 | |`#define DISABLE_RGB_MATRIX_JELLYBEAN_RAINDROPS` |Disables `RGB_MATRIX_JELLYBEAN_RAINDROPS` | |
175 | |`#define DISABLE_RGB_MATRIX_DIGITAL_RAIN` |Disables `RGB_MATRIX_DIGITAL_RAIN` | | 194 | |`#define DISABLE_RGB_MATRIX_DIGITAL_RAIN` |Disables `RGB_MATRIX_DIGITAL_RAIN` | |
176 | |`#define DISABLE_RGB_MATRIX_SOLID_REACTIVE` |Disables `RGB_MATRIX_SOLID_REACTIVE` | | 195 | |`#define DISABLE_RGB_MATRIX_SOLID_REACTIVE` |Disables `RGB_MATRIX_SOLID_REACTIVE` | |
177 | |`#define DISABLE_RGB_MATRIX_REACTIVE_SIMPLE` |Disables `RGB_MATRIX_REACTIVE_SIMPLE` | | 196 | |`#define DISABLE_RGB_MATRIX_SOLID_REACTIVE_SIMPLE` |Disables `RGB_MATRIX_SOLID_REACTIVE_SIMPLEE`| |
178 | |`#define DISABLE_RGB_MATRIX_SPLASH` |Disables `RGB_MATRIX_SPLASH` | | 197 | |`#define DISABLE_RGB_MATRIX_SPLASH` |Disables `RGB_MATRIX_SPLASH` | |
179 | |`#define DISABLE_RGB_MATRIX_MULTISPLASH` |Disables `RGB_MATRIX_MULTISPLASH` | | 198 | |`#define DISABLE_RGB_MATRIX_MULTISPLASH` |Disables `RGB_MATRIX_MULTISPLASH` | |
180 | |`#define DISABLE_RGB_MATRIX_SOLID_SPLASH` |Disables `RGB_MATRIX_SOLID_SPLASH` | | 199 | |`#define DISABLE_RGB_MATRIX_SOLID_SPLASH` |Disables `RGB_MATRIX_SOLID_SPLASH` | |
@@ -185,26 +204,33 @@ You can disable a single effect by defining `DISABLE_[EFFECT_NAME]` in your `con | |||
185 | 204 | ||
186 | Custom layer effects can be done by defining this in your `<keyboard>.c`: | 205 | Custom layer effects can be done by defining this in your `<keyboard>.c`: |
187 | 206 | ||
188 | void rgb_matrix_indicators_kb(void) { | 207 | ```C |
189 | rgb_matrix_set_color(index, red, green, blue); | 208 | void rgb_matrix_indicators_kb(void) { |
190 | } | 209 | rgb_matrix_set_color(index, red, green, blue); |
210 | } | ||
211 | ``` | ||
191 | 212 | ||
192 | A similar function works in the keymap as `rgb_matrix_indicators_user`. | 213 | A similar function works in the keymap as `rgb_matrix_indicators_user`. |
193 | 214 | ||
194 | ## Additional `config.h` Options | 215 | ## Additional `config.h` Options |
195 | 216 | ||
196 | #define RGB_MATRIX_KEYPRESSES // reacts to keypresses (will slow down matrix scan by a lot) | 217 | ```C |
197 | #define RGB_MATRIX_KEYRELEASES // reacts to keyreleases (not recommened) | 218 | #define RGB_MATRIX_KEYPRESSES // reacts to keypresses |
198 | #define RGB_DISABLE_AFTER_TIMEOUT 0 // number of ticks to wait until disabling effects | 219 | #define RGB_MATRIX_KEYRELEASES // reacts to keyreleases (instead of keypresses) |
199 | #define RGB_DISABLE_WHEN_USB_SUSPENDED false // turn off effects when suspended | 220 | #define RGB_DISABLE_AFTER_TIMEOUT 0 // number of ticks to wait until disabling effects |
200 | #define RGB_MATRIX_SKIP_FRAMES 1 // number of frames to skip when displaying animations (0 is full effect) if not defined defaults to 1 | 221 | #define RGB_DISABLE_WHEN_USB_SUSPENDED false // turn off effects when suspended |
201 | #define RGB_MATRIX_MAXIMUM_BRIGHTNESS 200 // limits maximum brightness of LEDs to 200 out of 255. If not defined maximum brightness is set to 255 | 222 | #define RGB_MATRIX_LED_PROCESS_LIMIT (DRIVER_LED_TOTAL + 4) / 5 // limits the number of LEDs to process in an animation per task run (increases keyboard responsiveness) |
223 | #define RGB_MATRIX_LED_FLUSH_LIMIT 16 // limits in milliseconds how frequently an animation will update the LEDs. 16 (16ms) is equivalent to limiting to 60fps (increases keyboard responsiveness) | ||
224 | #define RGB_MATRIX_MAXIMUM_BRIGHTNESS 200 // limits maximum brightness of LEDs to 200 out of 255. If not defined maximum brightness is set to 255 | ||
225 | ``` | ||
202 | 226 | ||
203 | ## EEPROM storage | 227 | ## EEPROM storage |
204 | 228 | ||
205 | The EEPROM for it is currently shared with the RGBLIGHT system (it's generally assumed only one RGB would be used at a time), but could be configured to use its own 32bit address with: | 229 | The EEPROM for it is currently shared with the RGBLIGHT system (it's generally assumed only one RGB would be used at a time), but could be configured to use its own 32bit address with: |
206 | 230 | ||
207 | #define EECONFIG_RGB_MATRIX (uint32_t *)16 | 231 | ```C |
232 | #define EECONFIG_RGB_MATRIX (uint32_t *)16 | ||
233 | ``` | ||
208 | 234 | ||
209 | Where `16` is an unused index from `eeconfig.h`. | 235 | Where `16` is an unused index from `eeconfig.h`. |
210 | 236 | ||
@@ -212,12 +238,14 @@ Where `16` is an unused index from `eeconfig.h`. | |||
212 | 238 | ||
213 | To use the suspend feature, add this to your `<keyboard>.c`: | 239 | To use the suspend feature, add this to your `<keyboard>.c`: |
214 | 240 | ||
215 | void suspend_power_down_kb(void) | 241 | ```C |
216 | { | 242 | void suspend_power_down_kb(void) |
217 | rgb_matrix_set_suspend_state(true); | 243 | { |
218 | } | 244 | rgb_matrix_set_suspend_state(true); |
219 | 245 | } | |
220 | void suspend_wakeup_init_kb(void) | 246 | |
221 | { | 247 | void suspend_wakeup_init_kb(void) |
222 | rgb_matrix_set_suspend_state(false); | 248 | { |
223 | } | 249 | rgb_matrix_set_suspend_state(false); |
250 | } | ||
251 | ``` | ||
diff --git a/keyboards/dztech/dz40rgb/config.h b/keyboards/dztech/dz40rgb/config.h index 5b9f6dc08..0d6c4ae39 100644 --- a/keyboards/dztech/dz40rgb/config.h +++ b/keyboards/dztech/dz40rgb/config.h | |||
@@ -22,7 +22,6 @@ | |||
22 | #define DEBOUNCE 3 | 22 | #define DEBOUNCE 3 |
23 | #define RGB_DISABLE_AFTER_TIMEOUT 0 // number of ticks to wait until disabling effects | 23 | #define RGB_DISABLE_AFTER_TIMEOUT 0 // number of ticks to wait until disabling effects |
24 | #define RGB_DISABLE_WHEN_USB_SUSPENDED false // turn off effects when suspended | 24 | #define RGB_DISABLE_WHEN_USB_SUSPENDED false // turn off effects when suspended |
25 | #define RGB_MATRIX_SKIP_FRAMES 10 | ||
26 | #define RGB_MATRIX_KEYPRESSES | 25 | #define RGB_MATRIX_KEYPRESSES |
27 | #define DISABLE_RGB_MATRIX_SPLASH | 26 | #define DISABLE_RGB_MATRIX_SPLASH |
28 | #define DISABLE_RGB_MATRIX_MULTISPLASH | 27 | #define DISABLE_RGB_MATRIX_MULTISPLASH |
diff --git a/keyboards/dztech/dz60rgb/config.h b/keyboards/dztech/dz60rgb/config.h index 19f32440e..3a6f4bcc0 100644 --- a/keyboards/dztech/dz60rgb/config.h +++ b/keyboards/dztech/dz60rgb/config.h | |||
@@ -23,7 +23,6 @@ | |||
23 | #define DEBOUNCE 3 | 23 | #define DEBOUNCE 3 |
24 | #define RGB_DISABLE_AFTER_TIMEOUT 0 // number of ticks to wait until disabling effects | 24 | #define RGB_DISABLE_AFTER_TIMEOUT 0 // number of ticks to wait until disabling effects |
25 | #define RGB_DISABLE_WHEN_USB_SUSPENDED false // turn off effects when suspended | 25 | #define RGB_DISABLE_WHEN_USB_SUSPENDED false // turn off effects when suspended |
26 | #define RGB_MATRIX_SKIP_FRAMES 10 | ||
27 | #define RGB_MATRIX_KEYPRESSES | 26 | #define RGB_MATRIX_KEYPRESSES |
28 | #define DISABLE_RGB_MATRIX_SPLASH | 27 | #define DISABLE_RGB_MATRIX_SPLASH |
29 | #define DISABLE_RGB_MATRIX_MULTISPLASH | 28 | #define DISABLE_RGB_MATRIX_MULTISPLASH |
diff --git a/keyboards/ergodox_ez/config.h b/keyboards/ergodox_ez/config.h index 096368f7a..a75edd415 100644 --- a/keyboards/ergodox_ez/config.h +++ b/keyboards/ergodox_ez/config.h | |||
@@ -109,7 +109,6 @@ along with this program. If not, see <http://www.gnu.org/licenses/>. | |||
109 | #define DRIVER_1_LED_TOTAL 24 | 109 | #define DRIVER_1_LED_TOTAL 24 |
110 | #define DRIVER_2_LED_TOTAL 24 | 110 | #define DRIVER_2_LED_TOTAL 24 |
111 | #define DRIVER_LED_TOTAL DRIVER_1_LED_TOTAL + DRIVER_2_LED_TOTAL | 111 | #define DRIVER_LED_TOTAL DRIVER_1_LED_TOTAL + DRIVER_2_LED_TOTAL |
112 | #define RGB_MATRIX_SKIP_FRAMES 10 | ||
113 | 112 | ||
114 | // #define RGBLIGHT_COLOR_LAYER_0 0x00, 0x00, 0xFF | 113 | // #define RGBLIGHT_COLOR_LAYER_0 0x00, 0x00, 0xFF |
115 | /* #define RGBLIGHT_COLOR_LAYER_1 0x00, 0x00, 0xFF */ | 114 | /* #define RGBLIGHT_COLOR_LAYER_1 0x00, 0x00, 0xFF */ |
diff --git a/keyboards/hs60/v1/config.h b/keyboards/hs60/v1/config.h index 7581e54b6..528f08bb9 100644 --- a/keyboards/hs60/v1/config.h +++ b/keyboards/hs60/v1/config.h | |||
@@ -120,7 +120,6 @@ along with this program. If not, see <http://www.gnu.org/licenses/>. | |||
120 | 120 | ||
121 | #define RGB_DISABLE_AFTER_TIMEOUT 0 // number of ticks to wait until disabling effects | 121 | #define RGB_DISABLE_AFTER_TIMEOUT 0 // number of ticks to wait until disabling effects |
122 | #define RGB_DISABLE_WHEN_USB_SUSPENDED false // turn off effects when suspended | 122 | #define RGB_DISABLE_WHEN_USB_SUSPENDED false // turn off effects when suspended |
123 | #define RGB_MATRIX_SKIP_FRAMES 0 | ||
124 | #define RGB_MATRIX_MAXIMUM_BRIGHTNESS 215 | 123 | #define RGB_MATRIX_MAXIMUM_BRIGHTNESS 215 |
125 | 124 | ||
126 | #define DRIVER_ADDR_1 0b1110100 | 125 | #define DRIVER_ADDR_1 0b1110100 |
diff --git a/layouts/community/ergodox/drashna_glow/config.h b/layouts/community/ergodox/drashna_glow/config.h index cdca5ba4b..a10c4bb29 100644 --- a/layouts/community/ergodox/drashna_glow/config.h +++ b/layouts/community/ergodox/drashna_glow/config.h | |||
@@ -13,7 +13,6 @@ | |||
13 | // #define RGB_MATRIX_KEYRELEASES // reacts to keyreleases (not recommened) | 13 | // #define RGB_MATRIX_KEYRELEASES // reacts to keyreleases (not recommened) |
14 | // #define RGB_DISABLE_AFTER_TIMEOUT 0 // number of ticks to wait until disabling effects | 14 | // #define RGB_DISABLE_AFTER_TIMEOUT 0 // number of ticks to wait until disabling effects |
15 | #define RGB_DISABLE_WHEN_USB_SUSPENDED true// turn off effects when suspended | 15 | #define RGB_DISABLE_WHEN_USB_SUSPENDED true// turn off effects when suspended |
16 | // #define RGB_MATRIX_SKIP_FRAMES 1 // number of frames to skip when displaying animations (0 is full effect) if not defined defaults to 1 | ||
17 | // #define RGB_MATRIX_MAXIMUM_BRIGHTNESS 200 // limits maximum brightness of LEDs to 200 out of 255. If not defined maximum brightness is set to 255 | 16 | // #define RGB_MATRIX_MAXIMUM_BRIGHTNESS 200 // limits maximum brightness of LEDs to 200 out of 255. If not defined maximum brightness is set to 255 |
18 | // #define EECONFIG_RGB_MATRIX (uint32_t *)16 | 17 | // #define EECONFIG_RGB_MATRIX (uint32_t *)16 |
19 | #endif | 18 | #endif |
diff --git a/layouts/community/ortho_4x12/drashna/config.h b/layouts/community/ortho_4x12/drashna/config.h index f648d1127..1858ee3a4 100644 --- a/layouts/community/ortho_4x12/drashna/config.h +++ b/layouts/community/ortho_4x12/drashna/config.h | |||
@@ -18,7 +18,6 @@ | |||
18 | // #define RGB_MATRIX_KEYRELEASES // reacts to keyreleases (not recommened) | 18 | // #define RGB_MATRIX_KEYRELEASES // reacts to keyreleases (not recommened) |
19 | // #define RGB_DISABLE_AFTER_TIMEOUT 0 // number of ticks to wait until disabling effects | 19 | // #define RGB_DISABLE_AFTER_TIMEOUT 0 // number of ticks to wait until disabling effects |
20 | #define RGB_DISABLE_WHEN_USB_SUSPENDED true// turn off effects when suspended | 20 | #define RGB_DISABLE_WHEN_USB_SUSPENDED true// turn off effects when suspended |
21 | // #define RGB_MATRIX_SKIP_FRAMES 1 // number of frames to skip when displaying animations (0 is full effect) if not defined defaults to 1 | ||
22 | // #define RGB_MATRIX_MAXIMUM_BRIGHTNESS 200 // limits maximum brightness of LEDs to 200 out of 255. If not defined maximum brightness is set to 255 | 21 | // #define RGB_MATRIX_MAXIMUM_BRIGHTNESS 200 // limits maximum brightness of LEDs to 200 out of 255. If not defined maximum brightness is set to 255 |
23 | #define EECONFIG_RGB_MATRIX (uint32_t *)15 | 22 | #define EECONFIG_RGB_MATRIX (uint32_t *)15 |
24 | #endif | 23 | #endif |
diff --git a/lib/lib8tion/LICENSE b/lib/lib8tion/LICENSE new file mode 100644 index 000000000..ebe476330 --- /dev/null +++ b/lib/lib8tion/LICENSE | |||
@@ -0,0 +1,20 @@ | |||
1 | The MIT License (MIT) | ||
2 | |||
3 | Copyright (c) 2013 FastLED | ||
4 | |||
5 | Permission is hereby granted, free of charge, to any person obtaining a copy of | ||
6 | this software and associated documentation files (the "Software"), to deal in | ||
7 | the Software without restriction, including without limitation the rights to | ||
8 | use, copy, modify, merge, publish, distribute, sublicense, and/or sell copies of | ||
9 | the Software, and to permit persons to whom the Software is furnished to do so, | ||
10 | subject to the following conditions: | ||
11 | |||
12 | The above copyright notice and this permission notice shall be included in all | ||
13 | copies or substantial portions of the Software. | ||
14 | |||
15 | THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR | ||
16 | IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY, FITNESS | ||
17 | FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL THE AUTHORS OR | ||
18 | COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER LIABILITY, WHETHER | ||
19 | IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM, OUT OF OR IN | ||
20 | CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN THE SOFTWARE. | ||
diff --git a/lib/lib8tion/lib8tion.c b/lib/lib8tion/lib8tion.c new file mode 100644 index 000000000..84b3e9c61 --- /dev/null +++ b/lib/lib8tion/lib8tion.c | |||
@@ -0,0 +1,242 @@ | |||
1 | #define FASTLED_INTERNAL | ||
2 | #include <stdint.h> | ||
3 | |||
4 | #define RAND16_SEED 1337 | ||
5 | uint16_t rand16seed = RAND16_SEED; | ||
6 | |||
7 | |||
8 | // memset8, memcpy8, memmove8: | ||
9 | // optimized avr replacements for the standard "C" library | ||
10 | // routines memset, memcpy, and memmove. | ||
11 | // | ||
12 | // There are two techniques that make these routines | ||
13 | // faster than the standard avr-libc routines. | ||
14 | // First, the loops are unrolled 2X, meaning that | ||
15 | // the average loop overhead is cut in half. | ||
16 | // And second, the compare-and-branch at the bottom | ||
17 | // of each loop decrements the low byte of the | ||
18 | // counter, and if the carry is clear, it branches | ||
19 | // back up immediately. Only if the low byte math | ||
20 | // causes carry do we bother to decrement the high | ||
21 | // byte and check that result for carry as well. | ||
22 | // Results for a 100-byte buffer are 20-40% faster | ||
23 | // than standard avr-libc, at a cost of a few extra | ||
24 | // bytes of code. | ||
25 | |||
26 | #if defined(__AVR__) | ||
27 | //__attribute__ ((noinline)) | ||
28 | void * memset8 ( void * ptr, uint8_t val, uint16_t num ) | ||
29 | { | ||
30 | asm volatile( | ||
31 | " movw r26, %[ptr] \n\t" | ||
32 | " sbrs %A[num], 0 \n\t" | ||
33 | " rjmp Lseteven_%= \n\t" | ||
34 | " rjmp Lsetodd_%= \n\t" | ||
35 | "Lsetloop_%=: \n\t" | ||
36 | " st X+, %[val] \n\t" | ||
37 | "Lsetodd_%=: \n\t" | ||
38 | " st X+, %[val] \n\t" | ||
39 | "Lseteven_%=: \n\t" | ||
40 | " subi %A[num], 2 \n\t" | ||
41 | " brcc Lsetloop_%= \n\t" | ||
42 | " sbci %B[num], 0 \n\t" | ||
43 | " brcc Lsetloop_%= \n\t" | ||
44 | : [num] "+r" (num) | ||
45 | : [ptr] "r" (ptr), | ||
46 | [val] "r" (val) | ||
47 | : "memory" | ||
48 | ); | ||
49 | return ptr; | ||
50 | } | ||
51 | |||
52 | |||
53 | |||
54 | //__attribute__ ((noinline)) | ||
55 | void * memcpy8 ( void * dst, const void* src, uint16_t num ) | ||
56 | { | ||
57 | asm volatile( | ||
58 | " movw r30, %[src] \n\t" | ||
59 | " movw r26, %[dst] \n\t" | ||
60 | " sbrs %A[num], 0 \n\t" | ||
61 | " rjmp Lcpyeven_%= \n\t" | ||
62 | " rjmp Lcpyodd_%= \n\t" | ||
63 | "Lcpyloop_%=: \n\t" | ||
64 | " ld __tmp_reg__, Z+ \n\t" | ||
65 | " st X+, __tmp_reg__ \n\t" | ||
66 | "Lcpyodd_%=: \n\t" | ||
67 | " ld __tmp_reg__, Z+ \n\t" | ||
68 | " st X+, __tmp_reg__ \n\t" | ||
69 | "Lcpyeven_%=: \n\t" | ||
70 | " subi %A[num], 2 \n\t" | ||
71 | " brcc Lcpyloop_%= \n\t" | ||
72 | " sbci %B[num], 0 \n\t" | ||
73 | " brcc Lcpyloop_%= \n\t" | ||
74 | : [num] "+r" (num) | ||
75 | : [src] "r" (src), | ||
76 | [dst] "r" (dst) | ||
77 | : "memory" | ||
78 | ); | ||
79 | return dst; | ||
80 | } | ||
81 | |||
82 | //__attribute__ ((noinline)) | ||
83 | void * memmove8 ( void * dst, const void* src, uint16_t num ) | ||
84 | { | ||
85 | if( src > dst) { | ||
86 | // if src > dst then we can use the forward-stepping memcpy8 | ||
87 | return memcpy8( dst, src, num); | ||
88 | } else { | ||
89 | // if src < dst then we have to step backward: | ||
90 | dst = (char*)dst + num; | ||
91 | src = (char*)src + num; | ||
92 | asm volatile( | ||
93 | " movw r30, %[src] \n\t" | ||
94 | " movw r26, %[dst] \n\t" | ||
95 | " sbrs %A[num], 0 \n\t" | ||
96 | " rjmp Lmoveven_%= \n\t" | ||
97 | " rjmp Lmovodd_%= \n\t" | ||
98 | "Lmovloop_%=: \n\t" | ||
99 | " ld __tmp_reg__, -Z \n\t" | ||
100 | " st -X, __tmp_reg__ \n\t" | ||
101 | "Lmovodd_%=: \n\t" | ||
102 | " ld __tmp_reg__, -Z \n\t" | ||
103 | " st -X, __tmp_reg__ \n\t" | ||
104 | "Lmoveven_%=: \n\t" | ||
105 | " subi %A[num], 2 \n\t" | ||
106 | " brcc Lmovloop_%= \n\t" | ||
107 | " sbci %B[num], 0 \n\t" | ||
108 | " brcc Lmovloop_%= \n\t" | ||
109 | : [num] "+r" (num) | ||
110 | : [src] "r" (src), | ||
111 | [dst] "r" (dst) | ||
112 | : "memory" | ||
113 | ); | ||
114 | return dst; | ||
115 | } | ||
116 | } | ||
117 | |||
118 | #endif /* AVR */ | ||
119 | |||
120 | |||
121 | |||
122 | |||
123 | #if 0 | ||
124 | // TEST / VERIFICATION CODE ONLY BELOW THIS POINT | ||
125 | #include <Arduino.h> | ||
126 | #include "lib8tion.h" | ||
127 | |||
128 | void test1abs( int8_t i) | ||
129 | { | ||
130 | Serial.print("abs("); Serial.print(i); Serial.print(") = "); | ||
131 | int8_t j = abs8(i); | ||
132 | Serial.print(j); Serial.println(" "); | ||
133 | } | ||
134 | |||
135 | void testabs() | ||
136 | { | ||
137 | delay(5000); | ||
138 | for( int8_t q = -128; q != 127; q++) { | ||
139 | test1abs(q); | ||
140 | } | ||
141 | for(;;){}; | ||
142 | } | ||
143 | |||
144 | |||
145 | void testmul8() | ||
146 | { | ||
147 | delay(5000); | ||
148 | byte r, c; | ||
149 | |||
150 | Serial.println("mul8:"); | ||
151 | for( r = 0; r <= 20; r += 1) { | ||
152 | Serial.print(r); Serial.print(" : "); | ||
153 | for( c = 0; c <= 20; c += 1) { | ||
154 | byte t; | ||
155 | t = mul8( r, c); | ||
156 | Serial.print(t); Serial.print(' '); | ||
157 | } | ||
158 | Serial.println(' '); | ||
159 | } | ||
160 | Serial.println("done."); | ||
161 | for(;;){}; | ||
162 | } | ||
163 | |||
164 | |||
165 | void testscale8() | ||
166 | { | ||
167 | delay(5000); | ||
168 | byte r, c; | ||
169 | |||
170 | Serial.println("scale8:"); | ||
171 | for( r = 0; r <= 240; r += 10) { | ||
172 | Serial.print(r); Serial.print(" : "); | ||
173 | for( c = 0; c <= 240; c += 10) { | ||
174 | byte t; | ||
175 | t = scale8( r, c); | ||
176 | Serial.print(t); Serial.print(' '); | ||
177 | } | ||
178 | Serial.println(' '); | ||
179 | } | ||
180 | |||
181 | Serial.println(' '); | ||
182 | Serial.println("scale8_video:"); | ||
183 | |||
184 | for( r = 0; r <= 100; r += 4) { | ||
185 | Serial.print(r); Serial.print(" : "); | ||
186 | for( c = 0; c <= 100; c += 4) { | ||
187 | byte t; | ||
188 | t = scale8_video( r, c); | ||
189 | Serial.print(t); Serial.print(' '); | ||
190 | } | ||
191 | Serial.println(' '); | ||
192 | } | ||
193 | |||
194 | Serial.println("done."); | ||
195 | for(;;){}; | ||
196 | } | ||
197 | |||
198 | |||
199 | |||
200 | void testqadd8() | ||
201 | { | ||
202 | delay(5000); | ||
203 | byte r, c; | ||
204 | for( r = 0; r <= 240; r += 10) { | ||
205 | Serial.print(r); Serial.print(" : "); | ||
206 | for( c = 0; c <= 240; c += 10) { | ||
207 | byte t; | ||
208 | t = qadd8( r, c); | ||
209 | Serial.print(t); Serial.print(' '); | ||
210 | } | ||
211 | Serial.println(' '); | ||
212 | } | ||
213 | Serial.println("done."); | ||
214 | for(;;){}; | ||
215 | } | ||
216 | |||
217 | void testnscale8x3() | ||
218 | { | ||
219 | delay(5000); | ||
220 | byte r, g, b, sc; | ||
221 | for( byte z = 0; z < 10; z++) { | ||
222 | r = random8(); g = random8(); b = random8(); sc = random8(); | ||
223 | |||
224 | Serial.print("nscale8x3_video( "); | ||
225 | Serial.print(r); Serial.print(", "); | ||
226 | Serial.print(g); Serial.print(", "); | ||
227 | Serial.print(b); Serial.print(", "); | ||
228 | Serial.print(sc); Serial.print(") = [ "); | ||
229 | |||
230 | nscale8x3_video( r, g, b, sc); | ||
231 | |||
232 | Serial.print(r); Serial.print(", "); | ||
233 | Serial.print(g); Serial.print(", "); | ||
234 | Serial.print(b); Serial.print("]"); | ||
235 | |||
236 | Serial.println(' '); | ||
237 | } | ||
238 | Serial.println("done."); | ||
239 | for(;;){}; | ||
240 | } | ||
241 | |||
242 | #endif | ||
diff --git a/lib/lib8tion/lib8tion.h b/lib/lib8tion/lib8tion.h new file mode 100644 index 000000000..d93c748e6 --- /dev/null +++ b/lib/lib8tion/lib8tion.h | |||
@@ -0,0 +1,934 @@ | |||
1 | #ifndef __INC_LIB8TION_H | ||
2 | #define __INC_LIB8TION_H | ||
3 | |||
4 | /* | ||
5 | |||
6 | Fast, efficient 8-bit math functions specifically | ||
7 | designed for high-performance LED programming. | ||
8 | |||
9 | Because of the AVR(Arduino) and ARM assembly language | ||
10 | implementations provided, using these functions often | ||
11 | results in smaller and faster code than the equivalent | ||
12 | program using plain "C" arithmetic and logic. | ||
13 | |||
14 | |||
15 | Included are: | ||
16 | |||
17 | |||
18 | - Saturating unsigned 8-bit add and subtract. | ||
19 | Instead of wrapping around if an overflow occurs, | ||
20 | these routines just 'clamp' the output at a maxumum | ||
21 | of 255, or a minimum of 0. Useful for adding pixel | ||
22 | values. E.g., qadd8( 200, 100) = 255. | ||
23 | |||
24 | qadd8( i, j) == MIN( (i + j), 0xFF ) | ||
25 | qsub8( i, j) == MAX( (i - j), 0 ) | ||
26 | |||
27 | - Saturating signed 8-bit ("7-bit") add. | ||
28 | qadd7( i, j) == MIN( (i + j), 0x7F) | ||
29 | |||
30 | |||
31 | - Scaling (down) of unsigned 8- and 16- bit values. | ||
32 | Scaledown value is specified in 1/256ths. | ||
33 | scale8( i, sc) == (i * sc) / 256 | ||
34 | scale16by8( i, sc) == (i * sc) / 256 | ||
35 | |||
36 | Example: scaling a 0-255 value down into a | ||
37 | range from 0-99: | ||
38 | downscaled = scale8( originalnumber, 100); | ||
39 | |||
40 | A special version of scale8 is provided for scaling | ||
41 | LED brightness values, to make sure that they don't | ||
42 | accidentally scale down to total black at low | ||
43 | dimming levels, since that would look wrong: | ||
44 | scale8_video( i, sc) = ((i * sc) / 256) +? 1 | ||
45 | |||
46 | Example: reducing an LED brightness by a | ||
47 | dimming factor: | ||
48 | new_bright = scale8_video( orig_bright, dimming); | ||
49 | |||
50 | |||
51 | - Fast 8- and 16- bit unsigned random numbers. | ||
52 | Significantly faster than Arduino random(), but | ||
53 | also somewhat less random. You can add entropy. | ||
54 | random8() == random from 0..255 | ||
55 | random8( n) == random from 0..(N-1) | ||
56 | random8( n, m) == random from N..(M-1) | ||
57 | |||
58 | random16() == random from 0..65535 | ||
59 | random16( n) == random from 0..(N-1) | ||
60 | random16( n, m) == random from N..(M-1) | ||
61 | |||
62 | random16_set_seed( k) == seed = k | ||
63 | random16_add_entropy( k) == seed += k | ||
64 | |||
65 | |||
66 | - Absolute value of a signed 8-bit value. | ||
67 | abs8( i) == abs( i) | ||
68 | |||
69 | |||
70 | - 8-bit math operations which return 8-bit values. | ||
71 | These are provided mostly for completeness, | ||
72 | not particularly for performance. | ||
73 | mul8( i, j) == (i * j) & 0xFF | ||
74 | add8( i, j) == (i + j) & 0xFF | ||
75 | sub8( i, j) == (i - j) & 0xFF | ||
76 | |||
77 | |||
78 | - Fast 16-bit approximations of sin and cos. | ||
79 | Input angle is a uint16_t from 0-65535. | ||
80 | Output is a signed int16_t from -32767 to 32767. | ||
81 | sin16( x) == sin( (x/32768.0) * pi) * 32767 | ||
82 | cos16( x) == cos( (x/32768.0) * pi) * 32767 | ||
83 | Accurate to more than 99% in all cases. | ||
84 | |||
85 | - Fast 8-bit approximations of sin and cos. | ||
86 | Input angle is a uint8_t from 0-255. | ||
87 | Output is an UNsigned uint8_t from 0 to 255. | ||
88 | sin8( x) == (sin( (x/128.0) * pi) * 128) + 128 | ||
89 | cos8( x) == (cos( (x/128.0) * pi) * 128) + 128 | ||
90 | Accurate to within about 2%. | ||
91 | |||
92 | |||
93 | - Fast 8-bit "easing in/out" function. | ||
94 | ease8InOutCubic(x) == 3(x^i) - 2(x^3) | ||
95 | ease8InOutApprox(x) == | ||
96 | faster, rougher, approximation of cubic easing | ||
97 | ease8InOutQuad(x) == quadratic (vs cubic) easing | ||
98 | |||
99 | - Cubic, Quadratic, and Triangle wave functions. | ||
100 | Input is a uint8_t representing phase withing the wave, | ||
101 | similar to how sin8 takes an angle 'theta'. | ||
102 | Output is a uint8_t representing the amplitude of | ||
103 | the wave at that point. | ||
104 | cubicwave8( x) | ||
105 | quadwave8( x) | ||
106 | triwave8( x) | ||
107 | |||
108 | - Square root for 16-bit integers. About three times | ||
109 | faster and five times smaller than Arduino's built-in | ||
110 | generic 32-bit sqrt routine. | ||
111 | sqrt16( uint16_t x ) == sqrt( x) | ||
112 | |||
113 | - Dimming and brightening functions for 8-bit | ||
114 | light values. | ||
115 | dim8_video( x) == scale8_video( x, x) | ||
116 | dim8_raw( x) == scale8( x, x) | ||
117 | dim8_lin( x) == (x<128) ? ((x+1)/2) : scale8(x,x) | ||
118 | brighten8_video( x) == 255 - dim8_video( 255 - x) | ||
119 | brighten8_raw( x) == 255 - dim8_raw( 255 - x) | ||
120 | brighten8_lin( x) == 255 - dim8_lin( 255 - x) | ||
121 | The dimming functions in particular are suitable | ||
122 | for making LED light output appear more 'linear'. | ||
123 | |||
124 | |||
125 | - Linear interpolation between two values, with the | ||
126 | fraction between them expressed as an 8- or 16-bit | ||
127 | fixed point fraction (fract8 or fract16). | ||
128 | lerp8by8( fromU8, toU8, fract8 ) | ||
129 | lerp16by8( fromU16, toU16, fract8 ) | ||
130 | lerp15by8( fromS16, toS16, fract8 ) | ||
131 | == from + (( to - from ) * fract8) / 256) | ||
132 | lerp16by16( fromU16, toU16, fract16 ) | ||
133 | == from + (( to - from ) * fract16) / 65536) | ||
134 | map8( in, rangeStart, rangeEnd) | ||
135 | == map( in, 0, 255, rangeStart, rangeEnd); | ||
136 | |||
137 | - Optimized memmove, memcpy, and memset, that are | ||
138 | faster than standard avr-libc 1.8. | ||
139 | memmove8( dest, src, bytecount) | ||
140 | memcpy8( dest, src, bytecount) | ||
141 | memset8( buf, value, bytecount) | ||
142 | |||
143 | - Beat generators which return sine or sawtooth | ||
144 | waves in a specified number of Beats Per Minute. | ||
145 | Sine wave beat generators can specify a low and | ||
146 | high range for the output. Sawtooth wave beat | ||
147 | generators always range 0-255 or 0-65535. | ||
148 | beatsin8( BPM, low8, high8) | ||
149 | = (sine(beatphase) * (high8-low8)) + low8 | ||
150 | beatsin16( BPM, low16, high16) | ||
151 | = (sine(beatphase) * (high16-low16)) + low16 | ||
152 | beatsin88( BPM88, low16, high16) | ||
153 | = (sine(beatphase) * (high16-low16)) + low16 | ||
154 | beat8( BPM) = 8-bit repeating sawtooth wave | ||
155 | beat16( BPM) = 16-bit repeating sawtooth wave | ||
156 | beat88( BPM88) = 16-bit repeating sawtooth wave | ||
157 | BPM is beats per minute in either simple form | ||
158 | e.g. 120, or Q8.8 fixed-point form. | ||
159 | BPM88 is beats per minute in ONLY Q8.8 fixed-point | ||
160 | form. | ||
161 | |||
162 | Lib8tion is pronounced like 'libation': lie-BAY-shun | ||
163 | |||
164 | */ | ||
165 | |||
166 | |||
167 | |||
168 | #include <stdint.h> | ||
169 | |||
170 | #define LIB8STATIC __attribute__ ((unused)) static inline | ||
171 | #define LIB8STATIC_ALWAYS_INLINE __attribute__ ((always_inline)) static inline | ||
172 | |||
173 | #if !defined(__AVR__) | ||
174 | #include <string.h> | ||
175 | // for memmove, memcpy, and memset if not defined here | ||
176 | #endif | ||
177 | |||
178 | #if defined(__arm__) | ||
179 | |||
180 | #if defined(FASTLED_TEENSY3) | ||
181 | // Can use Cortex M4 DSP instructions | ||
182 | #define QADD8_C 0 | ||
183 | #define QADD7_C 0 | ||
184 | #define QADD8_ARM_DSP_ASM 1 | ||
185 | #define QADD7_ARM_DSP_ASM 1 | ||
186 | #else | ||
187 | // Generic ARM | ||
188 | #define QADD8_C 1 | ||
189 | #define QADD7_C 1 | ||
190 | #endif | ||
191 | |||
192 | #define QSUB8_C 1 | ||
193 | #define SCALE8_C 1 | ||
194 | #define SCALE16BY8_C 1 | ||
195 | #define SCALE16_C 1 | ||
196 | #define ABS8_C 1 | ||
197 | #define MUL8_C 1 | ||
198 | #define QMUL8_C 1 | ||
199 | #define ADD8_C 1 | ||
200 | #define SUB8_C 1 | ||
201 | #define EASE8_C 1 | ||
202 | #define AVG8_C 1 | ||
203 | #define AVG7_C 1 | ||
204 | #define AVG16_C 1 | ||
205 | #define AVG15_C 1 | ||
206 | #define BLEND8_C 1 | ||
207 | |||
208 | |||
209 | #elif defined(__AVR__) | ||
210 | |||
211 | // AVR ATmega and friends Arduino | ||
212 | |||
213 | #define QADD8_C 0 | ||
214 | #define QADD7_C 0 | ||
215 | #define QSUB8_C 0 | ||
216 | #define ABS8_C 0 | ||
217 | #define ADD8_C 0 | ||
218 | #define SUB8_C 0 | ||
219 | #define AVG8_C 0 | ||
220 | #define AVG7_C 0 | ||
221 | #define AVG16_C 0 | ||
222 | #define AVG15_C 0 | ||
223 | |||
224 | #define QADD8_AVRASM 1 | ||
225 | #define QADD7_AVRASM 1 | ||
226 | #define QSUB8_AVRASM 1 | ||
227 | #define ABS8_AVRASM 1 | ||
228 | #define ADD8_AVRASM 1 | ||
229 | #define SUB8_AVRASM 1 | ||
230 | #define AVG8_AVRASM 1 | ||
231 | #define AVG7_AVRASM 1 | ||
232 | #define AVG16_AVRASM 1 | ||
233 | #define AVG15_AVRASM 1 | ||
234 | |||
235 | // Note: these require hardware MUL instruction | ||
236 | // -- sorry, ATtiny! | ||
237 | #if !defined(LIB8_ATTINY) | ||
238 | #define SCALE8_C 0 | ||
239 | #define SCALE16BY8_C 0 | ||
240 | #define SCALE16_C 0 | ||
241 | #define MUL8_C 0 | ||
242 | #define QMUL8_C 0 | ||
243 | #define EASE8_C 0 | ||
244 | #define BLEND8_C 0 | ||
245 | #define SCALE8_AVRASM 1 | ||
246 | #define SCALE16BY8_AVRASM 1 | ||
247 | #define SCALE16_AVRASM 1 | ||
248 | #define MUL8_AVRASM 1 | ||
249 | #define QMUL8_AVRASM 1 | ||
250 | #define EASE8_AVRASM 1 | ||
251 | #define CLEANUP_R1_AVRASM 1 | ||
252 | #define BLEND8_AVRASM 1 | ||
253 | #else | ||
254 | // On ATtiny, we just use C implementations | ||
255 | #define SCALE8_C 1 | ||
256 | #define SCALE16BY8_C 1 | ||
257 | #define SCALE16_C 1 | ||
258 | #define MUL8_C 1 | ||
259 | #define QMUL8_C 1 | ||
260 | #define EASE8_C 1 | ||
261 | #define BLEND8_C 1 | ||
262 | #define SCALE8_AVRASM 0 | ||
263 | #define SCALE16BY8_AVRASM 0 | ||
264 | #define SCALE16_AVRASM 0 | ||
265 | #define MUL8_AVRASM 0 | ||
266 | #define QMUL8_AVRASM 0 | ||
267 | #define EASE8_AVRASM 0 | ||
268 | #define BLEND8_AVRASM 0 | ||
269 | #endif | ||
270 | |||
271 | #else | ||
272 | |||
273 | // unspecified architecture, so | ||
274 | // no ASM, everything in C | ||
275 | #define QADD8_C 1 | ||
276 | #define QADD7_C 1 | ||
277 | #define QSUB8_C 1 | ||
278 | #define SCALE8_C 1 | ||
279 | #define SCALE16BY8_C 1 | ||
280 | #define SCALE16_C 1 | ||
281 | #define ABS8_C 1 | ||
282 | #define MUL8_C 1 | ||
283 | #define QMUL8_C 1 | ||
284 | #define ADD8_C 1 | ||
285 | #define SUB8_C 1 | ||
286 | #define EASE8_C 1 | ||
287 | #define AVG8_C 1 | ||
288 | #define AVG7_C 1 | ||
289 | #define AVG16_C 1 | ||
290 | #define AVG15_C 1 | ||
291 | #define BLEND8_C 1 | ||
292 | |||
293 | #endif | ||
294 | |||
295 | ///@defgroup lib8tion Fast math functions | ||
296 | ///A variety of functions for working with numbers. | ||
297 | ///@{ | ||
298 | |||
299 | |||
300 | /////////////////////////////////////////////////////////////////////// | ||
301 | // | ||
302 | // typdefs for fixed-point fractional types. | ||
303 | // | ||
304 | // sfract7 should be interpreted as signed 128ths. | ||
305 | // fract8 should be interpreted as unsigned 256ths. | ||
306 | // sfract15 should be interpreted as signed 32768ths. | ||
307 | // fract16 should be interpreted as unsigned 65536ths. | ||
308 | // | ||
309 | // Example: if a fract8 has the value "64", that should be interpreted | ||
310 | // as 64/256ths, or one-quarter. | ||
311 | // | ||
312 | // | ||
313 | // fract8 range is 0 to 0.99609375 | ||
314 | // in steps of 0.00390625 | ||
315 | // | ||
316 | // sfract7 range is -0.9921875 to 0.9921875 | ||
317 | // in steps of 0.0078125 | ||
318 | // | ||
319 | // fract16 range is 0 to 0.99998474121 | ||
320 | // in steps of 0.00001525878 | ||
321 | // | ||
322 | // sfract15 range is -0.99996948242 to 0.99996948242 | ||
323 | // in steps of 0.00003051757 | ||
324 | // | ||
325 | |||
326 | /// ANSI unsigned short _Fract. range is 0 to 0.99609375 | ||
327 | /// in steps of 0.00390625 | ||
328 | typedef uint8_t fract8; ///< ANSI: unsigned short _Fract | ||
329 | |||
330 | /// ANSI: signed short _Fract. range is -0.9921875 to 0.9921875 | ||
331 | /// in steps of 0.0078125 | ||
332 | typedef int8_t sfract7; ///< ANSI: signed short _Fract | ||
333 | |||
334 | /// ANSI: unsigned _Fract. range is 0 to 0.99998474121 | ||
335 | /// in steps of 0.00001525878 | ||
336 | typedef uint16_t fract16; ///< ANSI: unsigned _Fract | ||
337 | |||
338 | /// ANSI: signed _Fract. range is -0.99996948242 to 0.99996948242 | ||
339 | /// in steps of 0.00003051757 | ||
340 | typedef int16_t sfract15; ///< ANSI: signed _Fract | ||
341 | |||
342 | |||
343 | // accumXY types should be interpreted as X bits of integer, | ||
344 | // and Y bits of fraction. | ||
345 | // E.g., accum88 has 8 bits of int, 8 bits of fraction | ||
346 | |||
347 | typedef uint16_t accum88; ///< ANSI: unsigned short _Accum. 8 bits int, 8 bits fraction | ||
348 | typedef int16_t saccum78; ///< ANSI: signed short _Accum. 7 bits int, 8 bits fraction | ||
349 | typedef uint32_t accum1616;///< ANSI: signed _Accum. 16 bits int, 16 bits fraction | ||
350 | typedef int32_t saccum1516;///< ANSI: signed _Accum. 15 bits int, 16 bits fraction | ||
351 | typedef uint16_t accum124; ///< no direct ANSI counterpart. 12 bits int, 4 bits fraction | ||
352 | typedef int32_t saccum114;///< no direct ANSI counterpart. 1 bit int, 14 bits fraction | ||
353 | |||
354 | |||
355 | |||
356 | #include "math8.h" | ||
357 | #include "scale8.h" | ||
358 | #include "random8.h" | ||
359 | #include "trig8.h" | ||
360 | |||
361 | /////////////////////////////////////////////////////////////////////// | ||
362 | |||
363 | |||
364 | |||
365 | |||
366 | |||
367 | |||
368 | |||
369 | /////////////////////////////////////////////////////////////////////// | ||
370 | // | ||
371 | // float-to-fixed and fixed-to-float conversions | ||
372 | // | ||
373 | // Note that anything involving a 'float' on AVR will be slower. | ||
374 | |||
375 | /// sfract15ToFloat: conversion from sfract15 fixed point to | ||
376 | /// IEEE754 32-bit float. | ||
377 | LIB8STATIC float sfract15ToFloat( sfract15 y) | ||
378 | { | ||
379 | return y / 32768.0; | ||
380 | } | ||
381 | |||
382 | /// conversion from IEEE754 float in the range (-1,1) | ||
383 | /// to 16-bit fixed point. Note that the extremes of | ||
384 | /// one and negative one are NOT representable. The | ||
385 | /// representable range is basically | ||
386 | LIB8STATIC sfract15 floatToSfract15( float f) | ||
387 | { | ||
388 | return f * 32768.0; | ||
389 | } | ||
390 | |||
391 | |||
392 | |||
393 | /////////////////////////////////////////////////////////////////////// | ||
394 | // | ||
395 | // memmove8, memcpy8, and memset8: | ||
396 | // alternatives to memmove, memcpy, and memset that are | ||
397 | // faster on AVR than standard avr-libc 1.8 | ||
398 | |||
399 | #if defined(__AVR__) | ||
400 | void * memmove8( void * dst, const void * src, uint16_t num ); | ||
401 | void * memcpy8 ( void * dst, const void * src, uint16_t num ) __attribute__ ((noinline)); | ||
402 | void * memset8 ( void * ptr, uint8_t value, uint16_t num ) __attribute__ ((noinline)) ; | ||
403 | #else | ||
404 | // on non-AVR platforms, these names just call standard libc. | ||
405 | #define memmove8 memmove | ||
406 | #define memcpy8 memcpy | ||
407 | #define memset8 memset | ||
408 | #endif | ||
409 | |||
410 | |||
411 | /////////////////////////////////////////////////////////////////////// | ||
412 | // | ||
413 | // linear interpolation, such as could be used for Perlin noise, etc. | ||
414 | // | ||
415 | |||
416 | // A note on the structure of the lerp functions: | ||
417 | // The cases for b>a and b<=a are handled separately for | ||
418 | // speed: without knowing the relative order of a and b, | ||
419 | // the value (a-b) might be overflow the width of a or b, | ||
420 | // and have to be promoted to a wider, slower type. | ||
421 | // To avoid that, we separate the two cases, and are able | ||
422 | // to do all the math in the same width as the arguments, | ||
423 | // which is much faster and smaller on AVR. | ||
424 | |||
425 | /// linear interpolation between two unsigned 8-bit values, | ||
426 | /// with 8-bit fraction | ||
427 | LIB8STATIC uint8_t lerp8by8( uint8_t a, uint8_t b, fract8 frac) | ||
428 | { | ||
429 | uint8_t result; | ||
430 | if( b > a) { | ||
431 | uint8_t delta = b - a; | ||
432 | uint8_t scaled = scale8( delta, frac); | ||
433 | result = a + scaled; | ||
434 | } else { | ||
435 | uint8_t delta = a - b; | ||
436 | uint8_t scaled = scale8( delta, frac); | ||
437 | result = a - scaled; | ||
438 | } | ||
439 | return result; | ||
440 | } | ||
441 | |||
442 | /// linear interpolation between two unsigned 16-bit values, | ||
443 | /// with 16-bit fraction | ||
444 | LIB8STATIC uint16_t lerp16by16( uint16_t a, uint16_t b, fract16 frac) | ||
445 | { | ||
446 | uint16_t result; | ||
447 | if( b > a ) { | ||
448 | uint16_t delta = b - a; | ||
449 | uint16_t scaled = scale16(delta, frac); | ||
450 | result = a + scaled; | ||
451 | } else { | ||
452 | uint16_t delta = a - b; | ||
453 | uint16_t scaled = scale16( delta, frac); | ||
454 | result = a - scaled; | ||
455 | } | ||
456 | return result; | ||
457 | } | ||
458 | |||
459 | /// linear interpolation between two unsigned 16-bit values, | ||
460 | /// with 8-bit fraction | ||
461 | LIB8STATIC uint16_t lerp16by8( uint16_t a, uint16_t b, fract8 frac) | ||
462 | { | ||
463 | uint16_t result; | ||
464 | if( b > a) { | ||
465 | uint16_t delta = b - a; | ||
466 | uint16_t scaled = scale16by8( delta, frac); | ||
467 | result = a + scaled; | ||
468 | } else { | ||
469 | uint16_t delta = a - b; | ||
470 | uint16_t scaled = scale16by8( delta, frac); | ||
471 | result = a - scaled; | ||
472 | } | ||
473 | return result; | ||
474 | } | ||
475 | |||
476 | /// linear interpolation between two signed 15-bit values, | ||
477 | /// with 8-bit fraction | ||
478 | LIB8STATIC int16_t lerp15by8( int16_t a, int16_t b, fract8 frac) | ||
479 | { | ||
480 | int16_t result; | ||
481 | if( b > a) { | ||
482 | uint16_t delta = b - a; | ||
483 | uint16_t scaled = scale16by8( delta, frac); | ||
484 | result = a + scaled; | ||
485 | } else { | ||
486 | uint16_t delta = a - b; | ||
487 | uint16_t scaled = scale16by8( delta, frac); | ||
488 | result = a - scaled; | ||
489 | } | ||
490 | return result; | ||
491 | } | ||
492 | |||
493 | /// linear interpolation between two signed 15-bit values, | ||
494 | /// with 8-bit fraction | ||
495 | LIB8STATIC int16_t lerp15by16( int16_t a, int16_t b, fract16 frac) | ||
496 | { | ||
497 | int16_t result; | ||
498 | if( b > a) { | ||
499 | uint16_t delta = b - a; | ||
500 | uint16_t scaled = scale16( delta, frac); | ||
501 | result = a + scaled; | ||
502 | } else { | ||
503 | uint16_t delta = a - b; | ||
504 | uint16_t scaled = scale16( delta, frac); | ||
505 | result = a - scaled; | ||
506 | } | ||
507 | return result; | ||
508 | } | ||
509 | |||
510 | /// map8: map from one full-range 8-bit value into a narrower | ||
511 | /// range of 8-bit values, possibly a range of hues. | ||
512 | /// | ||
513 | /// E.g. map myValue into a hue in the range blue..purple..pink..red | ||
514 | /// hue = map8( myValue, HUE_BLUE, HUE_RED); | ||
515 | /// | ||
516 | /// Combines nicely with the waveform functions (like sin8, etc) | ||
517 | /// to produce continuous hue gradients back and forth: | ||
518 | /// | ||
519 | /// hue = map8( sin8( myValue), HUE_BLUE, HUE_RED); | ||
520 | /// | ||
521 | /// Mathematically simiar to lerp8by8, but arguments are more | ||
522 | /// like Arduino's "map"; this function is similar to | ||
523 | /// | ||
524 | /// map( in, 0, 255, rangeStart, rangeEnd) | ||
525 | /// | ||
526 | /// but faster and specifically designed for 8-bit values. | ||
527 | LIB8STATIC uint8_t map8( uint8_t in, uint8_t rangeStart, uint8_t rangeEnd) | ||
528 | { | ||
529 | uint8_t rangeWidth = rangeEnd - rangeStart; | ||
530 | uint8_t out = scale8( in, rangeWidth); | ||
531 | out += rangeStart; | ||
532 | return out; | ||
533 | } | ||
534 | |||
535 | |||
536 | /////////////////////////////////////////////////////////////////////// | ||
537 | // | ||
538 | // easing functions; see http://easings.net | ||
539 | // | ||
540 | |||
541 | /// ease8InOutQuad: 8-bit quadratic ease-in / ease-out function | ||
542 | /// Takes around 13 cycles on AVR | ||
543 | #if EASE8_C == 1 | ||
544 | LIB8STATIC uint8_t ease8InOutQuad( uint8_t i) | ||
545 | { | ||
546 | uint8_t j = i; | ||
547 | if( j & 0x80 ) { | ||
548 | j = 255 - j; | ||
549 | } | ||
550 | uint8_t jj = scale8( j, j); | ||
551 | uint8_t jj2 = jj << 1; | ||
552 | if( i & 0x80 ) { | ||
553 | jj2 = 255 - jj2; | ||
554 | } | ||
555 | return jj2; | ||
556 | } | ||
557 | |||
558 | #elif EASE8_AVRASM == 1 | ||
559 | // This AVR asm version of ease8InOutQuad preserves one more | ||
560 | // low-bit of precision than the C version, and is also slightly | ||
561 | // smaller and faster. | ||
562 | LIB8STATIC uint8_t ease8InOutQuad(uint8_t val) { | ||
563 | uint8_t j=val; | ||
564 | asm volatile ( | ||
565 | "sbrc %[val], 7 \n" | ||
566 | "com %[j] \n" | ||
567 | "mul %[j], %[j] \n" | ||
568 | "add r0, %[j] \n" | ||
569 | "ldi %[j], 0 \n" | ||
570 | "adc %[j], r1 \n" | ||
571 | "lsl r0 \n" // carry = high bit of low byte of mul product | ||
572 | "rol %[j] \n" // j = (j * 2) + carry // preserve add'l bit of precision | ||
573 | "sbrc %[val], 7 \n" | ||
574 | "com %[j] \n" | ||
575 | "clr __zero_reg__ \n" | ||
576 | : [j] "+&a" (j) | ||
577 | : [val] "a" (val) | ||
578 | : "r0", "r1" | ||
579 | ); | ||
580 | return j; | ||
581 | } | ||
582 | |||
583 | #else | ||
584 | #error "No implementation for ease8InOutQuad available." | ||
585 | #endif | ||
586 | |||
587 | /// ease16InOutQuad: 16-bit quadratic ease-in / ease-out function | ||
588 | // C implementation at this point | ||
589 | LIB8STATIC uint16_t ease16InOutQuad( uint16_t i) | ||
590 | { | ||
591 | uint16_t j = i; | ||
592 | if( j & 0x8000 ) { | ||
593 | j = 65535 - j; | ||
594 | } | ||
595 | uint16_t jj = scale16( j, j); | ||
596 | uint16_t jj2 = jj << 1; | ||
597 | if( i & 0x8000 ) { | ||
598 | jj2 = 65535 - jj2; | ||
599 | } | ||
600 | return jj2; | ||
601 | } | ||
602 | |||
603 | |||
604 | /// ease8InOutCubic: 8-bit cubic ease-in / ease-out function | ||
605 | /// Takes around 18 cycles on AVR | ||
606 | LIB8STATIC fract8 ease8InOutCubic( fract8 i) | ||
607 | { | ||
608 | uint8_t ii = scale8_LEAVING_R1_DIRTY( i, i); | ||
609 | uint8_t iii = scale8_LEAVING_R1_DIRTY( ii, i); | ||
610 | |||
611 | uint16_t r1 = (3 * (uint16_t)(ii)) - ( 2 * (uint16_t)(iii)); | ||
612 | |||
613 | /* the code generated for the above *'s automatically | ||
614 | cleans up R1, so there's no need to explicitily call | ||
615 | cleanup_R1(); */ | ||
616 | |||
617 | uint8_t result = r1; | ||
618 | |||
619 | // if we got "256", return 255: | ||
620 | if( r1 & 0x100 ) { | ||
621 | result = 255; | ||
622 | } | ||
623 | return result; | ||
624 | } | ||
625 | |||
626 | /// ease8InOutApprox: fast, rough 8-bit ease-in/ease-out function | ||
627 | /// shaped approximately like 'ease8InOutCubic', | ||
628 | /// it's never off by more than a couple of percent | ||
629 | /// from the actual cubic S-curve, and it executes | ||
630 | /// more than twice as fast. Use when the cycles | ||
631 | /// are more important than visual smoothness. | ||
632 | /// Asm version takes around 7 cycles on AVR. | ||
633 | |||
634 | #if EASE8_C == 1 | ||
635 | LIB8STATIC fract8 ease8InOutApprox( fract8 i) | ||
636 | { | ||
637 | if( i < 64) { | ||
638 | // start with slope 0.5 | ||
639 | i /= 2; | ||
640 | } else if( i > (255 - 64)) { | ||
641 | // end with slope 0.5 | ||
642 | i = 255 - i; | ||
643 | i /= 2; | ||
644 | i = 255 - i; | ||
645 | } else { | ||
646 | // in the middle, use slope 192/128 = 1.5 | ||
647 | i -= 64; | ||
648 | i += (i / 2); | ||
649 | i += 32; | ||
650 | } | ||
651 | |||
652 | return i; | ||
653 | } | ||
654 | |||
655 | #elif EASE8_AVRASM == 1 | ||
656 | LIB8STATIC uint8_t ease8InOutApprox( fract8 i) | ||
657 | { | ||
658 | // takes around 7 cycles on AVR | ||
659 | asm volatile ( | ||
660 | " subi %[i], 64 \n\t" | ||
661 | " cpi %[i], 128 \n\t" | ||
662 | " brcc Lshift_%= \n\t" | ||
663 | |||
664 | // middle case | ||
665 | " mov __tmp_reg__, %[i] \n\t" | ||
666 | " lsr __tmp_reg__ \n\t" | ||
667 | " add %[i], __tmp_reg__ \n\t" | ||
668 | " subi %[i], 224 \n\t" | ||
669 | " rjmp Ldone_%= \n\t" | ||
670 | |||
671 | // start or end case | ||
672 | "Lshift_%=: \n\t" | ||
673 | " lsr %[i] \n\t" | ||
674 | " subi %[i], 96 \n\t" | ||
675 | |||
676 | "Ldone_%=: \n\t" | ||
677 | |||
678 | : [i] "+&a" (i) | ||
679 | : | ||
680 | : "r0", "r1" | ||
681 | ); | ||
682 | return i; | ||
683 | } | ||
684 | #else | ||
685 | #error "No implementation for ease8 available." | ||
686 | #endif | ||
687 | |||
688 | |||
689 | |||
690 | /// triwave8: triangle (sawtooth) wave generator. Useful for | ||
691 | /// turning a one-byte ever-increasing value into a | ||
692 | /// one-byte value that oscillates up and down. | ||
693 | /// | ||
694 | /// input output | ||
695 | /// 0..127 0..254 (positive slope) | ||
696 | /// 128..255 254..0 (negative slope) | ||
697 | /// | ||
698 | /// On AVR this function takes just three cycles. | ||
699 | /// | ||
700 | LIB8STATIC uint8_t triwave8(uint8_t in) | ||
701 | { | ||
702 | if( in & 0x80) { | ||
703 | in = 255 - in; | ||
704 | } | ||
705 | uint8_t out = in << 1; | ||
706 | return out; | ||
707 | } | ||
708 | |||
709 | |||
710 | // quadwave8 and cubicwave8: S-shaped wave generators (like 'sine'). | ||
711 | // Useful for turning a one-byte 'counter' value into a | ||
712 | // one-byte oscillating value that moves smoothly up and down, | ||
713 | // with an 'acceleration' and 'deceleration' curve. | ||
714 | // | ||
715 | // These are even faster than 'sin8', and have | ||
716 | // slightly different curve shapes. | ||
717 | // | ||
718 | |||
719 | /// quadwave8: quadratic waveform generator. Spends just a little more | ||
720 | /// time at the limits than 'sine' does. | ||
721 | LIB8STATIC uint8_t quadwave8(uint8_t in) | ||
722 | { | ||
723 | return ease8InOutQuad( triwave8( in)); | ||
724 | } | ||
725 | |||
726 | /// cubicwave8: cubic waveform generator. Spends visibly more time | ||
727 | /// at the limits than 'sine' does. | ||
728 | LIB8STATIC uint8_t cubicwave8(uint8_t in) | ||
729 | { | ||
730 | return ease8InOutCubic( triwave8( in)); | ||
731 | } | ||
732 | |||
733 | /// squarewave8: square wave generator. Useful for | ||
734 | /// turning a one-byte ever-increasing value | ||
735 | /// into a one-byte value that is either 0 or 255. | ||
736 | /// The width of the output 'pulse' is | ||
737 | /// determined by the pulsewidth argument: | ||
738 | /// | ||
739 | ///~~~ | ||
740 | /// If pulsewidth is 255, output is always 255. | ||
741 | /// If pulsewidth < 255, then | ||
742 | /// if input < pulsewidth then output is 255 | ||
743 | /// if input >= pulsewidth then output is 0 | ||
744 | ///~~~ | ||
745 | /// | ||
746 | /// the output looking like: | ||
747 | /// | ||
748 | ///~~~ | ||
749 | /// 255 +--pulsewidth--+ | ||
750 | /// . | | | ||
751 | /// 0 0 +--------(256-pulsewidth)-------- | ||
752 | ///~~~ | ||
753 | /// | ||
754 | /// @param in | ||
755 | /// @param pulsewidth | ||
756 | /// @returns square wave output | ||
757 | LIB8STATIC uint8_t squarewave8( uint8_t in, uint8_t pulsewidth) | ||
758 | { | ||
759 | if( in < pulsewidth || (pulsewidth == 255)) { | ||
760 | return 255; | ||
761 | } else { | ||
762 | return 0; | ||
763 | } | ||
764 | } | ||
765 | |||
766 | |||
767 | // Beat generators - These functions produce waves at a given | ||
768 | // number of 'beats per minute'. Internally, they use | ||
769 | // the Arduino function 'millis' to track elapsed time. | ||
770 | // Accuracy is a bit better than one part in a thousand. | ||
771 | // | ||
772 | // beat8( BPM ) returns an 8-bit value that cycles 'BPM' times | ||
773 | // per minute, rising from 0 to 255, resetting to zero, | ||
774 | // rising up again, etc.. The output of this function | ||
775 | // is suitable for feeding directly into sin8, and cos8, | ||
776 | // triwave8, quadwave8, and cubicwave8. | ||
777 | // beat16( BPM ) returns a 16-bit value that cycles 'BPM' times | ||
778 | // per minute, rising from 0 to 65535, resetting to zero, | ||
779 | // rising up again, etc. The output of this function is | ||
780 | // suitable for feeding directly into sin16 and cos16. | ||
781 | // beat88( BPM88) is the same as beat16, except that the BPM88 argument | ||
782 | // MUST be in Q8.8 fixed point format, e.g. 120BPM must | ||
783 | // be specified as 120*256 = 30720. | ||
784 | // beatsin8( BPM, uint8_t low, uint8_t high) returns an 8-bit value that | ||
785 | // rises and falls in a sine wave, 'BPM' times per minute, | ||
786 | // between the values of 'low' and 'high'. | ||
787 | // beatsin16( BPM, uint16_t low, uint16_t high) returns a 16-bit value | ||
788 | // that rises and falls in a sine wave, 'BPM' times per | ||
789 | // minute, between the values of 'low' and 'high'. | ||
790 | // beatsin88( BPM88, ...) is the same as beatsin16, except that the | ||
791 | // BPM88 argument MUST be in Q8.8 fixed point format, | ||
792 | // e.g. 120BPM must be specified as 120*256 = 30720. | ||
793 | // | ||
794 | // BPM can be supplied two ways. The simpler way of specifying BPM is as | ||
795 | // a simple 8-bit integer from 1-255, (e.g., "120"). | ||
796 | // The more sophisticated way of specifying BPM allows for fractional | ||
797 | // "Q8.8" fixed point number (an 'accum88') with an 8-bit integer part and | ||
798 | // an 8-bit fractional part. The easiest way to construct this is to multiply | ||
799 | // a floating point BPM value (e.g. 120.3) by 256, (e.g. resulting in 30796 | ||
800 | // in this case), and pass that as the 16-bit BPM argument. | ||
801 | // "BPM88" MUST always be specified in Q8.8 format. | ||
802 | // | ||
803 | // Originally designed to make an entire animation project pulse with brightness. | ||
804 | // For that effect, add this line just above your existing call to "FastLED.show()": | ||
805 | // | ||
806 | // uint8_t bright = beatsin8( 60 /*BPM*/, 192 /*dimmest*/, 255 /*brightest*/ )); | ||
807 | // FastLED.setBrightness( bright ); | ||
808 | // FastLED.show(); | ||
809 | // | ||
810 | // The entire animation will now pulse between brightness 192 and 255 once per second. | ||
811 | |||
812 | |||
813 | // The beat generators need access to a millisecond counter. | ||
814 | // On Arduino, this is "millis()". On other platforms, you'll | ||
815 | // need to provide a function with this signature: | ||
816 | // uint32_t get_millisecond_timer(); | ||
817 | // that provides similar functionality. | ||
818 | // You can also force use of the get_millisecond_timer function | ||
819 | // by #defining USE_GET_MILLISECOND_TIMER. | ||
820 | #if (defined(ARDUINO) || defined(SPARK) || defined(FASTLED_HAS_MILLIS)) && !defined(USE_GET_MILLISECOND_TIMER) | ||
821 | // Forward declaration of Arduino function 'millis'. | ||
822 | //uint32_t millis(); | ||
823 | #define GET_MILLIS millis | ||
824 | #else | ||
825 | uint32_t get_millisecond_timer(void); | ||
826 | #define GET_MILLIS get_millisecond_timer | ||
827 | #endif | ||
828 | |||
829 | // beat16 generates a 16-bit 'sawtooth' wave at a given BPM, | ||
830 | /// with BPM specified in Q8.8 fixed-point format; e.g. | ||
831 | /// for this function, 120 BPM MUST BE specified as | ||
832 | /// 120*256 = 30720. | ||
833 | /// If you just want to specify "120", use beat16 or beat8. | ||
834 | LIB8STATIC uint16_t beat88( accum88 beats_per_minute_88, uint32_t timebase) | ||
835 | { | ||
836 | // BPM is 'beats per minute', or 'beats per 60000ms'. | ||
837 | // To avoid using the (slower) division operator, we | ||
838 | // want to convert 'beats per 60000ms' to 'beats per 65536ms', | ||
839 | // and then use a simple, fast bit-shift to divide by 65536. | ||
840 | // | ||
841 | // The ratio 65536:60000 is 279.620266667:256; we'll call it 280:256. | ||
842 | // The conversion is accurate to about 0.05%, more or less, | ||
843 | // e.g. if you ask for "120 BPM", you'll get about "119.93". | ||
844 | return (((GET_MILLIS()) - timebase) * beats_per_minute_88 * 280) >> 16; | ||
845 | } | ||
846 | |||
847 | /// beat16 generates a 16-bit 'sawtooth' wave at a given BPM | ||
848 | LIB8STATIC uint16_t beat16( accum88 beats_per_minute, uint32_t timebase) | ||
849 | { | ||
850 | // Convert simple 8-bit BPM's to full Q8.8 accum88's if needed | ||
851 | if( beats_per_minute < 256) beats_per_minute <<= 8; | ||
852 | return beat88(beats_per_minute, timebase); | ||
853 | } | ||
854 | |||
855 | /// beat8 generates an 8-bit 'sawtooth' wave at a given BPM | ||
856 | LIB8STATIC uint8_t beat8( accum88 beats_per_minute, uint32_t timebase) | ||
857 | { | ||
858 | return beat16( beats_per_minute, timebase) >> 8; | ||
859 | } | ||
860 | |||
861 | /// beatsin88 generates a 16-bit sine wave at a given BPM, | ||
862 | /// that oscillates within a given range. | ||
863 | /// For this function, BPM MUST BE SPECIFIED as | ||
864 | /// a Q8.8 fixed-point value; e.g. 120BPM must be | ||
865 | /// specified as 120*256 = 30720. | ||
866 | /// If you just want to specify "120", use beatsin16 or beatsin8. | ||
867 | LIB8STATIC uint16_t beatsin88( accum88 beats_per_minute_88, uint16_t lowest, uint16_t highest, uint32_t timebase, uint16_t phase_offset) | ||
868 | { | ||
869 | uint16_t beat = beat88( beats_per_minute_88, timebase); | ||
870 | uint16_t beatsin = (sin16( beat + phase_offset) + 32768); | ||
871 | uint16_t rangewidth = highest - lowest; | ||
872 | uint16_t scaledbeat = scale16( beatsin, rangewidth); | ||
873 | uint16_t result = lowest + scaledbeat; | ||
874 | return result; | ||
875 | } | ||
876 | |||
877 | /// beatsin16 generates a 16-bit sine wave at a given BPM, | ||
878 | /// that oscillates within a given range. | ||
879 | LIB8STATIC uint16_t beatsin16(accum88 beats_per_minute, uint16_t lowest, uint16_t highest, uint32_t timebase, uint16_t phase_offset) | ||
880 | { | ||
881 | uint16_t beat = beat16( beats_per_minute, timebase); | ||
882 | uint16_t beatsin = (sin16( beat + phase_offset) + 32768); | ||
883 | uint16_t rangewidth = highest - lowest; | ||
884 | uint16_t scaledbeat = scale16( beatsin, rangewidth); | ||
885 | uint16_t result = lowest + scaledbeat; | ||
886 | return result; | ||
887 | } | ||
888 | |||
889 | /// beatsin8 generates an 8-bit sine wave at a given BPM, | ||
890 | /// that oscillates within a given range. | ||
891 | LIB8STATIC uint8_t beatsin8( accum88 beats_per_minute, uint8_t lowest, uint8_t highest, uint32_t timebase, uint8_t phase_offset) | ||
892 | { | ||
893 | uint8_t beat = beat8( beats_per_minute, timebase); | ||
894 | uint8_t beatsin = sin8( beat + phase_offset); | ||
895 | uint8_t rangewidth = highest - lowest; | ||
896 | uint8_t scaledbeat = scale8( beatsin, rangewidth); | ||
897 | uint8_t result = lowest + scaledbeat; | ||
898 | return result; | ||
899 | } | ||
900 | |||
901 | |||
902 | /// Return the current seconds since boot in a 16-bit value. Used as part of the | ||
903 | /// "every N time-periods" mechanism | ||
904 | LIB8STATIC uint16_t seconds16(void) | ||
905 | { | ||
906 | uint32_t ms = GET_MILLIS(); | ||
907 | uint16_t s16; | ||
908 | s16 = ms / 1000; | ||
909 | return s16; | ||
910 | } | ||
911 | |||
912 | /// Return the current minutes since boot in a 16-bit value. Used as part of the | ||
913 | /// "every N time-periods" mechanism | ||
914 | LIB8STATIC uint16_t minutes16(void) | ||
915 | { | ||
916 | uint32_t ms = GET_MILLIS(); | ||
917 | uint16_t m16; | ||
918 | m16 = (ms / (60000L)) & 0xFFFF; | ||
919 | return m16; | ||
920 | } | ||
921 | |||
922 | /// Return the current hours since boot in an 8-bit value. Used as part of the | ||
923 | /// "every N time-periods" mechanism | ||
924 | LIB8STATIC uint8_t hours8(void) | ||
925 | { | ||
926 | uint32_t ms = GET_MILLIS(); | ||
927 | uint8_t h8; | ||
928 | h8 = (ms / (3600000L)) & 0xFF; | ||
929 | return h8; | ||
930 | } | ||
931 | |||
932 | ///@} | ||
933 | |||
934 | #endif | ||
diff --git a/lib/lib8tion/math8.h b/lib/lib8tion/math8.h new file mode 100644 index 000000000..8c6b6c227 --- /dev/null +++ b/lib/lib8tion/math8.h | |||
@@ -0,0 +1,552 @@ | |||
1 | #ifndef __INC_LIB8TION_MATH_H | ||
2 | #define __INC_LIB8TION_MATH_H | ||
3 | |||
4 | #include "scale8.h" | ||
5 | |||
6 | ///@ingroup lib8tion | ||
7 | |||
8 | ///@defgroup Math Basic math operations | ||
9 | /// Fast, efficient 8-bit math functions specifically | ||
10 | /// designed for high-performance LED programming. | ||
11 | /// | ||
12 | /// Because of the AVR(Arduino) and ARM assembly language | ||
13 | /// implementations provided, using these functions often | ||
14 | /// results in smaller and faster code than the equivalent | ||
15 | /// program using plain "C" arithmetic and logic. | ||
16 | ///@{ | ||
17 | |||
18 | |||
19 | /// add one byte to another, saturating at 0xFF | ||
20 | /// @param i - first byte to add | ||
21 | /// @param j - second byte to add | ||
22 | /// @returns the sum of i & j, capped at 0xFF | ||
23 | LIB8STATIC_ALWAYS_INLINE uint8_t qadd8( uint8_t i, uint8_t j) | ||
24 | { | ||
25 | #if QADD8_C == 1 | ||
26 | uint16_t t = i + j; | ||
27 | if (t > 255) t = 255; | ||
28 | return t; | ||
29 | #elif QADD8_AVRASM == 1 | ||
30 | asm volatile( | ||
31 | /* First, add j to i, conditioning the C flag */ | ||
32 | "add %0, %1 \n\t" | ||
33 | |||
34 | /* Now test the C flag. | ||
35 | If C is clear, we branch around a load of 0xFF into i. | ||
36 | If C is set, we go ahead and load 0xFF into i. | ||
37 | */ | ||
38 | "brcc L_%= \n\t" | ||
39 | "ldi %0, 0xFF \n\t" | ||
40 | "L_%=: " | ||
41 | : "+a" (i) | ||
42 | : "a" (j) ); | ||
43 | return i; | ||
44 | #elif QADD8_ARM_DSP_ASM == 1 | ||
45 | asm volatile( "uqadd8 %0, %0, %1" : "+r" (i) : "r" (j)); | ||
46 | return i; | ||
47 | #else | ||
48 | #error "No implementation for qadd8 available." | ||
49 | #endif | ||
50 | } | ||
51 | |||
52 | /// Add one byte to another, saturating at 0x7F | ||
53 | /// @param i - first byte to add | ||
54 | /// @param j - second byte to add | ||
55 | /// @returns the sum of i & j, capped at 0xFF | ||
56 | LIB8STATIC_ALWAYS_INLINE int8_t qadd7( int8_t i, int8_t j) | ||
57 | { | ||
58 | #if QADD7_C == 1 | ||
59 | int16_t t = i + j; | ||
60 | if (t > 127) t = 127; | ||
61 | return t; | ||
62 | #elif QADD7_AVRASM == 1 | ||
63 | asm volatile( | ||
64 | /* First, add j to i, conditioning the V flag */ | ||
65 | "add %0, %1 \n\t" | ||
66 | |||
67 | /* Now test the V flag. | ||
68 | If V is clear, we branch around a load of 0x7F into i. | ||
69 | If V is set, we go ahead and load 0x7F into i. | ||
70 | */ | ||
71 | "brvc L_%= \n\t" | ||
72 | "ldi %0, 0x7F \n\t" | ||
73 | "L_%=: " | ||
74 | : "+a" (i) | ||
75 | : "a" (j) ); | ||
76 | |||
77 | return i; | ||
78 | #elif QADD7_ARM_DSP_ASM == 1 | ||
79 | asm volatile( "qadd8 %0, %0, %1" : "+r" (i) : "r" (j)); | ||
80 | return i; | ||
81 | #else | ||
82 | #error "No implementation for qadd7 available." | ||
83 | #endif | ||
84 | } | ||
85 | |||
86 | /// subtract one byte from another, saturating at 0x00 | ||
87 | /// @returns i - j with a floor of 0 | ||
88 | LIB8STATIC_ALWAYS_INLINE uint8_t qsub8( uint8_t i, uint8_t j) | ||
89 | { | ||
90 | #if QSUB8_C == 1 | ||
91 | int16_t t = i - j; | ||
92 | if (t < 0) t = 0; | ||
93 | return t; | ||
94 | #elif QSUB8_AVRASM == 1 | ||
95 | |||
96 | asm volatile( | ||
97 | /* First, subtract j from i, conditioning the C flag */ | ||
98 | "sub %0, %1 \n\t" | ||
99 | |||
100 | /* Now test the C flag. | ||
101 | If C is clear, we branch around a load of 0x00 into i. | ||
102 | If C is set, we go ahead and load 0x00 into i. | ||
103 | */ | ||
104 | "brcc L_%= \n\t" | ||
105 | "ldi %0, 0x00 \n\t" | ||
106 | "L_%=: " | ||
107 | : "+a" (i) | ||
108 | : "a" (j) ); | ||
109 | |||
110 | return i; | ||
111 | #else | ||
112 | #error "No implementation for qsub8 available." | ||
113 | #endif | ||
114 | } | ||
115 | |||
116 | /// add one byte to another, with one byte result | ||
117 | LIB8STATIC_ALWAYS_INLINE uint8_t add8( uint8_t i, uint8_t j) | ||
118 | { | ||
119 | #if ADD8_C == 1 | ||
120 | uint16_t t = i + j; | ||
121 | return t; | ||
122 | #elif ADD8_AVRASM == 1 | ||
123 | // Add j to i, period. | ||
124 | asm volatile( "add %0, %1" : "+a" (i) : "a" (j)); | ||
125 | return i; | ||
126 | #else | ||
127 | #error "No implementation for add8 available." | ||
128 | #endif | ||
129 | } | ||
130 | |||
131 | /// add one byte to another, with one byte result | ||
132 | LIB8STATIC_ALWAYS_INLINE uint16_t add8to16( uint8_t i, uint16_t j) | ||
133 | { | ||
134 | #if ADD8_C == 1 | ||
135 | uint16_t t = i + j; | ||
136 | return t; | ||
137 | #elif ADD8_AVRASM == 1 | ||
138 | // Add i(one byte) to j(two bytes) | ||
139 | asm volatile( "add %A[j], %[i] \n\t" | ||
140 | "adc %B[j], __zero_reg__ \n\t" | ||
141 | : [j] "+a" (j) | ||
142 | : [i] "a" (i) | ||
143 | ); | ||
144 | return i; | ||
145 | #else | ||
146 | #error "No implementation for add8to16 available." | ||
147 | #endif | ||
148 | } | ||
149 | |||
150 | |||
151 | /// subtract one byte from another, 8-bit result | ||
152 | LIB8STATIC_ALWAYS_INLINE uint8_t sub8( uint8_t i, uint8_t j) | ||
153 | { | ||
154 | #if SUB8_C == 1 | ||
155 | int16_t t = i - j; | ||
156 | return t; | ||
157 | #elif SUB8_AVRASM == 1 | ||
158 | // Subtract j from i, period. | ||
159 | asm volatile( "sub %0, %1" : "+a" (i) : "a" (j)); | ||
160 | return i; | ||
161 | #else | ||
162 | #error "No implementation for sub8 available." | ||
163 | #endif | ||
164 | } | ||
165 | |||
166 | /// Calculate an integer average of two unsigned | ||
167 | /// 8-bit integer values (uint8_t). | ||
168 | /// Fractional results are rounded down, e.g. avg8(20,41) = 30 | ||
169 | LIB8STATIC_ALWAYS_INLINE uint8_t avg8( uint8_t i, uint8_t j) | ||
170 | { | ||
171 | #if AVG8_C == 1 | ||
172 | return (i + j) >> 1; | ||
173 | #elif AVG8_AVRASM == 1 | ||
174 | asm volatile( | ||
175 | /* First, add j to i, 9th bit overflows into C flag */ | ||
176 | "add %0, %1 \n\t" | ||
177 | /* Divide by two, moving C flag into high 8th bit */ | ||
178 | "ror %0 \n\t" | ||
179 | : "+a" (i) | ||
180 | : "a" (j) ); | ||
181 | return i; | ||
182 | #else | ||
183 | #error "No implementation for avg8 available." | ||
184 | #endif | ||
185 | } | ||
186 | |||
187 | /// Calculate an integer average of two unsigned | ||
188 | /// 16-bit integer values (uint16_t). | ||
189 | /// Fractional results are rounded down, e.g. avg16(20,41) = 30 | ||
190 | LIB8STATIC_ALWAYS_INLINE uint16_t avg16( uint16_t i, uint16_t j) | ||
191 | { | ||
192 | #if AVG16_C == 1 | ||
193 | return (uint32_t)((uint32_t)(i) + (uint32_t)(j)) >> 1; | ||
194 | #elif AVG16_AVRASM == 1 | ||
195 | asm volatile( | ||
196 | /* First, add jLo (heh) to iLo, 9th bit overflows into C flag */ | ||
197 | "add %A[i], %A[j] \n\t" | ||
198 | /* Now, add C + jHi to iHi, 17th bit overflows into C flag */ | ||
199 | "adc %B[i], %B[j] \n\t" | ||
200 | /* Divide iHi by two, moving C flag into high 16th bit, old 9th bit now in C */ | ||
201 | "ror %B[i] \n\t" | ||
202 | /* Divide iLo by two, moving C flag into high 8th bit */ | ||
203 | "ror %A[i] \n\t" | ||
204 | : [i] "+a" (i) | ||
205 | : [j] "a" (j) ); | ||
206 | return i; | ||
207 | #else | ||
208 | #error "No implementation for avg16 available." | ||
209 | #endif | ||
210 | } | ||
211 | |||
212 | |||
213 | /// Calculate an integer average of two signed 7-bit | ||
214 | /// integers (int8_t) | ||
215 | /// If the first argument is even, result is rounded down. | ||
216 | /// If the first argument is odd, result is result up. | ||
217 | LIB8STATIC_ALWAYS_INLINE int8_t avg7( int8_t i, int8_t j) | ||
218 | { | ||
219 | #if AVG7_C == 1 | ||
220 | return ((i + j) >> 1) + (i & 0x1); | ||
221 | #elif AVG7_AVRASM == 1 | ||
222 | asm volatile( | ||
223 | "asr %1 \n\t" | ||
224 | "asr %0 \n\t" | ||
225 | "adc %0, %1 \n\t" | ||
226 | : "+a" (i) | ||
227 | : "a" (j) ); | ||
228 | return i; | ||
229 | #else | ||
230 | #error "No implementation for avg7 available." | ||
231 | #endif | ||
232 | } | ||
233 | |||
234 | /// Calculate an integer average of two signed 15-bit | ||
235 | /// integers (int16_t) | ||
236 | /// If the first argument is even, result is rounded down. | ||
237 | /// If the first argument is odd, result is result up. | ||
238 | LIB8STATIC_ALWAYS_INLINE int16_t avg15( int16_t i, int16_t j) | ||
239 | { | ||
240 | #if AVG15_C == 1 | ||
241 | return ((int32_t)((int32_t)(i) + (int32_t)(j)) >> 1) + (i & 0x1); | ||
242 | #elif AVG15_AVRASM == 1 | ||
243 | asm volatile( | ||
244 | /* first divide j by 2, throwing away lowest bit */ | ||
245 | "asr %B[j] \n\t" | ||
246 | "ror %A[j] \n\t" | ||
247 | /* now divide i by 2, with lowest bit going into C */ | ||
248 | "asr %B[i] \n\t" | ||
249 | "ror %A[i] \n\t" | ||
250 | /* add j + C to i */ | ||
251 | "adc %A[i], %A[j] \n\t" | ||
252 | "adc %B[i], %B[j] \n\t" | ||
253 | : [i] "+a" (i) | ||
254 | : [j] "a" (j) ); | ||
255 | return i; | ||
256 | #else | ||
257 | #error "No implementation for avg15 available." | ||
258 | #endif | ||
259 | } | ||
260 | |||
261 | |||
262 | /// Calculate the remainder of one unsigned 8-bit | ||
263 | /// value divided by anoter, aka A % M. | ||
264 | /// Implemented by repeated subtraction, which is | ||
265 | /// very compact, and very fast if A is 'probably' | ||
266 | /// less than M. If A is a large multiple of M, | ||
267 | /// the loop has to execute multiple times. However, | ||
268 | /// even in that case, the loop is only two | ||
269 | /// instructions long on AVR, i.e., quick. | ||
270 | LIB8STATIC_ALWAYS_INLINE uint8_t mod8( uint8_t a, uint8_t m) | ||
271 | { | ||
272 | #if defined(__AVR__) | ||
273 | asm volatile ( | ||
274 | "L_%=: sub %[a],%[m] \n\t" | ||
275 | " brcc L_%= \n\t" | ||
276 | " add %[a],%[m] \n\t" | ||
277 | : [a] "+r" (a) | ||
278 | : [m] "r" (m) | ||
279 | ); | ||
280 | #else | ||
281 | while( a >= m) a -= m; | ||
282 | #endif | ||
283 | return a; | ||
284 | } | ||
285 | |||
286 | /// Add two numbers, and calculate the modulo | ||
287 | /// of the sum and a third number, M. | ||
288 | /// In other words, it returns (A+B) % M. | ||
289 | /// It is designed as a compact mechanism for | ||
290 | /// incrementing a 'mode' switch and wrapping | ||
291 | /// around back to 'mode 0' when the switch | ||
292 | /// goes past the end of the available range. | ||
293 | /// e.g. if you have seven modes, this switches | ||
294 | /// to the next one and wraps around if needed: | ||
295 | /// mode = addmod8( mode, 1, 7); | ||
296 | ///LIB8STATIC_ALWAYS_INLINESee 'mod8' for notes on performance. | ||
297 | LIB8STATIC uint8_t addmod8( uint8_t a, uint8_t b, uint8_t m) | ||
298 | { | ||
299 | #if defined(__AVR__) | ||
300 | asm volatile ( | ||
301 | " add %[a],%[b] \n\t" | ||
302 | "L_%=: sub %[a],%[m] \n\t" | ||
303 | " brcc L_%= \n\t" | ||
304 | " add %[a],%[m] \n\t" | ||
305 | : [a] "+r" (a) | ||
306 | : [b] "r" (b), [m] "r" (m) | ||
307 | ); | ||
308 | #else | ||
309 | a += b; | ||
310 | while( a >= m) a -= m; | ||
311 | #endif | ||
312 | return a; | ||
313 | } | ||
314 | |||
315 | /// Subtract two numbers, and calculate the modulo | ||
316 | /// of the difference and a third number, M. | ||
317 | /// In other words, it returns (A-B) % M. | ||
318 | /// It is designed as a compact mechanism for | ||
319 | /// incrementing a 'mode' switch and wrapping | ||
320 | /// around back to 'mode 0' when the switch | ||
321 | /// goes past the end of the available range. | ||
322 | /// e.g. if you have seven modes, this switches | ||
323 | /// to the next one and wraps around if needed: | ||
324 | /// mode = addmod8( mode, 1, 7); | ||
325 | ///LIB8STATIC_ALWAYS_INLINESee 'mod8' for notes on performance. | ||
326 | LIB8STATIC uint8_t submod8( uint8_t a, uint8_t b, uint8_t m) | ||
327 | { | ||
328 | #if defined(__AVR__) | ||
329 | asm volatile ( | ||
330 | " sub %[a],%[b] \n\t" | ||
331 | "L_%=: sub %[a],%[m] \n\t" | ||
332 | " brcc L_%= \n\t" | ||
333 | " add %[a],%[m] \n\t" | ||
334 | : [a] "+r" (a) | ||
335 | : [b] "r" (b), [m] "r" (m) | ||
336 | ); | ||
337 | #else | ||
338 | a -= b; | ||
339 | while( a >= m) a -= m; | ||
340 | #endif | ||
341 | return a; | ||
342 | } | ||
343 | |||
344 | /// 8x8 bit multiplication, with 8 bit result | ||
345 | LIB8STATIC_ALWAYS_INLINE uint8_t mul8( uint8_t i, uint8_t j) | ||
346 | { | ||
347 | #if MUL8_C == 1 | ||
348 | return ((uint16_t)i * (uint16_t)(j) ) & 0xFF; | ||
349 | #elif MUL8_AVRASM == 1 | ||
350 | asm volatile( | ||
351 | /* Multiply 8-bit i * 8-bit j, giving 16-bit r1,r0 */ | ||
352 | "mul %0, %1 \n\t" | ||
353 | /* Extract the LOW 8-bits (r0) */ | ||
354 | "mov %0, r0 \n\t" | ||
355 | /* Restore r1 to "0"; it's expected to always be that */ | ||
356 | "clr __zero_reg__ \n\t" | ||
357 | : "+a" (i) | ||
358 | : "a" (j) | ||
359 | : "r0", "r1"); | ||
360 | |||
361 | return i; | ||
362 | #else | ||
363 | #error "No implementation for mul8 available." | ||
364 | #endif | ||
365 | } | ||
366 | |||
367 | |||
368 | /// saturating 8x8 bit multiplication, with 8 bit result | ||
369 | /// @returns the product of i * j, capping at 0xFF | ||
370 | LIB8STATIC_ALWAYS_INLINE uint8_t qmul8( uint8_t i, uint8_t j) | ||
371 | { | ||
372 | #if QMUL8_C == 1 | ||
373 | int p = ((uint16_t)i * (uint16_t)(j) ); | ||
374 | if( p > 255) p = 255; | ||
375 | return p; | ||
376 | #elif QMUL8_AVRASM == 1 | ||
377 | asm volatile( | ||
378 | /* Multiply 8-bit i * 8-bit j, giving 16-bit r1,r0 */ | ||
379 | " mul %0, %1 \n\t" | ||
380 | /* If high byte of result is zero, all is well. */ | ||
381 | " tst r1 \n\t" | ||
382 | " breq Lnospill_%= \n\t" | ||
383 | /* If high byte of result > 0, saturate low byte to 0xFF */ | ||
384 | " ldi %0,0xFF \n\t" | ||
385 | " rjmp Ldone_%= \n\t" | ||
386 | "Lnospill_%=: \n\t" | ||
387 | /* Extract the LOW 8-bits (r0) */ | ||
388 | " mov %0, r0 \n\t" | ||
389 | "Ldone_%=: \n\t" | ||
390 | /* Restore r1 to "0"; it's expected to always be that */ | ||
391 | " clr __zero_reg__ \n\t" | ||
392 | : "+a" (i) | ||
393 | : "a" (j) | ||
394 | : "r0", "r1"); | ||
395 | |||
396 | return i; | ||
397 | #else | ||
398 | #error "No implementation for qmul8 available." | ||
399 | #endif | ||
400 | } | ||
401 | |||
402 | |||
403 | /// take abs() of a signed 8-bit uint8_t | ||
404 | LIB8STATIC_ALWAYS_INLINE int8_t abs8( int8_t i) | ||
405 | { | ||
406 | #if ABS8_C == 1 | ||
407 | if( i < 0) i = -i; | ||
408 | return i; | ||
409 | #elif ABS8_AVRASM == 1 | ||
410 | |||
411 | |||
412 | asm volatile( | ||
413 | /* First, check the high bit, and prepare to skip if it's clear */ | ||
414 | "sbrc %0, 7 \n" | ||
415 | |||
416 | /* Negate the value */ | ||
417 | "neg %0 \n" | ||
418 | |||
419 | : "+r" (i) : "r" (i) ); | ||
420 | return i; | ||
421 | #else | ||
422 | #error "No implementation for abs8 available." | ||
423 | #endif | ||
424 | } | ||
425 | |||
426 | /// square root for 16-bit integers | ||
427 | /// About three times faster and five times smaller | ||
428 | /// than Arduino's general sqrt on AVR. | ||
429 | LIB8STATIC uint8_t sqrt16(uint16_t x) | ||
430 | { | ||
431 | if( x <= 1) { | ||
432 | return x; | ||
433 | } | ||
434 | |||
435 | uint8_t low = 1; // lower bound | ||
436 | uint8_t hi, mid; | ||
437 | |||
438 | if( x > 7904) { | ||
439 | hi = 255; | ||
440 | } else { | ||
441 | hi = (x >> 5) + 8; // initial estimate for upper bound | ||
442 | } | ||
443 | |||
444 | do { | ||
445 | mid = (low + hi) >> 1; | ||
446 | if ((uint16_t)(mid * mid) > x) { | ||
447 | hi = mid - 1; | ||
448 | } else { | ||
449 | if( mid == 255) { | ||
450 | return 255; | ||
451 | } | ||
452 | low = mid + 1; | ||
453 | } | ||
454 | } while (hi >= low); | ||
455 | |||
456 | return low - 1; | ||
457 | } | ||
458 | |||
459 | /// blend a variable proproportion(0-255) of one byte to another | ||
460 | /// @param a - the starting byte value | ||
461 | /// @param b - the byte value to blend toward | ||
462 | /// @param amountOfB - the proportion (0-255) of b to blend | ||
463 | /// @returns a byte value between a and b, inclusive | ||
464 | #if (FASTLED_BLEND_FIXED == 1) | ||
465 | LIB8STATIC uint8_t blend8( uint8_t a, uint8_t b, uint8_t amountOfB) | ||
466 | { | ||
467 | #if BLEND8_C == 1 | ||
468 | uint16_t partial; | ||
469 | uint8_t result; | ||
470 | |||
471 | uint8_t amountOfA = 255 - amountOfB; | ||
472 | |||
473 | partial = (a * amountOfA); | ||
474 | #if (FASTLED_SCALE8_FIXED == 1) | ||
475 | partial += a; | ||
476 | //partial = add8to16( a, partial); | ||
477 | #endif | ||
478 | |||
479 | partial += (b * amountOfB); | ||
480 | #if (FASTLED_SCALE8_FIXED == 1) | ||
481 | partial += b; | ||
482 | //partial = add8to16( b, partial); | ||
483 | #endif | ||
484 | |||
485 | result = partial >> 8; | ||
486 | |||
487 | return result; | ||
488 | |||
489 | #elif BLEND8_AVRASM == 1 | ||
490 | uint16_t partial; | ||
491 | uint8_t result; | ||
492 | |||
493 | asm volatile ( | ||
494 | /* partial = b * amountOfB */ | ||
495 | " mul %[b], %[amountOfB] \n\t" | ||
496 | " movw %A[partial], r0 \n\t" | ||
497 | |||
498 | /* amountOfB (aka amountOfA) = 255 - amountOfB */ | ||
499 | " com %[amountOfB] \n\t" | ||
500 | |||
501 | /* partial += a * amountOfB (aka amountOfA) */ | ||
502 | " mul %[a], %[amountOfB] \n\t" | ||
503 | |||
504 | " add %A[partial], r0 \n\t" | ||
505 | " adc %B[partial], r1 \n\t" | ||
506 | |||
507 | " clr __zero_reg__ \n\t" | ||
508 | |||
509 | #if (FASTLED_SCALE8_FIXED == 1) | ||
510 | /* partial += a */ | ||
511 | " add %A[partial], %[a] \n\t" | ||
512 | " adc %B[partial], __zero_reg__ \n\t" | ||
513 | |||
514 | // partial += b | ||
515 | " add %A[partial], %[b] \n\t" | ||
516 | " adc %B[partial], __zero_reg__ \n\t" | ||
517 | #endif | ||
518 | |||
519 | : [partial] "=r" (partial), | ||
520 | [amountOfB] "+a" (amountOfB) | ||
521 | : [a] "a" (a), | ||
522 | [b] "a" (b) | ||
523 | : "r0", "r1" | ||
524 | ); | ||
525 | |||
526 | result = partial >> 8; | ||
527 | |||
528 | return result; | ||
529 | |||
530 | #else | ||
531 | #error "No implementation for blend8 available." | ||
532 | #endif | ||
533 | } | ||
534 | |||
535 | #else | ||
536 | LIB8STATIC uint8_t blend8( uint8_t a, uint8_t b, uint8_t amountOfB) | ||
537 | { | ||
538 | // This version loses precision in the integer math | ||
539 | // and can actually return results outside of the range | ||
540 | // from a to b. Its use is not recommended. | ||
541 | uint8_t result; | ||
542 | uint8_t amountOfA = 255 - amountOfB; | ||
543 | result = scale8_LEAVING_R1_DIRTY( a, amountOfA) | ||
544 | + scale8_LEAVING_R1_DIRTY( b, amountOfB); | ||
545 | cleanup_R1(); | ||
546 | return result; | ||
547 | } | ||
548 | #endif | ||
549 | |||
550 | |||
551 | ///@} | ||
552 | #endif | ||
diff --git a/lib/lib8tion/random8.h b/lib/lib8tion/random8.h new file mode 100644 index 000000000..7ee67cbb3 --- /dev/null +++ b/lib/lib8tion/random8.h | |||
@@ -0,0 +1,94 @@ | |||
1 | #ifndef __INC_LIB8TION_RANDOM_H | ||
2 | #define __INC_LIB8TION_RANDOM_H | ||
3 | ///@ingroup lib8tion | ||
4 | |||
5 | ///@defgroup Random Fast random number generators | ||
6 | /// Fast 8- and 16- bit unsigned random numbers. | ||
7 | /// Significantly faster than Arduino random(), but | ||
8 | /// also somewhat less random. You can add entropy. | ||
9 | ///@{ | ||
10 | |||
11 | // X(n+1) = (2053 * X(n)) + 13849) | ||
12 | #define FASTLED_RAND16_2053 ((uint16_t)(2053)) | ||
13 | #define FASTLED_RAND16_13849 ((uint16_t)(13849)) | ||
14 | |||
15 | /// random number seed | ||
16 | extern uint16_t rand16seed;// = RAND16_SEED; | ||
17 | |||
18 | /// Generate an 8-bit random number | ||
19 | LIB8STATIC uint8_t random8(void) | ||
20 | { | ||
21 | rand16seed = (rand16seed * FASTLED_RAND16_2053) + FASTLED_RAND16_13849; | ||
22 | // return the sum of the high and low bytes, for better | ||
23 | // mixing and non-sequential correlation | ||
24 | return (uint8_t)(((uint8_t)(rand16seed & 0xFF)) + | ||
25 | ((uint8_t)(rand16seed >> 8))); | ||
26 | } | ||
27 | |||
28 | /// Generate a 16 bit random number | ||
29 | LIB8STATIC uint16_t random16(void) | ||
30 | { | ||
31 | rand16seed = (rand16seed * FASTLED_RAND16_2053) + FASTLED_RAND16_13849; | ||
32 | return rand16seed; | ||
33 | } | ||
34 | |||
35 | /// Generate an 8-bit random number between 0 and lim | ||
36 | /// @param lim the upper bound for the result | ||
37 | LIB8STATIC uint8_t random8_max(uint8_t lim) | ||
38 | { | ||
39 | uint8_t r = random8(); | ||
40 | r = (r*lim) >> 8; | ||
41 | return r; | ||
42 | } | ||
43 | |||
44 | /// Generate an 8-bit random number in the given range | ||
45 | /// @param min the lower bound for the random number | ||
46 | /// @param lim the upper bound for the random number | ||
47 | LIB8STATIC uint8_t random8_min_max(uint8_t min, uint8_t lim) | ||
48 | { | ||
49 | uint8_t delta = lim - min; | ||
50 | uint8_t r = random8_max(delta) + min; | ||
51 | return r; | ||
52 | } | ||
53 | |||
54 | /// Generate an 16-bit random number between 0 and lim | ||
55 | /// @param lim the upper bound for the result | ||
56 | LIB8STATIC uint16_t random16_max(uint16_t lim) | ||
57 | { | ||
58 | uint16_t r = random16(); | ||
59 | uint32_t p = (uint32_t)lim * (uint32_t)r; | ||
60 | r = p >> 16; | ||
61 | return r; | ||
62 | } | ||
63 | |||
64 | /// Generate an 16-bit random number in the given range | ||
65 | /// @param min the lower bound for the random number | ||
66 | /// @param lim the upper bound for the random number | ||
67 | LIB8STATIC uint16_t random16_min_max( uint16_t min, uint16_t lim) | ||
68 | { | ||
69 | uint16_t delta = lim - min; | ||
70 | uint16_t r = random16_max(delta) + min; | ||
71 | return r; | ||
72 | } | ||
73 | |||
74 | /// Set the 16-bit seed used for the random number generator | ||
75 | LIB8STATIC void random16_set_seed(uint16_t seed) | ||
76 | { | ||
77 | rand16seed = seed; | ||
78 | } | ||
79 | |||
80 | /// Get the current seed value for the random number generator | ||
81 | LIB8STATIC uint16_t random16_get_seed(void) | ||
82 | { | ||
83 | return rand16seed; | ||
84 | } | ||
85 | |||
86 | /// Add entropy into the random number generator | ||
87 | LIB8STATIC void random16_add_entropy(uint16_t entropy) | ||
88 | { | ||
89 | rand16seed += entropy; | ||
90 | } | ||
91 | |||
92 | ///@} | ||
93 | |||
94 | #endif | ||
diff --git a/lib/lib8tion/scale8.h b/lib/lib8tion/scale8.h new file mode 100644 index 000000000..9895fd4d7 --- /dev/null +++ b/lib/lib8tion/scale8.h | |||
@@ -0,0 +1,542 @@ | |||
1 | #ifndef __INC_LIB8TION_SCALE_H | ||
2 | #define __INC_LIB8TION_SCALE_H | ||
3 | |||
4 | ///@ingroup lib8tion | ||
5 | |||
6 | ///@defgroup Scaling Scaling functions | ||
7 | /// Fast, efficient 8-bit scaling functions specifically | ||
8 | /// designed for high-performance LED programming. | ||
9 | /// | ||
10 | /// Because of the AVR(Arduino) and ARM assembly language | ||
11 | /// implementations provided, using these functions often | ||
12 | /// results in smaller and faster code than the equivalent | ||
13 | /// program using plain "C" arithmetic and logic. | ||
14 | ///@{ | ||
15 | |||
16 | /// scale one byte by a second one, which is treated as | ||
17 | /// the numerator of a fraction whose denominator is 256 | ||
18 | /// In other words, it computes i * (scale / 256) | ||
19 | /// 4 clocks AVR with MUL, 2 clocks ARM | ||
20 | LIB8STATIC_ALWAYS_INLINE uint8_t scale8( uint8_t i, fract8 scale) | ||
21 | { | ||
22 | #if SCALE8_C == 1 | ||
23 | #if (FASTLED_SCALE8_FIXED == 1) | ||
24 | return (((uint16_t)i) * (1+(uint16_t)(scale))) >> 8; | ||
25 | #else | ||
26 | return ((uint16_t)i * (uint16_t)(scale) ) >> 8; | ||
27 | #endif | ||
28 | #elif SCALE8_AVRASM == 1 | ||
29 | #if defined(LIB8_ATTINY) | ||
30 | #if (FASTLED_SCALE8_FIXED == 1) | ||
31 | uint8_t work=i; | ||
32 | #else | ||
33 | uint8_t work=0; | ||
34 | #endif | ||
35 | uint8_t cnt=0x80; | ||
36 | asm volatile( | ||
37 | #if (FASTLED_SCALE8_FIXED == 1) | ||
38 | " inc %[scale] \n\t" | ||
39 | " breq DONE_%= \n\t" | ||
40 | " clr %[work] \n\t" | ||
41 | #endif | ||
42 | "LOOP_%=: \n\t" | ||
43 | /*" sbrc %[scale], 0 \n\t" | ||
44 | " add %[work], %[i] \n\t" | ||
45 | " ror %[work] \n\t" | ||
46 | " lsr %[scale] \n\t" | ||
47 | " clc \n\t"*/ | ||
48 | " sbrc %[scale], 0 \n\t" | ||
49 | " add %[work], %[i] \n\t" | ||
50 | " ror %[work] \n\t" | ||
51 | " lsr %[scale] \n\t" | ||
52 | " lsr %[cnt] \n\t" | ||
53 | "brcc LOOP_%= \n\t" | ||
54 | "DONE_%=: \n\t" | ||
55 | : [work] "+r" (work), [cnt] "+r" (cnt) | ||
56 | : [scale] "r" (scale), [i] "r" (i) | ||
57 | : | ||
58 | ); | ||
59 | return work; | ||
60 | #else | ||
61 | asm volatile( | ||
62 | #if (FASTLED_SCALE8_FIXED==1) | ||
63 | // Multiply 8-bit i * 8-bit scale, giving 16-bit r1,r0 | ||
64 | "mul %0, %1 \n\t" | ||
65 | // Add i to r0, possibly setting the carry flag | ||
66 | "add r0, %0 \n\t" | ||
67 | // load the immediate 0 into i (note, this does _not_ touch any flags) | ||
68 | "ldi %0, 0x00 \n\t" | ||
69 | // walk and chew gum at the same time | ||
70 | "adc %0, r1 \n\t" | ||
71 | #else | ||
72 | /* Multiply 8-bit i * 8-bit scale, giving 16-bit r1,r0 */ | ||
73 | "mul %0, %1 \n\t" | ||
74 | /* Move the high 8-bits of the product (r1) back to i */ | ||
75 | "mov %0, r1 \n\t" | ||
76 | /* Restore r1 to "0"; it's expected to always be that */ | ||
77 | #endif | ||
78 | "clr __zero_reg__ \n\t" | ||
79 | |||
80 | : "+a" (i) /* writes to i */ | ||
81 | : "a" (scale) /* uses scale */ | ||
82 | : "r0", "r1" /* clobbers r0, r1 */ ); | ||
83 | |||
84 | /* Return the result */ | ||
85 | return i; | ||
86 | #endif | ||
87 | #else | ||
88 | #error "No implementation for scale8 available." | ||
89 | #endif | ||
90 | } | ||
91 | |||
92 | |||
93 | /// The "video" version of scale8 guarantees that the output will | ||
94 | /// be only be zero if one or both of the inputs are zero. If both | ||
95 | /// inputs are non-zero, the output is guaranteed to be non-zero. | ||
96 | /// This makes for better 'video'/LED dimming, at the cost of | ||
97 | /// several additional cycles. | ||
98 | LIB8STATIC_ALWAYS_INLINE uint8_t scale8_video( uint8_t i, fract8 scale) | ||
99 | { | ||
100 | #if SCALE8_C == 1 || defined(LIB8_ATTINY) | ||
101 | uint8_t j = (((int)i * (int)scale) >> 8) + ((i&&scale)?1:0); | ||
102 | // uint8_t nonzeroscale = (scale != 0) ? 1 : 0; | ||
103 | // uint8_t j = (i == 0) ? 0 : (((int)i * (int)(scale) ) >> 8) + nonzeroscale; | ||
104 | return j; | ||
105 | #elif SCALE8_AVRASM == 1 | ||
106 | uint8_t j=0; | ||
107 | asm volatile( | ||
108 | " tst %[i]\n\t" | ||
109 | " breq L_%=\n\t" | ||
110 | " mul %[i], %[scale]\n\t" | ||
111 | " mov %[j], r1\n\t" | ||
112 | " clr __zero_reg__\n\t" | ||
113 | " cpse %[scale], r1\n\t" | ||
114 | " subi %[j], 0xFF\n\t" | ||
115 | "L_%=: \n\t" | ||
116 | : [j] "+a" (j) | ||
117 | : [i] "a" (i), [scale] "a" (scale) | ||
118 | : "r0", "r1"); | ||
119 | |||
120 | return j; | ||
121 | // uint8_t nonzeroscale = (scale != 0) ? 1 : 0; | ||
122 | // asm volatile( | ||
123 | // " tst %0 \n" | ||
124 | // " breq L_%= \n" | ||
125 | // " mul %0, %1 \n" | ||
126 | // " mov %0, r1 \n" | ||
127 | // " add %0, %2 \n" | ||
128 | // " clr __zero_reg__ \n" | ||
129 | // "L_%=: \n" | ||
130 | |||
131 | // : "+a" (i) | ||
132 | // : "a" (scale), "a" (nonzeroscale) | ||
133 | // : "r0", "r1"); | ||
134 | |||
135 | // // Return the result | ||
136 | // return i; | ||
137 | #else | ||
138 | #error "No implementation for scale8_video available." | ||
139 | #endif | ||
140 | } | ||
141 | |||
142 | |||
143 | /// This version of scale8 does not clean up the R1 register on AVR | ||
144 | /// If you are doing several 'scale8's in a row, use this, and | ||
145 | /// then explicitly call cleanup_R1. | ||
146 | LIB8STATIC_ALWAYS_INLINE uint8_t scale8_LEAVING_R1_DIRTY( uint8_t i, fract8 scale) | ||
147 | { | ||
148 | #if SCALE8_C == 1 | ||
149 | #if (FASTLED_SCALE8_FIXED == 1) | ||
150 | return (((uint16_t)i) * ((uint16_t)(scale)+1)) >> 8; | ||
151 | #else | ||
152 | return ((int)i * (int)(scale) ) >> 8; | ||
153 | #endif | ||
154 | #elif SCALE8_AVRASM == 1 | ||
155 | asm volatile( | ||
156 | #if (FASTLED_SCALE8_FIXED==1) | ||
157 | // Multiply 8-bit i * 8-bit scale, giving 16-bit r1,r0 | ||
158 | "mul %0, %1 \n\t" | ||
159 | // Add i to r0, possibly setting the carry flag | ||
160 | "add r0, %0 \n\t" | ||
161 | // load the immediate 0 into i (note, this does _not_ touch any flags) | ||
162 | "ldi %0, 0x00 \n\t" | ||
163 | // walk and chew gum at the same time | ||
164 | "adc %0, r1 \n\t" | ||
165 | #else | ||
166 | /* Multiply 8-bit i * 8-bit scale, giving 16-bit r1,r0 */ | ||
167 | "mul %0, %1 \n\t" | ||
168 | /* Move the high 8-bits of the product (r1) back to i */ | ||
169 | "mov %0, r1 \n\t" | ||
170 | #endif | ||
171 | /* R1 IS LEFT DIRTY HERE; YOU MUST ZERO IT OUT YOURSELF */ | ||
172 | /* "clr __zero_reg__ \n\t" */ | ||
173 | |||
174 | : "+a" (i) /* writes to i */ | ||
175 | : "a" (scale) /* uses scale */ | ||
176 | : "r0", "r1" /* clobbers r0, r1 */ ); | ||
177 | |||
178 | // Return the result | ||
179 | return i; | ||
180 | #else | ||
181 | #error "No implementation for scale8_LEAVING_R1_DIRTY available." | ||
182 | #endif | ||
183 | } | ||
184 | |||
185 | |||
186 | /// This version of scale8_video does not clean up the R1 register on AVR | ||
187 | /// If you are doing several 'scale8_video's in a row, use this, and | ||
188 | /// then explicitly call cleanup_R1. | ||
189 | LIB8STATIC_ALWAYS_INLINE uint8_t scale8_video_LEAVING_R1_DIRTY( uint8_t i, fract8 scale) | ||
190 | { | ||
191 | #if SCALE8_C == 1 || defined(LIB8_ATTINY) | ||
192 | uint8_t j = (((int)i * (int)scale) >> 8) + ((i&&scale)?1:0); | ||
193 | // uint8_t nonzeroscale = (scale != 0) ? 1 : 0; | ||
194 | // uint8_t j = (i == 0) ? 0 : (((int)i * (int)(scale) ) >> 8) + nonzeroscale; | ||
195 | return j; | ||
196 | #elif SCALE8_AVRASM == 1 | ||
197 | uint8_t j=0; | ||
198 | asm volatile( | ||
199 | " tst %[i]\n\t" | ||
200 | " breq L_%=\n\t" | ||
201 | " mul %[i], %[scale]\n\t" | ||
202 | " mov %[j], r1\n\t" | ||
203 | " breq L_%=\n\t" | ||
204 | " subi %[j], 0xFF\n\t" | ||
205 | "L_%=: \n\t" | ||
206 | : [j] "+a" (j) | ||
207 | : [i] "a" (i), [scale] "a" (scale) | ||
208 | : "r0", "r1"); | ||
209 | |||
210 | return j; | ||
211 | // uint8_t nonzeroscale = (scale != 0) ? 1 : 0; | ||
212 | // asm volatile( | ||
213 | // " tst %0 \n" | ||
214 | // " breq L_%= \n" | ||
215 | // " mul %0, %1 \n" | ||
216 | // " mov %0, r1 \n" | ||
217 | // " add %0, %2 \n" | ||
218 | // " clr __zero_reg__ \n" | ||
219 | // "L_%=: \n" | ||
220 | |||
221 | // : "+a" (i) | ||
222 | // : "a" (scale), "a" (nonzeroscale) | ||
223 | // : "r0", "r1"); | ||
224 | |||
225 | // // Return the result | ||
226 | // return i; | ||
227 | #else | ||
228 | #error "No implementation for scale8_video_LEAVING_R1_DIRTY available." | ||
229 | #endif | ||
230 | } | ||
231 | |||
232 | /// Clean up the r1 register after a series of *LEAVING_R1_DIRTY calls | ||
233 | LIB8STATIC_ALWAYS_INLINE void cleanup_R1(void) | ||
234 | { | ||
235 | #if CLEANUP_R1_AVRASM == 1 | ||
236 | // Restore r1 to "0"; it's expected to always be that | ||
237 | asm volatile( "clr __zero_reg__ \n\t" : : : "r1" ); | ||
238 | #endif | ||
239 | } | ||
240 | |||
241 | |||
242 | /// scale a 16-bit unsigned value by an 8-bit value, | ||
243 | /// considered as numerator of a fraction whose denominator | ||
244 | /// is 256. In other words, it computes i * (scale / 256) | ||
245 | |||
246 | LIB8STATIC_ALWAYS_INLINE uint16_t scale16by8( uint16_t i, fract8 scale ) | ||
247 | { | ||
248 | #if SCALE16BY8_C == 1 | ||
249 | uint16_t result; | ||
250 | #if FASTLED_SCALE8_FIXED == 1 | ||
251 | result = (i * (1+((uint16_t)scale))) >> 8; | ||
252 | #else | ||
253 | result = (i * scale) / 256; | ||
254 | #endif | ||
255 | return result; | ||
256 | #elif SCALE16BY8_AVRASM == 1 | ||
257 | #if FASTLED_SCALE8_FIXED == 1 | ||
258 | uint16_t result = 0; | ||
259 | asm volatile( | ||
260 | // result.A = HighByte( (i.A x scale) + i.A ) | ||
261 | " mul %A[i], %[scale] \n\t" | ||
262 | " add r0, %A[i] \n\t" | ||
263 | // " adc r1, [zero] \n\t" | ||
264 | // " mov %A[result], r1 \n\t" | ||
265 | " adc %A[result], r1 \n\t" | ||
266 | |||
267 | // result.A-B += i.B x scale | ||
268 | " mul %B[i], %[scale] \n\t" | ||
269 | " add %A[result], r0 \n\t" | ||
270 | " adc %B[result], r1 \n\t" | ||
271 | |||
272 | // cleanup r1 | ||
273 | " clr __zero_reg__ \n\t" | ||
274 | |||
275 | // result.A-B += i.B | ||
276 | " add %A[result], %B[i] \n\t" | ||
277 | " adc %B[result], __zero_reg__ \n\t" | ||
278 | |||
279 | : [result] "+r" (result) | ||
280 | : [i] "r" (i), [scale] "r" (scale) | ||
281 | : "r0", "r1" | ||
282 | ); | ||
283 | return result; | ||
284 | #else | ||
285 | uint16_t result = 0; | ||
286 | asm volatile( | ||
287 | // result.A = HighByte(i.A x j ) | ||
288 | " mul %A[i], %[scale] \n\t" | ||
289 | " mov %A[result], r1 \n\t" | ||
290 | //" clr %B[result] \n\t" | ||
291 | |||
292 | // result.A-B += i.B x j | ||
293 | " mul %B[i], %[scale] \n\t" | ||
294 | " add %A[result], r0 \n\t" | ||
295 | " adc %B[result], r1 \n\t" | ||
296 | |||
297 | // cleanup r1 | ||
298 | " clr __zero_reg__ \n\t" | ||
299 | |||
300 | : [result] "+r" (result) | ||
301 | : [i] "r" (i), [scale] "r" (scale) | ||
302 | : "r0", "r1" | ||
303 | ); | ||
304 | return result; | ||
305 | #endif | ||
306 | #else | ||
307 | #error "No implementation for scale16by8 available." | ||
308 | #endif | ||
309 | } | ||
310 | |||
311 | /// scale a 16-bit unsigned value by a 16-bit value, | ||
312 | /// considered as numerator of a fraction whose denominator | ||
313 | /// is 65536. In other words, it computes i * (scale / 65536) | ||
314 | |||
315 | LIB8STATIC uint16_t scale16( uint16_t i, fract16 scale ) | ||
316 | { | ||
317 | #if SCALE16_C == 1 | ||
318 | uint16_t result; | ||
319 | #if FASTLED_SCALE8_FIXED == 1 | ||
320 | result = ((uint32_t)(i) * (1+(uint32_t)(scale))) / 65536; | ||
321 | #else | ||
322 | result = ((uint32_t)(i) * (uint32_t)(scale)) / 65536; | ||
323 | #endif | ||
324 | return result; | ||
325 | #elif SCALE16_AVRASM == 1 | ||
326 | #if FASTLED_SCALE8_FIXED == 1 | ||
327 | // implemented sort of like | ||
328 | // result = ((i * scale) + i ) / 65536 | ||
329 | // | ||
330 | // why not like this, you may ask? | ||
331 | // result = (i * (scale+1)) / 65536 | ||
332 | // the answer is that if scale is 65535, then scale+1 | ||
333 | // will be zero, which is not what we want. | ||
334 | uint32_t result; | ||
335 | asm volatile( | ||
336 | // result.A-B = i.A x scale.A | ||
337 | " mul %A[i], %A[scale] \n\t" | ||
338 | // save results... | ||
339 | // basic idea: | ||
340 | //" mov %A[result], r0 \n\t" | ||
341 | //" mov %B[result], r1 \n\t" | ||
342 | // which can be written as... | ||
343 | " movw %A[result], r0 \n\t" | ||
344 | // Because we're going to add i.A-B to | ||
345 | // result.A-D, we DO need to keep both | ||
346 | // the r0 and r1 portions of the product | ||
347 | // UNlike in the 'unfixed scale8' version. | ||
348 | // So the movw here is needed. | ||
349 | : [result] "=r" (result) | ||
350 | : [i] "r" (i), | ||
351 | [scale] "r" (scale) | ||
352 | : "r0", "r1" | ||
353 | ); | ||
354 | |||
355 | asm volatile( | ||
356 | // result.C-D = i.B x scale.B | ||
357 | " mul %B[i], %B[scale] \n\t" | ||
358 | //" mov %C[result], r0 \n\t" | ||
359 | //" mov %D[result], r1 \n\t" | ||
360 | " movw %C[result], r0 \n\t" | ||
361 | : [result] "+r" (result) | ||
362 | : [i] "r" (i), | ||
363 | [scale] "r" (scale) | ||
364 | : "r0", "r1" | ||
365 | ); | ||
366 | |||
367 | const uint8_t zero = 0; | ||
368 | asm volatile( | ||
369 | // result.B-D += i.B x scale.A | ||
370 | " mul %B[i], %A[scale] \n\t" | ||
371 | |||
372 | " add %B[result], r0 \n\t" | ||
373 | " adc %C[result], r1 \n\t" | ||
374 | " adc %D[result], %[zero] \n\t" | ||
375 | |||
376 | // result.B-D += i.A x scale.B | ||
377 | " mul %A[i], %B[scale] \n\t" | ||
378 | |||
379 | " add %B[result], r0 \n\t" | ||
380 | " adc %C[result], r1 \n\t" | ||
381 | " adc %D[result], %[zero] \n\t" | ||
382 | |||
383 | // cleanup r1 | ||
384 | " clr r1 \n\t" | ||
385 | |||
386 | : [result] "+r" (result) | ||
387 | : [i] "r" (i), | ||
388 | [scale] "r" (scale), | ||
389 | [zero] "r" (zero) | ||
390 | : "r0", "r1" | ||
391 | ); | ||
392 | |||
393 | asm volatile( | ||
394 | // result.A-D += i.A-B | ||
395 | " add %A[result], %A[i] \n\t" | ||
396 | " adc %B[result], %B[i] \n\t" | ||
397 | " adc %C[result], %[zero] \n\t" | ||
398 | " adc %D[result], %[zero] \n\t" | ||
399 | : [result] "+r" (result) | ||
400 | : [i] "r" (i), | ||
401 | [zero] "r" (zero) | ||
402 | ); | ||
403 | |||
404 | result = result >> 16; | ||
405 | return result; | ||
406 | #else | ||
407 | uint32_t result; | ||
408 | asm volatile( | ||
409 | // result.A-B = i.A x scale.A | ||
410 | " mul %A[i], %A[scale] \n\t" | ||
411 | // save results... | ||
412 | // basic idea: | ||
413 | //" mov %A[result], r0 \n\t" | ||
414 | //" mov %B[result], r1 \n\t" | ||
415 | // which can be written as... | ||
416 | " movw %A[result], r0 \n\t" | ||
417 | // We actually don't need to do anything with r0, | ||
418 | // as result.A is never used again here, so we | ||
419 | // could just move the high byte, but movw is | ||
420 | // one clock cycle, just like mov, so might as | ||
421 | // well, in case we want to use this code for | ||
422 | // a generic 16x16 multiply somewhere. | ||
423 | |||
424 | : [result] "=r" (result) | ||
425 | : [i] "r" (i), | ||
426 | [scale] "r" (scale) | ||
427 | : "r0", "r1" | ||
428 | ); | ||
429 | |||
430 | asm volatile( | ||
431 | // result.C-D = i.B x scale.B | ||
432 | " mul %B[i], %B[scale] \n\t" | ||
433 | //" mov %C[result], r0 \n\t" | ||
434 | //" mov %D[result], r1 \n\t" | ||
435 | " movw %C[result], r0 \n\t" | ||
436 | : [result] "+r" (result) | ||
437 | : [i] "r" (i), | ||
438 | [scale] "r" (scale) | ||
439 | : "r0", "r1" | ||
440 | ); | ||
441 | |||
442 | const uint8_t zero = 0; | ||
443 | asm volatile( | ||
444 | // result.B-D += i.B x scale.A | ||
445 | " mul %B[i], %A[scale] \n\t" | ||
446 | |||
447 | " add %B[result], r0 \n\t" | ||
448 | " adc %C[result], r1 \n\t" | ||
449 | " adc %D[result], %[zero] \n\t" | ||
450 | |||
451 | // result.B-D += i.A x scale.B | ||
452 | " mul %A[i], %B[scale] \n\t" | ||
453 | |||
454 | " add %B[result], r0 \n\t" | ||
455 | " adc %C[result], r1 \n\t" | ||
456 | " adc %D[result], %[zero] \n\t" | ||
457 | |||
458 | // cleanup r1 | ||
459 | " clr r1 \n\t" | ||
460 | |||
461 | : [result] "+r" (result) | ||
462 | : [i] "r" (i), | ||
463 | [scale] "r" (scale), | ||
464 | [zero] "r" (zero) | ||
465 | : "r0", "r1" | ||
466 | ); | ||
467 | |||
468 | result = result >> 16; | ||
469 | return result; | ||
470 | #endif | ||
471 | #else | ||
472 | #error "No implementation for scale16 available." | ||
473 | #endif | ||
474 | } | ||
475 | ///@} | ||
476 | |||
477 | ///@defgroup Dimming Dimming and brightening functions | ||
478 | /// | ||
479 | /// Dimming and brightening functions | ||
480 | /// | ||
481 | /// The eye does not respond in a linear way to light. | ||
482 | /// High speed PWM'd LEDs at 50% duty cycle appear far | ||
483 | /// brighter then the 'half as bright' you might expect. | ||
484 | /// | ||
485 | /// If you want your midpoint brightness leve (128) to | ||
486 | /// appear half as bright as 'full' brightness (255), you | ||
487 | /// have to apply a 'dimming function'. | ||
488 | ///@{ | ||
489 | |||
490 | /// Adjust a scaling value for dimming | ||
491 | LIB8STATIC uint8_t dim8_raw( uint8_t x) | ||
492 | { | ||
493 | return scale8( x, x); | ||
494 | } | ||
495 | |||
496 | /// Adjust a scaling value for dimming for video (value will never go below 1) | ||
497 | LIB8STATIC uint8_t dim8_video( uint8_t x) | ||
498 | { | ||
499 | return scale8_video( x, x); | ||
500 | } | ||
501 | |||
502 | /// Linear version of the dimming function that halves for values < 128 | ||
503 | LIB8STATIC uint8_t dim8_lin( uint8_t x ) | ||
504 | { | ||
505 | if( x & 0x80 ) { | ||
506 | x = scale8( x, x); | ||
507 | } else { | ||
508 | x += 1; | ||
509 | x /= 2; | ||
510 | } | ||
511 | return x; | ||
512 | } | ||
513 | |||
514 | /// inverse of the dimming function, brighten a value | ||
515 | LIB8STATIC uint8_t brighten8_raw( uint8_t x) | ||
516 | { | ||
517 | uint8_t ix = 255 - x; | ||
518 | return 255 - scale8( ix, ix); | ||
519 | } | ||
520 | |||
521 | /// inverse of the dimming function, brighten a value | ||
522 | LIB8STATIC uint8_t brighten8_video( uint8_t x) | ||
523 | { | ||
524 | uint8_t ix = 255 - x; | ||
525 | return 255 - scale8_video( ix, ix); | ||
526 | } | ||
527 | |||
528 | /// inverse of the dimming function, brighten a value | ||
529 | LIB8STATIC uint8_t brighten8_lin( uint8_t x ) | ||
530 | { | ||
531 | uint8_t ix = 255 - x; | ||
532 | if( ix & 0x80 ) { | ||
533 | ix = scale8( ix, ix); | ||
534 | } else { | ||
535 | ix += 1; | ||
536 | ix /= 2; | ||
537 | } | ||
538 | return 255 - ix; | ||
539 | } | ||
540 | |||
541 | ///@} | ||
542 | #endif | ||
diff --git a/lib/lib8tion/trig8.h b/lib/lib8tion/trig8.h new file mode 100644 index 000000000..4907c6ff3 --- /dev/null +++ b/lib/lib8tion/trig8.h | |||
@@ -0,0 +1,259 @@ | |||
1 | #ifndef __INC_LIB8TION_TRIG_H | ||
2 | #define __INC_LIB8TION_TRIG_H | ||
3 | |||
4 | ///@ingroup lib8tion | ||
5 | |||
6 | ///@defgroup Trig Fast trig functions | ||
7 | /// Fast 8 and 16-bit approximations of sin(x) and cos(x). | ||
8 | /// Don't use these approximations for calculating the | ||
9 | /// trajectory of a rocket to Mars, but they're great | ||
10 | /// for art projects and LED displays. | ||
11 | /// | ||
12 | /// On Arduino/AVR, the 16-bit approximation is more than | ||
13 | /// 10X faster than floating point sin(x) and cos(x), while | ||
14 | /// the 8-bit approximation is more than 20X faster. | ||
15 | ///@{ | ||
16 | |||
17 | #if defined(__AVR__) | ||
18 | #define sin16 sin16_avr | ||
19 | #else | ||
20 | #define sin16 sin16_C | ||
21 | #endif | ||
22 | |||
23 | /// Fast 16-bit approximation of sin(x). This approximation never varies more than | ||
24 | /// 0.69% from the floating point value you'd get by doing | ||
25 | /// | ||
26 | /// float s = sin(x) * 32767.0; | ||
27 | /// | ||
28 | /// @param theta input angle from 0-65535 | ||
29 | /// @returns sin of theta, value between -32767 to 32767. | ||
30 | LIB8STATIC int16_t sin16_avr( uint16_t theta ) | ||
31 | { | ||
32 | static const uint8_t data[] = | ||
33 | { 0, 0, 49, 0, 6393%256, 6393/256, 48, 0, | ||
34 | 12539%256, 12539/256, 44, 0, 18204%256, 18204/256, 38, 0, | ||
35 | 23170%256, 23170/256, 31, 0, 27245%256, 27245/256, 23, 0, | ||
36 | 30273%256, 30273/256, 14, 0, 32137%256, 32137/256, 4 /*,0*/ }; | ||
37 | |||
38 | uint16_t offset = (theta & 0x3FFF); | ||
39 | |||
40 | // AVR doesn't have a multi-bit shift instruction, | ||
41 | // so if we say "offset >>= 3", gcc makes a tiny loop. | ||
42 | // Inserting empty volatile statements between each | ||
43 | // bit shift forces gcc to unroll the loop. | ||
44 | offset >>= 1; // 0..8191 | ||
45 | asm volatile(""); | ||
46 | offset >>= 1; // 0..4095 | ||
47 | asm volatile(""); | ||
48 | offset >>= 1; // 0..2047 | ||
49 | |||
50 | if( theta & 0x4000 ) offset = 2047 - offset; | ||
51 | |||
52 | uint8_t sectionX4; | ||
53 | sectionX4 = offset / 256; | ||
54 | sectionX4 *= 4; | ||
55 | |||
56 | uint8_t m; | ||
57 | |||
58 | union { | ||
59 | uint16_t b; | ||
60 | struct { | ||
61 | uint8_t blo; | ||
62 | uint8_t bhi; | ||
63 | }; | ||
64 | } u; | ||
65 | |||
66 | //in effect u.b = blo + (256 * bhi); | ||
67 | u.blo = data[ sectionX4 ]; | ||
68 | u.bhi = data[ sectionX4 + 1]; | ||
69 | m = data[ sectionX4 + 2]; | ||
70 | |||
71 | uint8_t secoffset8 = (uint8_t)(offset) / 2; | ||
72 | |||
73 | uint16_t mx = m * secoffset8; | ||
74 | |||
75 | int16_t y = mx + u.b; | ||
76 | if( theta & 0x8000 ) y = -y; | ||
77 | |||
78 | return y; | ||
79 | } | ||
80 | |||
81 | /// Fast 16-bit approximation of sin(x). This approximation never varies more than | ||
82 | /// 0.69% from the floating point value you'd get by doing | ||
83 | /// | ||
84 | /// float s = sin(x) * 32767.0; | ||
85 | /// | ||
86 | /// @param theta input angle from 0-65535 | ||
87 | /// @returns sin of theta, value between -32767 to 32767. | ||
88 | LIB8STATIC int16_t sin16_C( uint16_t theta ) | ||
89 | { | ||
90 | static const uint16_t base[] = | ||
91 | { 0, 6393, 12539, 18204, 23170, 27245, 30273, 32137 }; | ||
92 | static const uint8_t slope[] = | ||
93 | { 49, 48, 44, 38, 31, 23, 14, 4 }; | ||
94 | |||
95 | uint16_t offset = (theta & 0x3FFF) >> 3; // 0..2047 | ||
96 | if( theta & 0x4000 ) offset = 2047 - offset; | ||
97 | |||
98 | uint8_t section = offset / 256; // 0..7 | ||
99 | uint16_t b = base[section]; | ||
100 | uint8_t m = slope[section]; | ||
101 | |||
102 | uint8_t secoffset8 = (uint8_t)(offset) / 2; | ||
103 | |||
104 | uint16_t mx = m * secoffset8; | ||
105 | int16_t y = mx + b; | ||
106 | |||
107 | if( theta & 0x8000 ) y = -y; | ||
108 | |||
109 | return y; | ||
110 | } | ||
111 | |||
112 | |||
113 | /// Fast 16-bit approximation of cos(x). This approximation never varies more than | ||
114 | /// 0.69% from the floating point value you'd get by doing | ||
115 | /// | ||
116 | /// float s = cos(x) * 32767.0; | ||
117 | /// | ||
118 | /// @param theta input angle from 0-65535 | ||
119 | /// @returns sin of theta, value between -32767 to 32767. | ||
120 | LIB8STATIC int16_t cos16( uint16_t theta) | ||
121 | { | ||
122 | return sin16( theta + 16384); | ||
123 | } | ||
124 | |||
125 | /////////////////////////////////////////////////////////////////////// | ||
126 | |||
127 | // sin8 & cos8 | ||
128 | // Fast 8-bit approximations of sin(x) & cos(x). | ||
129 | // Input angle is an unsigned int from 0-255. | ||
130 | // Output is an unsigned int from 0 to 255. | ||
131 | // | ||
132 | // This approximation can vary to to 2% | ||
133 | // from the floating point value you'd get by doing | ||
134 | // float s = (sin( x ) * 128.0) + 128; | ||
135 | // | ||
136 | // Don't use this approximation for calculating the | ||
137 | // "real" trigonometric calculations, but it's great | ||
138 | // for art projects and LED displays. | ||
139 | // | ||
140 | // On Arduino/AVR, this approximation is more than | ||
141 | // 20X faster than floating point sin(x) and cos(x) | ||
142 | |||
143 | #if defined(__AVR__) && !defined(LIB8_ATTINY) | ||
144 | #define sin8 sin8_avr | ||
145 | #else | ||
146 | #define sin8 sin8_C | ||
147 | #endif | ||
148 | |||
149 | |||
150 | const uint8_t b_m16_interleave[] = { 0, 49, 49, 41, 90, 27, 117, 10 }; | ||
151 | |||
152 | /// Fast 8-bit approximation of sin(x). This approximation never varies more than | ||
153 | /// 2% from the floating point value you'd get by doing | ||
154 | /// | ||
155 | /// float s = (sin(x) * 128.0) + 128; | ||
156 | /// | ||
157 | /// @param theta input angle from 0-255 | ||
158 | /// @returns sin of theta, value between 0 and 255 | ||
159 | LIB8STATIC uint8_t sin8_avr( uint8_t theta) | ||
160 | { | ||
161 | uint8_t offset = theta; | ||
162 | |||
163 | asm volatile( | ||
164 | "sbrc %[theta],6 \n\t" | ||
165 | "com %[offset] \n\t" | ||
166 | : [theta] "+r" (theta), [offset] "+r" (offset) | ||
167 | ); | ||
168 | |||
169 | offset &= 0x3F; // 0..63 | ||
170 | |||
171 | uint8_t secoffset = offset & 0x0F; // 0..15 | ||
172 | if( theta & 0x40) secoffset++; | ||
173 | |||
174 | uint8_t m16; uint8_t b; | ||
175 | |||
176 | uint8_t section = offset >> 4; // 0..3 | ||
177 | uint8_t s2 = section * 2; | ||
178 | |||
179 | const uint8_t* p = b_m16_interleave; | ||
180 | p += s2; | ||
181 | b = *p; | ||
182 | p++; | ||
183 | m16 = *p; | ||
184 | |||
185 | uint8_t mx; | ||
186 | uint8_t xr1; | ||
187 | asm volatile( | ||
188 | "mul %[m16],%[secoffset] \n\t" | ||
189 | "mov %[mx],r0 \n\t" | ||
190 | "mov %[xr1],r1 \n\t" | ||
191 | "eor r1, r1 \n\t" | ||
192 | "swap %[mx] \n\t" | ||
193 | "andi %[mx],0x0F \n\t" | ||
194 | "swap %[xr1] \n\t" | ||
195 | "andi %[xr1], 0xF0 \n\t" | ||
196 | "or %[mx], %[xr1] \n\t" | ||
197 | : [mx] "=d" (mx), [xr1] "=d" (xr1) | ||
198 | : [m16] "d" (m16), [secoffset] "d" (secoffset) | ||
199 | ); | ||
200 | |||
201 | int8_t y = mx + b; | ||
202 | if( theta & 0x80 ) y = -y; | ||
203 | |||
204 | y += 128; | ||
205 | |||
206 | return y; | ||
207 | } | ||
208 | |||
209 | |||
210 | /// Fast 8-bit approximation of sin(x). This approximation never varies more than | ||
211 | /// 2% from the floating point value you'd get by doing | ||
212 | /// | ||
213 | /// float s = (sin(x) * 128.0) + 128; | ||
214 | /// | ||
215 | /// @param theta input angle from 0-255 | ||
216 | /// @returns sin of theta, value between 0 and 255 | ||
217 | LIB8STATIC uint8_t sin8_C( uint8_t theta) | ||
218 | { | ||
219 | uint8_t offset = theta; | ||
220 | if( theta & 0x40 ) { | ||
221 | offset = (uint8_t)255 - offset; | ||
222 | } | ||
223 | offset &= 0x3F; // 0..63 | ||
224 | |||
225 | uint8_t secoffset = offset & 0x0F; // 0..15 | ||
226 | if( theta & 0x40) secoffset++; | ||
227 | |||
228 | uint8_t section = offset >> 4; // 0..3 | ||
229 | uint8_t s2 = section * 2; | ||
230 | const uint8_t* p = b_m16_interleave; | ||
231 | p += s2; | ||
232 | uint8_t b = *p; | ||
233 | p++; | ||
234 | uint8_t m16 = *p; | ||
235 | |||
236 | uint8_t mx = (m16 * secoffset) >> 4; | ||
237 | |||
238 | int8_t y = mx + b; | ||
239 | if( theta & 0x80 ) y = -y; | ||
240 | |||
241 | y += 128; | ||
242 | |||
243 | return y; | ||
244 | } | ||
245 | |||
246 | /// Fast 8-bit approximation of cos(x). This approximation never varies more than | ||
247 | /// 2% from the floating point value you'd get by doing | ||
248 | /// | ||
249 | /// float s = (cos(x) * 128.0) + 128; | ||
250 | /// | ||
251 | /// @param theta input angle from 0-255 | ||
252 | /// @returns sin of theta, value between 0 and 255 | ||
253 | LIB8STATIC uint8_t cos8( uint8_t theta) | ||
254 | { | ||
255 | return sin8( theta + 64); | ||
256 | } | ||
257 | |||
258 | ///@} | ||
259 | #endif | ||
diff --git a/quantum/color.c b/quantum/color.c index 8ede053e7..c49877592 100644 --- a/quantum/color.c +++ b/quantum/color.c | |||
@@ -78,9 +78,11 @@ RGB hsv_to_rgb( HSV hsv ) | |||
78 | break; | 78 | break; |
79 | } | 79 | } |
80 | 80 | ||
81 | #ifdef USE_CIE1931_CURVE | ||
81 | rgb.r = pgm_read_byte( &CIE1931_CURVE[rgb.r] ); | 82 | rgb.r = pgm_read_byte( &CIE1931_CURVE[rgb.r] ); |
82 | rgb.g = pgm_read_byte( &CIE1931_CURVE[rgb.g] ); | 83 | rgb.g = pgm_read_byte( &CIE1931_CURVE[rgb.g] ); |
83 | rgb.b = pgm_read_byte( &CIE1931_CURVE[rgb.b] ); | 84 | rgb.b = pgm_read_byte( &CIE1931_CURVE[rgb.b] ); |
85 | #endif | ||
84 | 86 | ||
85 | return rgb; | 87 | return rgb; |
86 | } | 88 | } |
diff --git a/quantum/quantum.c b/quantum/quantum.c index 8316d1f06..8c928441c 100644 --- a/quantum/quantum.c +++ b/quantum/quantum.c | |||
@@ -274,10 +274,10 @@ bool process_record_quantum(keyrecord_t *record) { | |||
274 | #ifdef HAPTIC_ENABLE | 274 | #ifdef HAPTIC_ENABLE |
275 | process_haptic(keycode, record) && | 275 | process_haptic(keycode, record) && |
276 | #endif //HAPTIC_ENABLE | 276 | #endif //HAPTIC_ENABLE |
277 | process_record_kb(keycode, record) && | 277 | #if defined(RGB_MATRIX_ENABLE) && defined(RGB_MATRIX_KEYREACTIVE_ENABLED) |
278 | #if defined(RGB_MATRIX_ENABLE) && defined(RGB_MATRIX_KEYPRESSES) | ||
279 | process_rgb_matrix(keycode, record) && | 278 | process_rgb_matrix(keycode, record) && |
280 | #endif | 279 | #endif |
280 | process_record_kb(keycode, record) && | ||
281 | #if defined(MIDI_ENABLE) && defined(MIDI_ADVANCED) | 281 | #if defined(MIDI_ENABLE) && defined(MIDI_ADVANCED) |
282 | process_midi(keycode, record) && | 282 | process_midi(keycode, record) && |
283 | #endif | 283 | #endif |
@@ -1049,12 +1049,6 @@ void matrix_init_quantum() { | |||
1049 | matrix_init_kb(); | 1049 | matrix_init_kb(); |
1050 | } | 1050 | } |
1051 | 1051 | ||
1052 | uint8_t rgb_matrix_task_counter = 0; | ||
1053 | |||
1054 | #ifndef RGB_MATRIX_SKIP_FRAMES | ||
1055 | #define RGB_MATRIX_SKIP_FRAMES 1 | ||
1056 | #endif | ||
1057 | |||
1058 | void matrix_scan_quantum() { | 1052 | void matrix_scan_quantum() { |
1059 | #if defined(AUDIO_ENABLE) && !defined(NO_MUSIC_MODE) | 1053 | #if defined(AUDIO_ENABLE) && !defined(NO_MUSIC_MODE) |
1060 | matrix_scan_music(); | 1054 | matrix_scan_music(); |
@@ -1078,10 +1072,6 @@ void matrix_scan_quantum() { | |||
1078 | 1072 | ||
1079 | #ifdef RGB_MATRIX_ENABLE | 1073 | #ifdef RGB_MATRIX_ENABLE |
1080 | rgb_matrix_task(); | 1074 | rgb_matrix_task(); |
1081 | if (rgb_matrix_task_counter == 0) { | ||
1082 | rgb_matrix_update_pwm_buffers(); | ||
1083 | } | ||
1084 | rgb_matrix_task_counter = ((rgb_matrix_task_counter + 1) % (RGB_MATRIX_SKIP_FRAMES + 1)); | ||
1085 | #endif | 1075 | #endif |
1086 | 1076 | ||
1087 | #ifdef ENCODER_ENABLE | 1077 | #ifdef ENCODER_ENABLE |
diff --git a/quantum/rgb_matrix.c b/quantum/rgb_matrix.c index 56a97e3c7..0728e2431 100644 --- a/quantum/rgb_matrix.c +++ b/quantum/rgb_matrix.c | |||
@@ -24,62 +24,80 @@ | |||
24 | #include <string.h> | 24 | #include <string.h> |
25 | #include <math.h> | 25 | #include <math.h> |
26 | 26 | ||
27 | rgb_config_t rgb_matrix_config; | 27 | #include "lib/lib8tion/lib8tion.h" |
28 | |||
29 | #include "rgb_matrix_animations/solid_color_anim.h" | ||
30 | #include "rgb_matrix_animations/alpha_mods_anim.h" | ||
31 | #include "rgb_matrix_animations/dual_beacon_anim.h" | ||
32 | #include "rgb_matrix_animations/gradient_up_down_anim.h" | ||
33 | #include "rgb_matrix_animations/raindrops_anim.h" | ||
34 | #include "rgb_matrix_animations/cycle_all_anim.h" | ||
35 | #include "rgb_matrix_animations/cycle_left_right_anim.h" | ||
36 | #include "rgb_matrix_animations/cycle_up_down_anim.h" | ||
37 | #include "rgb_matrix_animations/rainbow_beacon_anim.h" | ||
38 | #include "rgb_matrix_animations/rainbow_pinwheels_anim.h" | ||
39 | #include "rgb_matrix_animations/rainbow_moving_chevron_anim.h" | ||
40 | #include "rgb_matrix_animations/jellybean_raindrops_anim.h" | ||
41 | #include "rgb_matrix_animations/digital_rain_anim.h" | ||
42 | #include "rgb_matrix_animations/solid_reactive_simple_anim.h" | ||
43 | #include "rgb_matrix_animations/solid_reactive_anim.h" | ||
44 | #include "rgb_matrix_animations/splash_anim.h" | ||
45 | #include "rgb_matrix_animations/solid_splash_anim.h" | ||
46 | #include "rgb_matrix_animations/breathing_anim.h" | ||
28 | 47 | ||
29 | #ifndef MAX | 48 | #ifndef RGB_DISABLE_AFTER_TIMEOUT |
30 | #define MAX(X, Y) ((X) > (Y) ? (X) : (Y)) | 49 | #define RGB_DISABLE_AFTER_TIMEOUT 0 |
31 | #endif | 50 | #endif |
32 | 51 | ||
33 | #ifndef MIN | 52 | #ifndef RGB_DISABLE_WHEN_USB_SUSPENDED |
34 | #define MIN(a,b) ((a) < (b)? (a): (b)) | 53 | #define RGB_DISABLE_WHEN_USB_SUSPENDED false |
35 | #endif | 54 | #endif |
36 | 55 | ||
37 | #ifndef RGB_DISABLE_AFTER_TIMEOUT | 56 | #ifndef EECONFIG_RGB_MATRIX |
38 | #define RGB_DISABLE_AFTER_TIMEOUT 0 | 57 | #define EECONFIG_RGB_MATRIX EECONFIG_RGBLIGHT |
39 | #endif | 58 | #endif |
40 | 59 | ||
41 | #ifndef RGB_DISABLE_WHEN_USB_SUSPENDED | 60 | #if !defined(RGB_MATRIX_MAXIMUM_BRIGHTNESS) || RGB_MATRIX_MAXIMUM_BRIGHTNESS > UINT8_MAX |
42 | #define RGB_DISABLE_WHEN_USB_SUSPENDED false | 61 | #undef RGB_MATRIX_MAXIMUM_BRIGHTNESS |
62 | #define RGB_MATRIX_MAXIMUM_BRIGHTNESS UINT8_MAX | ||
43 | #endif | 63 | #endif |
44 | 64 | ||
45 | #ifndef EECONFIG_RGB_MATRIX | 65 | #if !defined(RGB_MATRIX_HUE_STEP) |
46 | #define EECONFIG_RGB_MATRIX EECONFIG_RGBLIGHT | 66 | #define RGB_MATRIX_HUE_STEP 8 |
47 | #endif | 67 | #endif |
48 | 68 | ||
49 | #if !defined(RGB_MATRIX_MAXIMUM_BRIGHTNESS) || RGB_MATRIX_MAXIMUM_BRIGHTNESS > 255 | 69 | #if !defined(RGB_MATRIX_SAT_STEP) |
50 | #define RGB_MATRIX_MAXIMUM_BRIGHTNESS 255 | 70 | #define RGB_MATRIX_SAT_STEP 16 |
51 | #endif | 71 | #endif |
52 | 72 | ||
53 | #ifndef RGB_DIGITAL_RAIN_DROPS | 73 | #if !defined(RGB_MATRIX_VAL_STEP) |
54 | // lower the number for denser effect/wider keyboard | 74 | #define RGB_MATRIX_VAL_STEP 16 |
55 | #define RGB_DIGITAL_RAIN_DROPS 24 | ||
56 | #endif | 75 | #endif |
57 | 76 | ||
58 | #if !defined(DISABLE_RGB_MATRIX_RAINDROPS) || !defined(DISABLE_RGB_MATRIX_JELLYBEAN_RAINDROPS) || !defined(DISABLE_RGB_MATRIX_DIGITAL_RAIN) | 77 | #if !defined(RGB_MATRIX_SPD_STEP) |
59 | #define TRACK_PREVIOUS_EFFECT | 78 | #define RGB_MATRIX_SPD_STEP 16 |
60 | #endif | 79 | #endif |
61 | 80 | ||
62 | bool g_suspend_state = false; | 81 | bool g_suspend_state = false; |
63 | 82 | ||
64 | // Global tick at 20 Hz | 83 | rgb_config_t rgb_matrix_config; |
65 | uint32_t g_tick = 0; | ||
66 | |||
67 | // Ticks since this key was last hit. | ||
68 | uint8_t g_key_hit[DRIVER_LED_TOTAL]; | ||
69 | 84 | ||
70 | // Ticks since any key was last hit. | 85 | rgb_counters_t g_rgb_counters; |
71 | uint32_t g_any_key_hit = 0; | 86 | static uint32_t rgb_counters_buffer; |
72 | 87 | ||
73 | #ifndef PI | 88 | #ifdef RGB_MATRIX_KEYREACTIVE_ENABLED |
74 | #define PI 3.14159265 | 89 | last_hit_t g_last_hit_tracker; |
75 | #endif | 90 | static last_hit_t last_hit_buffer; |
91 | #endif // RGB_MATRIX_KEYREACTIVE_ENABLED | ||
76 | 92 | ||
77 | uint32_t eeconfig_read_rgb_matrix(void) { | 93 | uint32_t eeconfig_read_rgb_matrix(void) { |
78 | return eeprom_read_dword(EECONFIG_RGB_MATRIX); | 94 | return eeprom_read_dword(EECONFIG_RGB_MATRIX); |
79 | } | 95 | } |
96 | |||
80 | void eeconfig_update_rgb_matrix(uint32_t val) { | 97 | void eeconfig_update_rgb_matrix(uint32_t val) { |
81 | eeprom_update_dword(EECONFIG_RGB_MATRIX, val); | 98 | eeprom_update_dword(EECONFIG_RGB_MATRIX, val); |
82 | } | 99 | } |
100 | |||
83 | void eeconfig_update_rgb_matrix_default(void) { | 101 | void eeconfig_update_rgb_matrix_default(void) { |
84 | dprintf("eeconfig_update_rgb_matrix_default\n"); | 102 | dprintf("eeconfig_update_rgb_matrix_default\n"); |
85 | rgb_matrix_config.enable = 1; | 103 | rgb_matrix_config.enable = 1; |
@@ -90,11 +108,12 @@ void eeconfig_update_rgb_matrix_default(void) { | |||
90 | rgb_matrix_config.mode = RGB_MATRIX_SOLID_COLOR; | 108 | rgb_matrix_config.mode = RGB_MATRIX_SOLID_COLOR; |
91 | #endif | 109 | #endif |
92 | rgb_matrix_config.hue = 0; | 110 | rgb_matrix_config.hue = 0; |
93 | rgb_matrix_config.sat = 255; | 111 | rgb_matrix_config.sat = UINT8_MAX; |
94 | rgb_matrix_config.val = RGB_MATRIX_MAXIMUM_BRIGHTNESS; | 112 | rgb_matrix_config.val = RGB_MATRIX_MAXIMUM_BRIGHTNESS; |
95 | rgb_matrix_config.speed = 0; | 113 | rgb_matrix_config.speed = UINT8_MAX / 2; |
96 | eeconfig_update_rgb_matrix(rgb_matrix_config.raw); | 114 | eeconfig_update_rgb_matrix(rgb_matrix_config.raw); |
97 | } | 115 | } |
116 | |||
98 | void eeconfig_debug_rgb_matrix(void) { | 117 | void eeconfig_debug_rgb_matrix(void) { |
99 | dprintf("rgb_matrix_config eprom\n"); | 118 | dprintf("rgb_matrix_config eprom\n"); |
100 | dprintf("rgb_matrix_config.enable = %d\n", rgb_matrix_config.enable); | 119 | dprintf("rgb_matrix_config.enable = %d\n", rgb_matrix_config.enable); |
@@ -105,710 +124,330 @@ void eeconfig_debug_rgb_matrix(void) { | |||
105 | dprintf("rgb_matrix_config.speed = %d\n", rgb_matrix_config.speed); | 124 | dprintf("rgb_matrix_config.speed = %d\n", rgb_matrix_config.speed); |
106 | } | 125 | } |
107 | 126 | ||
108 | // Last led hit | 127 | uint8_t rgb_matrix_map_row_column_to_led(uint8_t row, uint8_t column, uint8_t *led_i) { |
109 | #define LED_HITS_TO_REMEMBER 8 | 128 | // TODO: This is kinda expensive, fix this soonish |
110 | uint8_t g_last_led_hit[LED_HITS_TO_REMEMBER] = {255}; | 129 | uint8_t led_count = 0; |
111 | uint8_t g_last_led_count = 0; | 130 | for (uint8_t i = 0; i < DRIVER_LED_TOTAL && led_count < LED_HITS_TO_REMEMBER; i++) { |
112 | 131 | matrix_co_t matrix_co = g_rgb_leds[i].matrix_co; | |
113 | void map_row_column_to_led( uint8_t row, uint8_t column, uint8_t *led_i, uint8_t *led_count) { | 132 | if (row == matrix_co.row && column == matrix_co.col) { |
114 | rgb_led led; | 133 | led_i[led_count] = i; |
115 | *led_count = 0; | 134 | led_count++; |
116 | |||
117 | for (uint8_t i = 0; i < DRIVER_LED_TOTAL; i++) { | ||
118 | // map_index_to_led(i, &led); | ||
119 | led = g_rgb_leds[i]; | ||
120 | if (row == led.matrix_co.row && column == led.matrix_co.col) { | ||
121 | led_i[*led_count] = i; | ||
122 | (*led_count)++; | ||
123 | } | ||
124 | } | 135 | } |
136 | } | ||
137 | return led_count; | ||
125 | } | 138 | } |
126 | 139 | ||
127 | void rgb_matrix_update_pwm_buffers(void) { | 140 | void rgb_matrix_update_pwm_buffers(void) { |
128 | rgb_matrix_driver.flush(); | 141 | rgb_matrix_driver.flush(); |
129 | } | 142 | } |
130 | 143 | ||
131 | void rgb_matrix_set_color( int index, uint8_t red, uint8_t green, uint8_t blue ) { | 144 | void rgb_matrix_set_color( int index, uint8_t red, uint8_t green, uint8_t blue ) { |
132 | rgb_matrix_driver.set_color(index, red, green, blue); | 145 | rgb_matrix_driver.set_color(index, red, green, blue); |
133 | } | 146 | } |
134 | 147 | ||
135 | void rgb_matrix_set_color_all( uint8_t red, uint8_t green, uint8_t blue ) { | 148 | void rgb_matrix_set_color_all( uint8_t red, uint8_t green, uint8_t blue ) { |
136 | rgb_matrix_driver.set_color_all(red, green, blue); | 149 | rgb_matrix_driver.set_color_all(red, green, blue); |
137 | } | 150 | } |
138 | 151 | ||
139 | bool process_rgb_matrix(uint16_t keycode, keyrecord_t *record) { | 152 | bool process_rgb_matrix(uint16_t keycode, keyrecord_t *record) { |
140 | if ( record->event.pressed ) { | 153 | #ifdef RGB_MATRIX_KEYREACTIVE_ENABLED |
141 | uint8_t led[8], led_count; | 154 | uint8_t led[LED_HITS_TO_REMEMBER]; |
142 | map_row_column_to_led(record->event.key.row, record->event.key.col, led, &led_count); | 155 | uint8_t led_count = 0; |
143 | if (led_count > 0) { | 156 | |
144 | for (uint8_t i = LED_HITS_TO_REMEMBER; i > 1; i--) { | 157 | #if defined(RGB_MATRIX_KEYRELEASES) |
145 | g_last_led_hit[i - 1] = g_last_led_hit[i - 2]; | 158 | if (!record->event.pressed) { |
146 | } | 159 | led_count = rgb_matrix_map_row_column_to_led(record->event.key.row, record->event.key.col, led); |
147 | g_last_led_hit[0] = led[0]; | 160 | g_rgb_counters.any_key_hit = 0; |
148 | g_last_led_count = MIN(LED_HITS_TO_REMEMBER, g_last_led_count + 1); | 161 | } |
149 | } | 162 | #elif defined(RGB_MATRIX_KEYPRESSES) |
150 | for(uint8_t i = 0; i < led_count; i++) | 163 | if (record->event.pressed) { |
151 | g_key_hit[led[i]] = 0; | 164 | led_count = rgb_matrix_map_row_column_to_led(record->event.key.row, record->event.key.col, led); |
152 | g_any_key_hit = 0; | 165 | g_rgb_counters.any_key_hit = 0; |
153 | } else { | 166 | } |
154 | #ifdef RGB_MATRIX_KEYRELEASES | 167 | #endif // defined(RGB_MATRIX_KEYRELEASES) |
155 | uint8_t led[8], led_count; | 168 | |
156 | map_row_column_to_led(record->event.key.row, record->event.key.col, led, &led_count); | 169 | if (last_hit_buffer.count + led_count > LED_HITS_TO_REMEMBER) { |
157 | for(uint8_t i = 0; i < led_count; i++) | 170 | memcpy(&last_hit_buffer.x[0], &last_hit_buffer.x[led_count], LED_HITS_TO_REMEMBER - led_count); |
158 | g_key_hit[led[i]] = 255; | 171 | memcpy(&last_hit_buffer.y[0], &last_hit_buffer.y[led_count], LED_HITS_TO_REMEMBER - led_count); |
159 | 172 | memcpy(&last_hit_buffer.tick[0], &last_hit_buffer.tick[led_count], (LED_HITS_TO_REMEMBER - led_count) * 2); // 16 bit | |
160 | g_any_key_hit = 255; | 173 | memcpy(&last_hit_buffer.index[0], &last_hit_buffer.index[led_count], LED_HITS_TO_REMEMBER - led_count); |
161 | #endif | 174 | last_hit_buffer.count--; |
162 | } | 175 | } |
163 | return true; | ||
164 | } | ||
165 | 176 | ||
166 | void rgb_matrix_set_suspend_state(bool state) { | 177 | for(uint8_t i = 0; i < led_count; i++) { |
167 | g_suspend_state = state; | 178 | uint8_t index = last_hit_buffer.count; |
179 | last_hit_buffer.x[index] = g_rgb_leds[led[i]].point.x; | ||
180 | last_hit_buffer.y[index] = g_rgb_leds[led[i]].point.y; | ||
181 | last_hit_buffer.index[index] = led[i]; | ||
182 | last_hit_buffer.tick[index] = 0; | ||
183 | last_hit_buffer.count++; | ||
184 | } | ||
185 | #endif // RGB_MATRIX_KEYREACTIVE_ENABLED | ||
186 | return true; | ||
168 | } | 187 | } |
169 | 188 | ||
170 | void rgb_matrix_test(void) { | 189 | void rgb_matrix_test(void) { |
171 | // Mask out bits 4 and 5 | 190 | // Mask out bits 4 and 5 |
172 | // Increase the factor to make the test animation slower (and reduce to make it faster) | 191 | // Increase the factor to make the test animation slower (and reduce to make it faster) |
173 | uint8_t factor = 10; | 192 | uint8_t factor = 10; |
174 | switch ( (g_tick & (0b11 << factor)) >> factor ) | 193 | switch ( (g_rgb_counters.tick & (0b11 << factor)) >> factor ) |
175 | { | 194 | { |
176 | case 0: | 195 | case 0: { |
177 | { | 196 | rgb_matrix_set_color_all( 20, 0, 0 ); |
178 | rgb_matrix_set_color_all( 20, 0, 0 ); | 197 | break; |
179 | break; | ||
180 | } | ||
181 | case 1: | ||
182 | { | ||
183 | rgb_matrix_set_color_all( 0, 20, 0 ); | ||
184 | break; | ||
185 | } | ||
186 | case 2: | ||
187 | { | ||
188 | rgb_matrix_set_color_all( 0, 0, 20 ); | ||
189 | break; | ||
190 | } | ||
191 | case 3: | ||
192 | { | ||
193 | rgb_matrix_set_color_all( 20, 20, 20 ); | ||
194 | break; | ||
195 | } | ||
196 | } | 198 | } |
197 | } | 199 | case 1: { |
198 | 200 | rgb_matrix_set_color_all( 0, 20, 0 ); | |
199 | // All LEDs off | 201 | break; |
200 | void rgb_matrix_all_off(void) { | ||
201 | rgb_matrix_set_color_all( 0, 0, 0 ); | ||
202 | } | ||
203 | |||
204 | // Solid color | ||
205 | void rgb_matrix_solid_color(void) { | ||
206 | HSV hsv = { .h = rgb_matrix_config.hue, .s = rgb_matrix_config.sat, .v = rgb_matrix_config.val }; | ||
207 | RGB rgb = hsv_to_rgb( hsv ); | ||
208 | rgb_matrix_set_color_all( rgb.r, rgb.g, rgb.b ); | ||
209 | } | ||
210 | |||
211 | void rgb_matrix_solid_reactive(void) { | ||
212 | // Relies on hue being 8-bit and wrapping | ||
213 | for ( int i=0; i<DRIVER_LED_TOTAL; i++ ) | ||
214 | { | ||
215 | uint16_t offset2 = g_key_hit[i]<<2; | ||
216 | offset2 = (offset2<=130) ? (130-offset2) : 0; | ||
217 | |||
218 | HSV hsv = { .h = rgb_matrix_config.hue+offset2, .s = 255, .v = rgb_matrix_config.val }; | ||
219 | RGB rgb = hsv_to_rgb( hsv ); | ||
220 | rgb_matrix_set_color( i, rgb.r, rgb.g, rgb.b ); | ||
221 | } | ||
222 | } | ||
223 | |||
224 | void rgb_matrix_solid_reactive_simple(void) | ||
225 | { | ||
226 | HSV hsv = {.h = rgb_matrix_config.hue, .s = rgb_matrix_config.sat, .v = rgb_matrix_config.val}; | ||
227 | RGB rgb; | ||
228 | |||
229 | for (int i = 0; i < DRIVER_LED_TOTAL; i++) { | ||
230 | uint16_t offset2 = g_key_hit[i] << 2; | ||
231 | offset2 = (offset2 <= 255) ? (255 - offset2) : 0; | ||
232 | hsv.v = offset2 * rgb_matrix_config.val / RGB_MATRIX_MAXIMUM_BRIGHTNESS; | ||
233 | rgb = hsv_to_rgb(hsv); | ||
234 | rgb_matrix_set_color(i, rgb.r, rgb.g, rgb.b); | ||
235 | } | ||
236 | } | ||
237 | |||
238 | // alphas = color1, mods = color2 | ||
239 | void rgb_matrix_alphas_mods(void) { | ||
240 | |||
241 | RGB rgb1 = hsv_to_rgb( (HSV){ .h = rgb_matrix_config.hue, .s = rgb_matrix_config.sat, .v = rgb_matrix_config.val } ); | ||
242 | RGB rgb2 = hsv_to_rgb( (HSV){ .h = (rgb_matrix_config.hue + 180) % 360, .s = rgb_matrix_config.sat, .v = rgb_matrix_config.val } ); | ||
243 | |||
244 | rgb_led led; | ||
245 | for (int i = 0; i < DRIVER_LED_TOTAL; i++) { | ||
246 | led = g_rgb_leds[i]; | ||
247 | if ( led.matrix_co.raw < 0xFF ) { | ||
248 | if ( led.modifier ) | ||
249 | { | ||
250 | rgb_matrix_set_color( i, rgb2.r, rgb2.g, rgb2.b ); | ||
251 | } | ||
252 | else | ||
253 | { | ||
254 | rgb_matrix_set_color( i, rgb1.r, rgb1.g, rgb1.b ); | ||
255 | } | ||
256 | } | ||
257 | } | ||
258 | } | ||
259 | |||
260 | void rgb_matrix_gradient_up_down(void) { | ||
261 | int16_t h1 = rgb_matrix_config.hue; | ||
262 | int16_t h2 = (rgb_matrix_config.hue + 180) % 360; | ||
263 | int16_t deltaH = h2 - h1; | ||
264 | |||
265 | // Take the shortest path between hues | ||
266 | if ( deltaH > 127 ) | ||
267 | { | ||
268 | deltaH -= 256; | ||
269 | } | ||
270 | else if ( deltaH < -127 ) | ||
271 | { | ||
272 | deltaH += 256; | ||
273 | } | ||
274 | // Divide delta by 4, this gives the delta per row | ||
275 | deltaH /= 4; | ||
276 | |||
277 | int16_t s1 = rgb_matrix_config.sat; | ||
278 | int16_t s2 = rgb_matrix_config.hue; | ||
279 | int16_t deltaS = ( s2 - s1 ) / 4; | ||
280 | |||
281 | HSV hsv = { .h = 0, .s = 255, .v = rgb_matrix_config.val }; | ||
282 | RGB rgb; | ||
283 | Point point; | ||
284 | for ( int i=0; i<DRIVER_LED_TOTAL; i++ ) | ||
285 | { | ||
286 | // map_led_to_point( i, &point ); | ||
287 | point = g_rgb_leds[i].point; | ||
288 | // The y range will be 0..64, map this to 0..4 | ||
289 | uint8_t y = (point.y>>4); | ||
290 | // Relies on hue being 8-bit and wrapping | ||
291 | hsv.h = rgb_matrix_config.hue + ( deltaH * y ); | ||
292 | hsv.s = rgb_matrix_config.sat + ( deltaS * y ); | ||
293 | rgb = hsv_to_rgb( hsv ); | ||
294 | rgb_matrix_set_color( i, rgb.r, rgb.g, rgb.b ); | ||
295 | } | ||
296 | } | ||
297 | |||
298 | void rgb_matrix_raindrops(bool initialize) { | ||
299 | int16_t h1 = rgb_matrix_config.hue; | ||
300 | int16_t h2 = (rgb_matrix_config.hue + 180) % 360; | ||
301 | int16_t deltaH = h2 - h1; | ||
302 | deltaH /= 4; | ||
303 | |||
304 | // Take the shortest path between hues | ||
305 | if ( deltaH > 127 ) | ||
306 | { | ||
307 | deltaH -= 256; | ||
308 | } | 202 | } |
309 | else if ( deltaH < -127 ) | 203 | case 2: { |
310 | { | 204 | rgb_matrix_set_color_all( 0, 0, 20 ); |
311 | deltaH += 256; | 205 | break; |
312 | } | 206 | } |
313 | 207 | case 3: { | |
314 | int16_t s1 = rgb_matrix_config.sat; | 208 | rgb_matrix_set_color_all( 20, 20, 20 ); |
315 | int16_t s2 = rgb_matrix_config.sat; | 209 | break; |
316 | int16_t deltaS = ( s2 - s1 ) / 4; | ||
317 | |||
318 | HSV hsv; | ||
319 | RGB rgb; | ||
320 | |||
321 | // Change one LED every tick, make sure speed is not 0 | ||
322 | uint8_t led_to_change = ( g_tick & ( 0x0A / (rgb_matrix_config.speed == 0 ? 1 : rgb_matrix_config.speed) ) ) == 0 ? rand() % (DRIVER_LED_TOTAL) : 255; | ||
323 | |||
324 | for ( int i=0; i<DRIVER_LED_TOTAL; i++ ) | ||
325 | { | ||
326 | // If initialize, all get set to random colors | ||
327 | // If not, all but one will stay the same as before. | ||
328 | if ( initialize || i == led_to_change ) | ||
329 | { | ||
330 | hsv.h = h1 + ( deltaH * ( rand() & 0x03 ) ); | ||
331 | hsv.s = s1 + ( deltaS * ( rand() & 0x03 ) ); | ||
332 | // Override brightness with global brightness control | ||
333 | hsv.v = rgb_matrix_config.val; | ||
334 | |||
335 | rgb = hsv_to_rgb( hsv ); | ||
336 | rgb_matrix_set_color( i, rgb.r, rgb.g, rgb.b ); | ||
337 | } | ||
338 | } | ||
339 | } | ||
340 | |||
341 | void rgb_matrix_cycle_all(void) { | ||
342 | uint8_t offset = ( g_tick << rgb_matrix_config.speed ) & 0xFF; | ||
343 | |||
344 | rgb_led led; | ||
345 | |||
346 | // Relies on hue being 8-bit and wrapping | ||
347 | for ( int i=0; i<DRIVER_LED_TOTAL; i++ ) | ||
348 | { | ||
349 | // map_index_to_led(i, &led); | ||
350 | led = g_rgb_leds[i]; | ||
351 | if (led.matrix_co.raw < 0xFF) { | ||
352 | uint16_t offset2 = g_key_hit[i]<<2; | ||
353 | offset2 = (offset2<=63) ? (63-offset2) : 0; | ||
354 | |||
355 | HSV hsv = { .h = offset+offset2, .s = 255, .v = rgb_matrix_config.val }; | ||
356 | RGB rgb = hsv_to_rgb( hsv ); | ||
357 | rgb_matrix_set_color( i, rgb.r, rgb.g, rgb.b ); | ||
358 | } | ||
359 | } | ||
360 | } | ||
361 | |||
362 | void rgb_matrix_cycle_left_right(void) { | ||
363 | uint8_t offset = ( g_tick << rgb_matrix_config.speed ) & 0xFF; | ||
364 | HSV hsv = { .h = 0, .s = 255, .v = rgb_matrix_config.val }; | ||
365 | RGB rgb; | ||
366 | Point point; | ||
367 | rgb_led led; | ||
368 | for ( int i=0; i<DRIVER_LED_TOTAL; i++ ) | ||
369 | { | ||
370 | // map_index_to_led(i, &led); | ||
371 | led = g_rgb_leds[i]; | ||
372 | if (led.matrix_co.raw < 0xFF) { | ||
373 | uint16_t offset2 = g_key_hit[i]<<2; | ||
374 | offset2 = (offset2<=63) ? (63-offset2) : 0; | ||
375 | |||
376 | // map_led_to_point( i, &point ); | ||
377 | point = g_rgb_leds[i].point; | ||
378 | // Relies on hue being 8-bit and wrapping | ||
379 | hsv.h = point.x + offset + offset2; | ||
380 | rgb = hsv_to_rgb( hsv ); | ||
381 | rgb_matrix_set_color( i, rgb.r, rgb.g, rgb.b ); | ||
382 | } | ||
383 | } | ||
384 | } | ||
385 | |||
386 | void rgb_matrix_cycle_up_down(void) { | ||
387 | uint8_t offset = ( g_tick << rgb_matrix_config.speed ) & 0xFF; | ||
388 | HSV hsv = { .h = 0, .s = 255, .v = rgb_matrix_config.val }; | ||
389 | RGB rgb; | ||
390 | Point point; | ||
391 | rgb_led led; | ||
392 | for ( int i=0; i<DRIVER_LED_TOTAL; i++ ) | ||
393 | { | ||
394 | // map_index_to_led(i, &led); | ||
395 | led = g_rgb_leds[i]; | ||
396 | if (led.matrix_co.raw < 0xFF) { | ||
397 | uint16_t offset2 = g_key_hit[i]<<2; | ||
398 | offset2 = (offset2<=63) ? (63-offset2) : 0; | ||
399 | |||
400 | // map_led_to_point( i, &point ); | ||
401 | point = g_rgb_leds[i].point; | ||
402 | // Relies on hue being 8-bit and wrapping | ||
403 | hsv.h = point.y + offset + offset2; | ||
404 | rgb = hsv_to_rgb( hsv ); | ||
405 | rgb_matrix_set_color( i, rgb.r, rgb.g, rgb.b ); | ||
406 | } | ||
407 | } | 210 | } |
211 | } | ||
408 | } | 212 | } |
409 | 213 | ||
214 | static bool rgb_matrix_none(effect_params_t* params) { | ||
215 | if (!params->init) { | ||
216 | return false; | ||
217 | } | ||
410 | 218 | ||
411 | void rgb_matrix_dual_beacon(void) { | 219 | RGB_MATRIX_USE_LIMITS(led_min, led_max); |
412 | HSV hsv = { .h = rgb_matrix_config.hue, .s = rgb_matrix_config.sat, .v = rgb_matrix_config.val }; | 220 | for (uint8_t i = led_min; i < led_max; i++) { |
413 | RGB rgb; | 221 | rgb_matrix_set_color(i, 0, 0, 0); |
414 | Point point; | 222 | } |
415 | double cos_value = cos(g_tick * PI / 128) / 32; | 223 | return led_max < DRIVER_LED_TOTAL; |
416 | double sin_value = sin(g_tick * PI / 128) / 112; | ||
417 | for (uint8_t i = 0; i < DRIVER_LED_TOTAL; i++) { | ||
418 | point = g_rgb_leds[i].point; | ||
419 | hsv.h = ((point.y - 32.0)* cos_value + (point.x - 112.0) * sin_value) * (180) + rgb_matrix_config.hue; | ||
420 | rgb = hsv_to_rgb( hsv ); | ||
421 | rgb_matrix_set_color( i, rgb.r, rgb.g, rgb.b ); | ||
422 | } | ||
423 | } | 224 | } |
424 | 225 | ||
425 | void rgb_matrix_rainbow_beacon(void) { | 226 | static uint8_t rgb_last_enable = UINT8_MAX; |
426 | HSV hsv = { .h = rgb_matrix_config.hue, .s = rgb_matrix_config.sat, .v = rgb_matrix_config.val }; | 227 | static uint8_t rgb_last_effect = UINT8_MAX; |
427 | RGB rgb; | 228 | static effect_params_t rgb_effect_params = { 0, 0 }; |
428 | Point point; | 229 | static rgb_task_states rgb_task_state = SYNCING; |
429 | double cos_value = cos(g_tick * PI / 128); | ||
430 | double sin_value = sin(g_tick * PI / 128); | ||
431 | for (uint8_t i = 0; i < DRIVER_LED_TOTAL; i++) { | ||
432 | point = g_rgb_leds[i].point; | ||
433 | hsv.h = (1.5 * (rgb_matrix_config.speed == 0 ? 1 : rgb_matrix_config.speed)) * (point.y - 32.0)* cos_value + (1.5 * (rgb_matrix_config.speed == 0 ? 1 : rgb_matrix_config.speed)) * (point.x - 112.0) * sin_value + rgb_matrix_config.hue; | ||
434 | rgb = hsv_to_rgb( hsv ); | ||
435 | rgb_matrix_set_color( i, rgb.r, rgb.g, rgb.b ); | ||
436 | } | ||
437 | } | ||
438 | 230 | ||
439 | void rgb_matrix_rainbow_pinwheels(void) { | 231 | static void rgb_task_timers(void) { |
440 | HSV hsv = { .h = rgb_matrix_config.hue, .s = rgb_matrix_config.sat, .v = rgb_matrix_config.val }; | 232 | // Update double buffer timers |
441 | RGB rgb; | 233 | uint16_t deltaTime = timer_elapsed32(rgb_counters_buffer); |
442 | Point point; | 234 | rgb_counters_buffer = timer_read32(); |
443 | double cos_value = cos(g_tick * PI / 128); | 235 | if (g_rgb_counters.any_key_hit < UINT32_MAX) { |
444 | double sin_value = sin(g_tick * PI / 128); | 236 | if (UINT32_MAX - deltaTime < g_rgb_counters.any_key_hit) { |
445 | for (uint8_t i = 0; i < DRIVER_LED_TOTAL; i++) { | 237 | g_rgb_counters.any_key_hit = UINT32_MAX; |
446 | point = g_rgb_leds[i].point; | 238 | } else { |
447 | hsv.h = (2 * (rgb_matrix_config.speed == 0 ? 1 : rgb_matrix_config.speed)) * (point.y - 32.0)* cos_value + (2 * (rgb_matrix_config.speed == 0 ? 1 : rgb_matrix_config.speed)) * (66 - abs(point.x - 112.0)) * sin_value + rgb_matrix_config.hue; | 239 | g_rgb_counters.any_key_hit += deltaTime; |
448 | rgb = hsv_to_rgb( hsv ); | ||
449 | rgb_matrix_set_color( i, rgb.r, rgb.g, rgb.b ); | ||
450 | } | 240 | } |
451 | } | 241 | } |
452 | 242 | ||
453 | void rgb_matrix_rainbow_moving_chevron(void) { | 243 | // Update double buffer last hit timers |
454 | HSV hsv = { .h = rgb_matrix_config.hue, .s = rgb_matrix_config.sat, .v = rgb_matrix_config.val }; | 244 | #ifdef RGB_MATRIX_KEYREACTIVE_ENABLED |
455 | RGB rgb; | 245 | uint8_t count = last_hit_buffer.count; |
456 | Point point; | 246 | for (uint8_t i = 0; i < count; ++i) { |
457 | uint8_t r = 128; | 247 | if (UINT16_MAX - deltaTime < last_hit_buffer.tick[i]) { |
458 | double cos_value = cos(r * PI / 128); | 248 | last_hit_buffer.count--; |
459 | double sin_value = sin(r * PI / 128); | 249 | continue; |
460 | double multiplier = (g_tick / 256.0 * 224); | ||
461 | for (uint8_t i = 0; i < DRIVER_LED_TOTAL; i++) { | ||
462 | point = g_rgb_leds[i].point; | ||
463 | hsv.h = (1.5 * (rgb_matrix_config.speed == 0 ? 1 : rgb_matrix_config.speed)) * abs(point.y - 32.0)* sin_value + (1.5 * (rgb_matrix_config.speed == 0 ? 1 : rgb_matrix_config.speed)) * (point.x - multiplier) * cos_value + rgb_matrix_config.hue; | ||
464 | rgb = hsv_to_rgb( hsv ); | ||
465 | rgb_matrix_set_color( i, rgb.r, rgb.g, rgb.b ); | ||
466 | } | 250 | } |
467 | } | 251 | last_hit_buffer.tick[i] += deltaTime; |
468 | 252 | } | |
469 | 253 | #endif // RGB_MATRIX_KEYREACTIVE_ENABLED | |
470 | void rgb_matrix_jellybean_raindrops( bool initialize ) { | 254 | } |
471 | HSV hsv; | 255 | |
472 | RGB rgb; | 256 | static void rgb_task_sync(void) { |
257 | // next task | ||
258 | if (timer_elapsed32(g_rgb_counters.tick) >= RGB_MATRIX_LED_FLUSH_LIMIT) | ||
259 | rgb_task_state = STARTING; | ||
260 | } | ||
261 | |||
262 | static void rgb_task_start(void) { | ||
263 | // reset iter | ||
264 | rgb_effect_params.iter = 0; | ||
265 | |||
266 | // update double buffers | ||
267 | g_rgb_counters.tick = rgb_counters_buffer; | ||
268 | #ifdef RGB_MATRIX_KEYREACTIVE_ENABLED | ||
269 | g_last_hit_tracker = last_hit_buffer; | ||
270 | #endif // RGB_MATRIX_KEYREACTIVE_ENABLED | ||
271 | |||
272 | // next task | ||
273 | rgb_task_state = RENDERING; | ||
274 | } | ||
275 | |||
276 | static void rgb_task_render(uint8_t effect) { | ||
277 | bool rendering = false; | ||
278 | rgb_effect_params.init = (effect != rgb_last_effect) || (rgb_matrix_config.enable != rgb_last_enable); | ||
279 | |||
280 | // each effect can opt to do calculations | ||
281 | // and/or request PWM buffer updates. | ||
282 | switch (effect) { | ||
283 | case RGB_MATRIX_NONE: | ||
284 | rendering = rgb_matrix_none(&rgb_effect_params); | ||
285 | break; | ||
286 | |||
287 | case RGB_MATRIX_SOLID_COLOR: | ||
288 | rendering = rgb_matrix_solid_color(&rgb_effect_params); // Max 1ms Avg 0ms | ||
289 | break; | ||
290 | #ifndef DISABLE_RGB_MATRIX_ALPHAS_MODS | ||
291 | case RGB_MATRIX_ALPHAS_MODS: | ||
292 | rendering = rgb_matrix_alphas_mods(&rgb_effect_params); // Max 2ms Avg 1ms | ||
293 | break; | ||
294 | #endif // DISABLE_RGB_MATRIX_ALPHAS_MODS | ||
295 | #ifndef DISABLE_RGB_MATRIX_GRADIENT_UP_DOWN | ||
296 | case RGB_MATRIX_GRADIENT_UP_DOWN: | ||
297 | rendering = rgb_matrix_gradient_up_down(&rgb_effect_params); // Max 4ms Avg 3ms | ||
298 | break; | ||
299 | #endif // DISABLE_RGB_MATRIX_GRADIENT_UP_DOWN | ||
300 | #ifndef DISABLE_RGB_MATRIX_BREATHING | ||
301 | case RGB_MATRIX_BREATHING: | ||
302 | rendering = rgb_matrix_breathing(&rgb_effect_params); // Max 1ms Avg 0ms | ||
303 | break; | ||
304 | #endif // DISABLE_RGB_MATRIX_BREATHING | ||
305 | #ifndef DISABLE_RGB_MATRIX_CYCLE_ALL | ||
306 | case RGB_MATRIX_CYCLE_ALL: | ||
307 | rendering = rgb_matrix_cycle_all(&rgb_effect_params); // Max 4ms Avg 3ms | ||
308 | break; | ||
309 | #endif // DISABLE_RGB_MATRIX_CYCLE_ALL | ||
310 | #ifndef DISABLE_RGB_MATRIX_CYCLE_LEFT_RIGHT | ||
311 | case RGB_MATRIX_CYCLE_LEFT_RIGHT: | ||
312 | rendering = rgb_matrix_cycle_left_right(&rgb_effect_params); // Max 4ms Avg 3ms | ||
313 | break; | ||
314 | #endif // DISABLE_RGB_MATRIX_CYCLE_LEFT_RIGHT | ||
315 | #ifndef DISABLE_RGB_MATRIX_CYCLE_UP_DOWN | ||
316 | case RGB_MATRIX_CYCLE_UP_DOWN: | ||
317 | rendering = rgb_matrix_cycle_up_down(&rgb_effect_params); // Max 4ms Avg 3ms | ||
318 | break; | ||
319 | #endif // DISABLE_RGB_MATRIX_CYCLE_UP_DOWN | ||
320 | #ifndef DISABLE_RGB_MATRIX_RAINBOW_MOVING_CHEVRON | ||
321 | case RGB_MATRIX_RAINBOW_MOVING_CHEVRON: | ||
322 | rendering = rgb_matrix_rainbow_moving_chevron(&rgb_effect_params); // Max 4ms Avg 3ms | ||
323 | break; | ||
324 | #endif // DISABLE_RGB_MATRIX_RAINBOW_MOVING_CHEVRON | ||
325 | #ifndef DISABLE_RGB_MATRIX_DUAL_BEACON | ||
326 | case RGB_MATRIX_DUAL_BEACON: | ||
327 | rendering = rgb_matrix_dual_beacon(&rgb_effect_params); // Max 4ms Avg 3ms | ||
328 | break; | ||
329 | #endif // DISABLE_RGB_MATRIX_DUAL_BEACON | ||
330 | #ifndef DISABLE_RGB_MATRIX_RAINBOW_BEACON | ||
331 | case RGB_MATRIX_RAINBOW_BEACON: | ||
332 | rendering = rgb_matrix_rainbow_beacon(&rgb_effect_params); // Max 4ms Avg 3ms | ||
333 | break; | ||
334 | #endif // DISABLE_RGB_MATRIX_RAINBOW_BEACON | ||
335 | #ifndef DISABLE_RGB_MATRIX_RAINBOW_PINWHEELS | ||
336 | case RGB_MATRIX_RAINBOW_PINWHEELS: | ||
337 | rendering = rgb_matrix_rainbow_pinwheels(&rgb_effect_params); // Max 4ms Avg 3ms | ||
338 | break; | ||
339 | #endif // DISABLE_RGB_MATRIX_RAINBOW_PINWHEELS | ||
340 | #ifndef DISABLE_RGB_MATRIX_RAINDROPS | ||
341 | case RGB_MATRIX_RAINDROPS: | ||
342 | rendering = rgb_matrix_raindrops(&rgb_effect_params); // Max 1ms Avg 0ms | ||
343 | break; | ||
344 | #endif // DISABLE_RGB_MATRIX_RAINDROPS | ||
345 | #ifndef DISABLE_RGB_MATRIX_JELLYBEAN_RAINDROPS | ||
346 | case RGB_MATRIX_JELLYBEAN_RAINDROPS: | ||
347 | rendering = rgb_matrix_jellybean_raindrops(&rgb_effect_params); // Max 1ms Avg 0ms | ||
348 | break; | ||
349 | #endif // DISABLE_RGB_MATRIX_JELLYBEAN_RAINDROPS | ||
350 | #ifndef DISABLE_RGB_MATRIX_DIGITAL_RAIN | ||
351 | case RGB_MATRIX_DIGITAL_RAIN: | ||
352 | rendering = rgb_matrix_digital_rain(&rgb_effect_params); // Max 9ms Avg 8ms | this is expensive, fix it | ||
353 | break; | ||
354 | #endif // DISABLE_RGB_MATRIX_DIGITAL_RAIN | ||
355 | #ifdef RGB_MATRIX_KEYREACTIVE_ENABLED | ||
356 | #ifndef DISABLE_RGB_MATRIX_SOLID_REACTIVE_SIMPLE | ||
357 | case RGB_MATRIX_SOLID_REACTIVE_SIMPLE: | ||
358 | rendering = rgb_matrix_solid_reactive_simple(&rgb_effect_params);// Max 4ms Avg 3ms | ||
359 | break; | ||
360 | #endif | ||
361 | #ifndef DISABLE_RGB_MATRIX_SOLID_REACTIVE | ||
362 | case RGB_MATRIX_SOLID_REACTIVE: | ||
363 | rendering = rgb_matrix_solid_reactive(&rgb_effect_params); // Max 4ms Avg 3ms | ||
364 | break; | ||
365 | #endif // DISABLE_RGB_MATRIX_SOLID_REACTIVE | ||
366 | #ifndef DISABLE_RGB_MATRIX_SPLASH | ||
367 | case RGB_MATRIX_SPLASH: | ||
368 | rendering = rgb_matrix_splash(&rgb_effect_params); // Max 5ms Avg 3ms | ||
369 | break; | ||
370 | #endif // DISABLE_RGB_MATRIX_SPLASH | ||
371 | #ifndef DISABLE_RGB_MATRIX_MULTISPLASH | ||
372 | case RGB_MATRIX_MULTISPLASH: | ||
373 | rendering = rgb_matrix_multisplash(&rgb_effect_params); // Max 10ms Avg 5ms | ||
374 | break; | ||
375 | #endif // DISABLE_RGB_MATRIX_MULTISPLASH | ||
376 | #ifndef DISABLE_RGB_MATRIX_SOLID_SPLASH | ||
377 | case RGB_MATRIX_SOLID_SPLASH: | ||
378 | rendering = rgb_matrix_solid_splash(&rgb_effect_params); // Max 5ms Avg 3ms | ||
379 | break; | ||
380 | #endif // DISABLE_RGB_MATRIX_SOLID_SPLASH | ||
381 | #ifndef DISABLE_RGB_MATRIX_SOLID_MULTISPLASH | ||
382 | case RGB_MATRIX_SOLID_MULTISPLASH: | ||
383 | rendering = rgb_matrix_solid_multisplash(&rgb_effect_params); // Max 10ms Avg 5ms | ||
384 | break; | ||
385 | #endif // DISABLE_RGB_MATRIX_SOLID_MULTISPLASH | ||
386 | #endif // RGB_MATRIX_KEYREACTIVE_ENABLED | ||
473 | 387 | ||
474 | // Change one LED every tick, make sure speed is not 0 | 388 | // Factory default magic value |
475 | uint8_t led_to_change = ( g_tick & ( 0x0A / (rgb_matrix_config.speed == 0 ? 1 : rgb_matrix_config.speed) ) ) == 0 ? rand() % (DRIVER_LED_TOTAL) : 255; | 389 | case UINT8_MAX: { |
390 | rgb_matrix_test(); | ||
391 | rgb_task_state = FLUSHING; | ||
392 | } | ||
393 | return; | ||
394 | } | ||
476 | 395 | ||
477 | for ( int i=0; i<DRIVER_LED_TOTAL; i++ ) | 396 | rgb_effect_params.iter++; |
478 | { | ||
479 | // If initialize, all get set to random colors | ||
480 | // If not, all but one will stay the same as before. | ||
481 | if ( initialize || i == led_to_change ) | ||
482 | { | ||
483 | hsv.h = rand() & 0xFF; | ||
484 | hsv.s = rand() & 0xFF; | ||
485 | // Override brightness with global brightness control | ||
486 | hsv.v = rgb_matrix_config.val; | ||
487 | 397 | ||
488 | rgb = hsv_to_rgb( hsv ); | 398 | // next task |
489 | rgb_matrix_set_color( i, rgb.r, rgb.g, rgb.b ); | 399 | if (!rendering) { |
490 | } | 400 | rgb_task_state = FLUSHING; |
401 | if (!rgb_effect_params.init && effect == RGB_MATRIX_NONE) { | ||
402 | // We only need to flush once if we are RGB_MATRIX_NONE | ||
403 | rgb_task_state = SYNCING; | ||
491 | } | 404 | } |
405 | } | ||
492 | } | 406 | } |
493 | 407 | ||
494 | void rgb_matrix_digital_rain( const bool initialize ) { | 408 | static void rgb_task_flush(uint8_t effect) { |
495 | // algorithm ported from https://github.com/tremby/Kaleidoscope-LEDEffect-DigitalRain | 409 | // update last trackers after the first full render so we can init over several frames |
496 | const uint8_t drop_ticks = 28; | 410 | rgb_last_effect = effect; |
497 | const uint8_t pure_green_intensity = 0xd0; | 411 | rgb_last_enable = rgb_matrix_config.enable; |
498 | const uint8_t max_brightness_boost = 0xc0; | ||
499 | const uint8_t max_intensity = 0xff; | ||
500 | 412 | ||
501 | static uint8_t map[MATRIX_COLS][MATRIX_ROWS] = {{0}}; | 413 | // update pwm buffers |
502 | static uint8_t drop = 0; | 414 | rgb_matrix_update_pwm_buffers(); |
503 | |||
504 | if (initialize) { | ||
505 | rgb_matrix_set_color_all(0, 0, 0); | ||
506 | memset(map, 0, sizeof map); | ||
507 | drop = 0; | ||
508 | } | ||
509 | for (uint8_t col = 0; col < MATRIX_COLS; col++) { | ||
510 | for (uint8_t row = 0; row < MATRIX_ROWS; row++) { | ||
511 | if (row == 0 && drop == 0 && rand() < RAND_MAX / RGB_DIGITAL_RAIN_DROPS) { | ||
512 | // top row, pixels have just fallen and we're | ||
513 | // making a new rain drop in this column | ||
514 | map[col][row] = max_intensity; | ||
515 | } | ||
516 | else if (map[col][row] > 0 && map[col][row] < max_intensity) { | ||
517 | // neither fully bright nor dark, decay it | ||
518 | map[col][row]--; | ||
519 | } | ||
520 | // set the pixel colour | ||
521 | uint8_t led, led_count; | ||
522 | map_row_column_to_led(row, col, &led, &led_count); | ||
523 | |||
524 | if (map[col][row] > pure_green_intensity) { | ||
525 | const uint8_t boost = (uint8_t) ((uint16_t) max_brightness_boost | ||
526 | * (map[col][row] - pure_green_intensity) / (max_intensity - pure_green_intensity)); | ||
527 | rgb_matrix_set_color(led, boost, max_intensity, boost); | ||
528 | } | ||
529 | else { | ||
530 | const uint8_t green = (uint8_t) ((uint16_t) max_intensity * map[col][row] / pure_green_intensity); | ||
531 | rgb_matrix_set_color(led, 0, green, 0); | ||
532 | } | ||
533 | } | ||
534 | } | ||
535 | if (++drop > drop_ticks) { | ||
536 | // reset drop timer | ||
537 | drop = 0; | ||
538 | for (uint8_t row = MATRIX_ROWS - 1; row > 0; row--) { | ||
539 | for (uint8_t col = 0; col < MATRIX_COLS; col++) { | ||
540 | // if ths is on the bottom row and bright allow decay | ||
541 | if (row == MATRIX_ROWS - 1 && map[col][row] == max_intensity) { | ||
542 | map[col][row]--; | ||
543 | } | ||
544 | // check if the pixel above is bright | ||
545 | if (map[col][row - 1] == max_intensity) { | ||
546 | // allow old bright pixel to decay | ||
547 | map[col][row - 1]--; | ||
548 | // make this pixel bright | ||
549 | map[col][row] = max_intensity; | ||
550 | } | ||
551 | } | ||
552 | } | ||
553 | } | ||
554 | } | ||
555 | 415 | ||
556 | void rgb_matrix_multisplash(void) { | 416 | // next task |
557 | // if (g_any_key_hit < 0xFF) { | 417 | rgb_task_state = SYNCING; |
558 | HSV hsv = { .h = rgb_matrix_config.hue, .s = rgb_matrix_config.sat, .v = rgb_matrix_config.val }; | ||
559 | RGB rgb; | ||
560 | rgb_led led; | ||
561 | for (uint8_t i = 0; i < DRIVER_LED_TOTAL; i++) { | ||
562 | led = g_rgb_leds[i]; | ||
563 | uint16_t c = 0, d = 0; | ||
564 | rgb_led last_led; | ||
565 | // if (g_last_led_count) { | ||
566 | for (uint8_t last_i = 0; last_i < g_last_led_count; last_i++) { | ||
567 | last_led = g_rgb_leds[g_last_led_hit[last_i]]; | ||
568 | uint16_t dist = (uint16_t)sqrt(pow(led.point.x - last_led.point.x, 2) + pow(led.point.y - last_led.point.y, 2)); | ||
569 | uint16_t effect = (g_key_hit[g_last_led_hit[last_i]] << 2) - dist; | ||
570 | c += MIN(MAX(effect, 0), 255); | ||
571 | d += 255 - MIN(MAX(effect, 0), 255); | ||
572 | } | ||
573 | // } else { | ||
574 | // d = 255; | ||
575 | // } | ||
576 | hsv.h = (rgb_matrix_config.hue + c) % 256; | ||
577 | hsv.v = MAX(MIN(d, 255), 0); | ||
578 | rgb = hsv_to_rgb( hsv ); | ||
579 | rgb_matrix_set_color( i, rgb.r, rgb.g, rgb.b ); | ||
580 | } | ||
581 | // } else { | ||
582 | // rgb_matrix_set_color_all( 0, 0, 0 ); | ||
583 | // } | ||
584 | } | ||
585 | |||
586 | |||
587 | void rgb_matrix_splash(void) { | ||
588 | g_last_led_count = MIN(g_last_led_count, 1); | ||
589 | rgb_matrix_multisplash(); | ||
590 | } | ||
591 | |||
592 | |||
593 | void rgb_matrix_solid_multisplash(void) { | ||
594 | // if (g_any_key_hit < 0xFF) { | ||
595 | HSV hsv = { .h = rgb_matrix_config.hue, .s = rgb_matrix_config.sat, .v = rgb_matrix_config.val }; | ||
596 | RGB rgb; | ||
597 | rgb_led led; | ||
598 | for (uint8_t i = 0; i < DRIVER_LED_TOTAL; i++) { | ||
599 | led = g_rgb_leds[i]; | ||
600 | uint16_t d = 0; | ||
601 | rgb_led last_led; | ||
602 | // if (g_last_led_count) { | ||
603 | for (uint8_t last_i = 0; last_i < g_last_led_count; last_i++) { | ||
604 | last_led = g_rgb_leds[g_last_led_hit[last_i]]; | ||
605 | uint16_t dist = (uint16_t)sqrt(pow(led.point.x - last_led.point.x, 2) + pow(led.point.y - last_led.point.y, 2)); | ||
606 | uint16_t effect = (g_key_hit[g_last_led_hit[last_i]] << 2) - dist; | ||
607 | d += 255 - MIN(MAX(effect, 0), 255); | ||
608 | } | ||
609 | // } else { | ||
610 | // d = 255; | ||
611 | // } | ||
612 | hsv.v = MAX(MIN(d, 255), 0); | ||
613 | rgb = hsv_to_rgb( hsv ); | ||
614 | rgb_matrix_set_color( i, rgb.r, rgb.g, rgb.b ); | ||
615 | } | ||
616 | // } else { | ||
617 | // rgb_matrix_set_color_all( 0, 0, 0 ); | ||
618 | // } | ||
619 | } | ||
620 | |||
621 | |||
622 | void rgb_matrix_solid_splash(void) { | ||
623 | g_last_led_count = MIN(g_last_led_count, 1); | ||
624 | rgb_matrix_solid_multisplash(); | ||
625 | } | ||
626 | |||
627 | |||
628 | // Needs eeprom access that we don't have setup currently | ||
629 | |||
630 | void rgb_matrix_custom(void) { | ||
631 | // HSV hsv; | ||
632 | // RGB rgb; | ||
633 | // for ( int i=0; i<DRIVER_LED_TOTAL; i++ ) | ||
634 | // { | ||
635 | // backlight_get_key_color(i, &hsv); | ||
636 | // // Override brightness with global brightness control | ||
637 | // hsv.v = rgb_matrix_config.val; | ||
638 | // rgb = hsv_to_rgb( hsv ); | ||
639 | // rgb_matrix_set_color( i, rgb.r, rgb.g, rgb.b ); | ||
640 | // } | ||
641 | } | 418 | } |
642 | 419 | ||
643 | void rgb_matrix_task(void) { | 420 | void rgb_matrix_task(void) { |
644 | #ifdef TRACK_PREVIOUS_EFFECT | 421 | rgb_task_timers(); |
645 | static uint8_t toggle_enable_last = 255; | 422 | |
646 | #endif | 423 | // Ideally we would also stop sending zeros to the LED driver PWM buffers |
647 | if (!rgb_matrix_config.enable) { | 424 | // while suspended and just do a software shutdown. This is a cheap hack for now. |
648 | rgb_matrix_all_off(); | 425 | bool suspend_backlight = ((g_suspend_state && RGB_DISABLE_WHEN_USB_SUSPENDED) || (RGB_DISABLE_AFTER_TIMEOUT > 0 && g_rgb_counters.any_key_hit > RGB_DISABLE_AFTER_TIMEOUT * 60 * 20)); |
649 | rgb_matrix_indicators(); | 426 | uint8_t effect = suspend_backlight || !rgb_matrix_config.enable ? 0 : rgb_matrix_config.mode; |
650 | #ifdef TRACK_PREVIOUS_EFFECT | 427 | |
651 | toggle_enable_last = rgb_matrix_config.enable; | 428 | switch (rgb_task_state) { |
652 | #endif | 429 | case STARTING: |
653 | return; | 430 | rgb_task_start(); |
654 | } | 431 | break; |
655 | // delay 1 second before driving LEDs or doing anything else | 432 | case RENDERING: |
656 | static uint8_t startup_tick = 0; | 433 | rgb_task_render(effect); |
657 | if ( startup_tick < 20 ) { | 434 | break; |
658 | startup_tick++; | 435 | case FLUSHING: |
659 | return; | 436 | rgb_task_flush(effect); |
660 | } | 437 | break; |
661 | 438 | case SYNCING: | |
662 | g_tick++; | 439 | rgb_task_sync(); |
663 | 440 | break; | |
664 | if ( g_any_key_hit < 0xFFFFFFFF ) { | 441 | } |
665 | g_any_key_hit++; | ||
666 | } | ||
667 | |||
668 | for ( int led = 0; led < DRIVER_LED_TOTAL; led++ ) { | ||
669 | if ( g_key_hit[led] < 255 ) { | ||
670 | if (g_key_hit[led] == 254) | ||
671 | g_last_led_count = MAX(g_last_led_count - 1, 0); | ||
672 | g_key_hit[led]++; | ||
673 | } | ||
674 | } | ||
675 | |||
676 | // Factory default magic value | ||
677 | if ( rgb_matrix_config.mode == 255 ) { | ||
678 | rgb_matrix_test(); | ||
679 | return; | ||
680 | } | ||
681 | |||
682 | // Ideally we would also stop sending zeros to the LED driver PWM buffers | ||
683 | // while suspended and just do a software shutdown. This is a cheap hack for now. | ||
684 | bool suspend_backlight = ((g_suspend_state && RGB_DISABLE_WHEN_USB_SUSPENDED) || | ||
685 | (RGB_DISABLE_AFTER_TIMEOUT > 0 && g_any_key_hit > RGB_DISABLE_AFTER_TIMEOUT * 60 * 20)); | ||
686 | uint8_t effect = suspend_backlight ? 0 : rgb_matrix_config.mode; | ||
687 | |||
688 | #ifdef TRACK_PREVIOUS_EFFECT | ||
689 | // Keep track of the effect used last time, | ||
690 | // detect change in effect, so each effect can | ||
691 | // have an optional initialization. | ||
692 | |||
693 | static uint8_t effect_last = 255; | ||
694 | bool initialize = (effect != effect_last) || (rgb_matrix_config.enable != toggle_enable_last); | ||
695 | effect_last = effect; | ||
696 | toggle_enable_last = rgb_matrix_config.enable; | ||
697 | #endif | ||
698 | |||
699 | // this gets ticked at 20 Hz. | ||
700 | // each effect can opt to do calculations | ||
701 | // and/or request PWM buffer updates. | ||
702 | switch ( effect ) { | ||
703 | case RGB_MATRIX_SOLID_COLOR: | ||
704 | rgb_matrix_solid_color(); | ||
705 | break; | ||
706 | #ifndef DISABLE_RGB_MATRIX_ALPHAS_MODS | ||
707 | case RGB_MATRIX_ALPHAS_MODS: | ||
708 | rgb_matrix_alphas_mods(); | ||
709 | break; | ||
710 | #endif | ||
711 | #ifndef DISABLE_RGB_MATRIX_DUAL_BEACON | ||
712 | case RGB_MATRIX_DUAL_BEACON: | ||
713 | rgb_matrix_dual_beacon(); | ||
714 | break; | ||
715 | #endif | ||
716 | #ifndef DISABLE_RGB_MATRIX_GRADIENT_UP_DOWN | ||
717 | case RGB_MATRIX_GRADIENT_UP_DOWN: | ||
718 | rgb_matrix_gradient_up_down(); | ||
719 | break; | ||
720 | #endif | ||
721 | #ifndef DISABLE_RGB_MATRIX_RAINDROPS | ||
722 | case RGB_MATRIX_RAINDROPS: | ||
723 | rgb_matrix_raindrops( initialize ); | ||
724 | break; | ||
725 | #endif | ||
726 | #ifndef DISABLE_RGB_MATRIX_CYCLE_ALL | ||
727 | case RGB_MATRIX_CYCLE_ALL: | ||
728 | rgb_matrix_cycle_all(); | ||
729 | break; | ||
730 | #endif | ||
731 | #ifndef DISABLE_RGB_MATRIX_CYCLE_LEFT_RIGHT | ||
732 | case RGB_MATRIX_CYCLE_LEFT_RIGHT: | ||
733 | rgb_matrix_cycle_left_right(); | ||
734 | break; | ||
735 | #endif | ||
736 | #ifndef DISABLE_RGB_MATRIX_CYCLE_UP_DOWN | ||
737 | case RGB_MATRIX_CYCLE_UP_DOWN: | ||
738 | rgb_matrix_cycle_up_down(); | ||
739 | break; | ||
740 | #endif | ||
741 | #ifndef DISABLE_RGB_MATRIX_RAINBOW_BEACON | ||
742 | case RGB_MATRIX_RAINBOW_BEACON: | ||
743 | rgb_matrix_rainbow_beacon(); | ||
744 | break; | ||
745 | #endif | ||
746 | #ifndef DISABLE_RGB_MATRIX_RAINBOW_PINWHEELS | ||
747 | case RGB_MATRIX_RAINBOW_PINWHEELS: | ||
748 | rgb_matrix_rainbow_pinwheels(); | ||
749 | break; | ||
750 | #endif | ||
751 | #ifndef DISABLE_RGB_MATRIX_RAINBOW_MOVING_CHEVRON | ||
752 | case RGB_MATRIX_RAINBOW_MOVING_CHEVRON: | ||
753 | rgb_matrix_rainbow_moving_chevron(); | ||
754 | break; | ||
755 | #endif | ||
756 | #ifndef DISABLE_RGB_MATRIX_JELLYBEAN_RAINDROPS | ||
757 | case RGB_MATRIX_JELLYBEAN_RAINDROPS: | ||
758 | rgb_matrix_jellybean_raindrops( initialize ); | ||
759 | break; | ||
760 | #endif | ||
761 | #ifndef DISABLE_RGB_MATRIX_DIGITAL_RAIN | ||
762 | case RGB_MATRIX_DIGITAL_RAIN: | ||
763 | rgb_matrix_digital_rain( initialize ); | ||
764 | break; | ||
765 | #endif | ||
766 | #ifdef RGB_MATRIX_KEYPRESSES | ||
767 | #ifndef DISABLE_RGB_MATRIX_SOLID_REACTIVE | ||
768 | case RGB_MATRIX_SOLID_REACTIVE: | ||
769 | rgb_matrix_solid_reactive(); | ||
770 | break; | ||
771 | #endif | ||
772 | #ifndef DISABLE_RGB_MATRIX_SOLID_REACTIVE_SIMPLE | ||
773 | case RGB_MATRIX_SOLID_REACTIVE_SIMPLE: | ||
774 | rgb_matrix_solid_reactive_simple(); | ||
775 | break; | ||
776 | #endif | ||
777 | #ifndef DISABLE_RGB_MATRIX_SPLASH | ||
778 | case RGB_MATRIX_SPLASH: | ||
779 | rgb_matrix_splash(); | ||
780 | break; | ||
781 | #endif | ||
782 | #ifndef DISABLE_RGB_MATRIX_MULTISPLASH | ||
783 | case RGB_MATRIX_MULTISPLASH: | ||
784 | rgb_matrix_multisplash(); | ||
785 | break; | ||
786 | #endif | ||
787 | #ifndef DISABLE_RGB_MATRIX_SOLID_SPLASH | ||
788 | case RGB_MATRIX_SOLID_SPLASH: | ||
789 | rgb_matrix_solid_splash(); | ||
790 | break; | ||
791 | #endif | ||
792 | #ifndef DISABLE_RGB_MATRIX_SOLID_MULTISPLASH | ||
793 | case RGB_MATRIX_SOLID_MULTISPLASH: | ||
794 | rgb_matrix_solid_multisplash(); | ||
795 | break; | ||
796 | #endif | ||
797 | #endif | ||
798 | default: | ||
799 | rgb_matrix_custom(); | ||
800 | break; | ||
801 | } | ||
802 | |||
803 | if ( ! suspend_backlight ) { | ||
804 | rgb_matrix_indicators(); | ||
805 | } | ||
806 | 442 | ||
443 | if (!suspend_backlight) { | ||
444 | rgb_matrix_indicators(); | ||
445 | } | ||
807 | } | 446 | } |
808 | 447 | ||
809 | void rgb_matrix_indicators(void) { | 448 | void rgb_matrix_indicators(void) { |
810 | rgb_matrix_indicators_kb(); | 449 | rgb_matrix_indicators_kb(); |
811 | rgb_matrix_indicators_user(); | 450 | rgb_matrix_indicators_user(); |
812 | } | 451 | } |
813 | 452 | ||
814 | __attribute__((weak)) | 453 | __attribute__((weak)) |
@@ -817,103 +456,54 @@ void rgb_matrix_indicators_kb(void) {} | |||
817 | __attribute__((weak)) | 456 | __attribute__((weak)) |
818 | void rgb_matrix_indicators_user(void) {} | 457 | void rgb_matrix_indicators_user(void) {} |
819 | 458 | ||
820 | |||
821 | // void rgb_matrix_set_indicator_index( uint8_t *index, uint8_t row, uint8_t column ) | ||
822 | // { | ||
823 | // if ( row >= MATRIX_ROWS ) | ||
824 | // { | ||
825 | // // Special value, 255=none, 254=all | ||
826 | // *index = row; | ||
827 | // } | ||
828 | // else | ||
829 | // { | ||
830 | // // This needs updated to something like | ||
831 | // // uint8_t led[8], led_count; | ||
832 | // // map_row_column_to_led(row,column,led,&led_count); | ||
833 | // // for(uint8_t i = 0; i < led_count; i++) | ||
834 | // map_row_column_to_led( row, column, index ); | ||
835 | // } | ||
836 | // } | ||
837 | |||
838 | void rgb_matrix_init(void) { | 459 | void rgb_matrix_init(void) { |
839 | rgb_matrix_driver.init(); | 460 | rgb_matrix_driver.init(); |
840 | 461 | ||
841 | // TODO: put the 1 second startup delay here? | 462 | // TODO: put the 1 second startup delay here? |
842 | 463 | ||
843 | // clear the key hits | 464 | #ifdef RGB_MATRIX_KEYREACTIVE_ENABLED |
844 | for ( int led=0; led<DRIVER_LED_TOTAL; led++ ) { | 465 | g_last_hit_tracker.count = 0; |
845 | g_key_hit[led] = 255; | 466 | for (uint8_t i = 0; i < LED_HITS_TO_REMEMBER; ++i) { |
467 | g_last_hit_tracker.tick[i] = UINT16_MAX; | ||
846 | } | 468 | } |
847 | 469 | ||
470 | last_hit_buffer.count = 0; | ||
471 | for (uint8_t i = 0; i < LED_HITS_TO_REMEMBER; ++i) { | ||
472 | last_hit_buffer.tick[i] = UINT16_MAX; | ||
473 | } | ||
474 | #endif // RGB_MATRIX_KEYREACTIVE_ENABLED | ||
848 | 475 | ||
849 | if (!eeconfig_is_enabled()) { | 476 | if (!eeconfig_is_enabled()) { |
850 | dprintf("rgb_matrix_init_drivers eeconfig is not enabled.\n"); | 477 | dprintf("rgb_matrix_init_drivers eeconfig is not enabled.\n"); |
851 | eeconfig_init(); | 478 | eeconfig_init(); |
852 | eeconfig_update_rgb_matrix_default(); | 479 | eeconfig_update_rgb_matrix_default(); |
853 | } | 480 | } |
481 | |||
854 | rgb_matrix_config.raw = eeconfig_read_rgb_matrix(); | 482 | rgb_matrix_config.raw = eeconfig_read_rgb_matrix(); |
483 | rgb_matrix_config.speed = UINT8_MAX / 2; //EECONFIG needs to be increased to support this | ||
855 | if (!rgb_matrix_config.mode) { | 484 | if (!rgb_matrix_config.mode) { |
856 | dprintf("rgb_matrix_init_drivers rgb_matrix_config.mode = 0. Write default values to EEPROM.\n"); | 485 | dprintf("rgb_matrix_init_drivers rgb_matrix_config.mode = 0. Write default values to EEPROM.\n"); |
857 | eeconfig_update_rgb_matrix_default(); | 486 | eeconfig_update_rgb_matrix_default(); |
858 | rgb_matrix_config.raw = eeconfig_read_rgb_matrix(); | 487 | rgb_matrix_config.raw = eeconfig_read_rgb_matrix(); |
859 | } | 488 | } |
860 | eeconfig_debug_rgb_matrix(); // display current eeprom values | 489 | eeconfig_debug_rgb_matrix(); // display current eeprom values |
861 | } | 490 | } |
862 | 491 | ||
863 | // Deals with the messy details of incrementing an integer | 492 | void rgb_matrix_set_suspend_state(bool state) { |
864 | static uint8_t increment( uint8_t value, uint8_t step, uint8_t min, uint8_t max ) { | 493 | g_suspend_state = state; |
865 | int16_t new_value = value; | ||
866 | new_value += step; | ||
867 | return MIN( MAX( new_value, min ), max ); | ||
868 | } | ||
869 | |||
870 | static uint8_t decrement( uint8_t value, uint8_t step, uint8_t min, uint8_t max ) { | ||
871 | int16_t new_value = value; | ||
872 | new_value -= step; | ||
873 | return MIN( MAX( new_value, min ), max ); | ||
874 | } | ||
875 | |||
876 | // void *backlight_get_custom_key_color_eeprom_address( uint8_t led ) | ||
877 | // { | ||
878 | // // 3 bytes per color | ||
879 | // return EECONFIG_RGB_MATRIX + ( led * 3 ); | ||
880 | // } | ||
881 | |||
882 | // void backlight_get_key_color( uint8_t led, HSV *hsv ) | ||
883 | // { | ||
884 | // void *address = backlight_get_custom_key_color_eeprom_address( led ); | ||
885 | // hsv->h = eeprom_read_byte(address); | ||
886 | // hsv->s = eeprom_read_byte(address+1); | ||
887 | // hsv->v = eeprom_read_byte(address+2); | ||
888 | // } | ||
889 | |||
890 | // void backlight_set_key_color( uint8_t row, uint8_t column, HSV hsv ) | ||
891 | // { | ||
892 | // uint8_t led[8], led_count; | ||
893 | // map_row_column_to_led(row,column,led,&led_count); | ||
894 | // for(uint8_t i = 0; i < led_count; i++) { | ||
895 | // if ( led[i] < DRIVER_LED_TOTAL ) | ||
896 | // { | ||
897 | // void *address = backlight_get_custom_key_color_eeprom_address(led[i]); | ||
898 | // eeprom_update_byte(address, hsv.h); | ||
899 | // eeprom_update_byte(address+1, hsv.s); | ||
900 | // eeprom_update_byte(address+2, hsv.v); | ||
901 | // } | ||
902 | // } | ||
903 | // } | ||
904 | |||
905 | uint32_t rgb_matrix_get_tick(void) { | ||
906 | return g_tick; | ||
907 | } | 494 | } |
908 | 495 | ||
909 | void rgb_matrix_toggle(void) { | 496 | void rgb_matrix_toggle(void) { |
910 | rgb_matrix_config.enable ^= 1; | 497 | rgb_matrix_config.enable ^= 1; |
911 | eeconfig_update_rgb_matrix(rgb_matrix_config.raw); | 498 | if (!rgb_matrix_config.enable) { |
499 | rgb_task_state = STARTING; | ||
500 | } | ||
501 | eeconfig_update_rgb_matrix(rgb_matrix_config.raw); | ||
912 | } | 502 | } |
913 | 503 | ||
914 | void rgb_matrix_enable(void) { | 504 | void rgb_matrix_enable(void) { |
915 | rgb_matrix_config.enable = 1; | 505 | rgb_matrix_config.enable = 1; |
916 | eeconfig_update_rgb_matrix(rgb_matrix_config.raw); | 506 | eeconfig_update_rgb_matrix(rgb_matrix_config.raw); |
917 | } | 507 | } |
918 | 508 | ||
919 | void rgb_matrix_enable_noeeprom(void) { | 509 | void rgb_matrix_enable_noeeprom(void) { |
@@ -922,7 +512,7 @@ void rgb_matrix_enable_noeeprom(void) { | |||
922 | 512 | ||
923 | void rgb_matrix_disable(void) { | 513 | void rgb_matrix_disable(void) { |
924 | rgb_matrix_config.enable = 0; | 514 | rgb_matrix_config.enable = 0; |
925 | eeconfig_update_rgb_matrix(rgb_matrix_config.raw); | 515 | eeconfig_update_rgb_matrix(rgb_matrix_config.raw); |
926 | } | 516 | } |
927 | 517 | ||
928 | void rgb_matrix_disable_noeeprom(void) { | 518 | void rgb_matrix_disable_noeeprom(void) { |
@@ -930,76 +520,79 @@ void rgb_matrix_disable_noeeprom(void) { | |||
930 | } | 520 | } |
931 | 521 | ||
932 | void rgb_matrix_step(void) { | 522 | void rgb_matrix_step(void) { |
933 | rgb_matrix_config.mode++; | 523 | rgb_matrix_config.mode++; |
934 | if (rgb_matrix_config.mode >= RGB_MATRIX_EFFECT_MAX) | 524 | if (rgb_matrix_config.mode >= RGB_MATRIX_EFFECT_MAX) |
935 | rgb_matrix_config.mode = 1; | 525 | rgb_matrix_config.mode = 1; |
936 | eeconfig_update_rgb_matrix(rgb_matrix_config.raw); | 526 | rgb_task_state = STARTING; |
527 | eeconfig_update_rgb_matrix(rgb_matrix_config.raw); | ||
937 | } | 528 | } |
938 | 529 | ||
939 | void rgb_matrix_step_reverse(void) { | 530 | void rgb_matrix_step_reverse(void) { |
940 | rgb_matrix_config.mode--; | 531 | rgb_matrix_config.mode--; |
941 | if (rgb_matrix_config.mode < 1) | 532 | if (rgb_matrix_config.mode < 1) |
942 | rgb_matrix_config.mode = RGB_MATRIX_EFFECT_MAX - 1; | 533 | rgb_matrix_config.mode = RGB_MATRIX_EFFECT_MAX - 1; |
943 | eeconfig_update_rgb_matrix(rgb_matrix_config.raw); | 534 | rgb_task_state = STARTING; |
535 | eeconfig_update_rgb_matrix(rgb_matrix_config.raw); | ||
944 | } | 536 | } |
945 | 537 | ||
946 | void rgb_matrix_increase_hue(void) { | 538 | void rgb_matrix_increase_hue(void) { |
947 | rgb_matrix_config.hue = increment( rgb_matrix_config.hue, 8, 0, 255 ); | 539 | rgb_matrix_config.hue += RGB_MATRIX_HUE_STEP; |
948 | eeconfig_update_rgb_matrix(rgb_matrix_config.raw); | 540 | eeconfig_update_rgb_matrix(rgb_matrix_config.raw); |
949 | } | 541 | } |
950 | 542 | ||
951 | void rgb_matrix_decrease_hue(void) { | 543 | void rgb_matrix_decrease_hue(void) { |
952 | rgb_matrix_config.hue = decrement( rgb_matrix_config.hue, 8, 0, 255 ); | 544 | rgb_matrix_config.hue -= RGB_MATRIX_HUE_STEP; |
953 | eeconfig_update_rgb_matrix(rgb_matrix_config.raw); | 545 | eeconfig_update_rgb_matrix(rgb_matrix_config.raw); |
954 | } | 546 | } |
955 | 547 | ||
956 | void rgb_matrix_increase_sat(void) { | 548 | void rgb_matrix_increase_sat(void) { |
957 | rgb_matrix_config.sat = increment( rgb_matrix_config.sat, 8, 0, 255 ); | 549 | rgb_matrix_config.sat = qadd8(rgb_matrix_config.sat, RGB_MATRIX_SAT_STEP); |
958 | eeconfig_update_rgb_matrix(rgb_matrix_config.raw); | 550 | eeconfig_update_rgb_matrix(rgb_matrix_config.raw); |
959 | } | 551 | } |
960 | 552 | ||
961 | void rgb_matrix_decrease_sat(void) { | 553 | void rgb_matrix_decrease_sat(void) { |
962 | rgb_matrix_config.sat = decrement( rgb_matrix_config.sat, 8, 0, 255 ); | 554 | rgb_matrix_config.sat = qsub8(rgb_matrix_config.sat, RGB_MATRIX_SAT_STEP); |
963 | eeconfig_update_rgb_matrix(rgb_matrix_config.raw); | 555 | eeconfig_update_rgb_matrix(rgb_matrix_config.raw); |
964 | } | 556 | } |
965 | 557 | ||
966 | void rgb_matrix_increase_val(void) { | 558 | void rgb_matrix_increase_val(void) { |
967 | rgb_matrix_config.val = increment( rgb_matrix_config.val, 8, 0, RGB_MATRIX_MAXIMUM_BRIGHTNESS ); | 559 | rgb_matrix_config.val = qadd8(rgb_matrix_config.val, RGB_MATRIX_VAL_STEP); |
968 | eeconfig_update_rgb_matrix(rgb_matrix_config.raw); | 560 | if (rgb_matrix_config.val > RGB_MATRIX_MAXIMUM_BRIGHTNESS) |
561 | rgb_matrix_config.val = RGB_MATRIX_MAXIMUM_BRIGHTNESS; | ||
562 | eeconfig_update_rgb_matrix(rgb_matrix_config.raw); | ||
969 | } | 563 | } |
970 | 564 | ||
971 | void rgb_matrix_decrease_val(void) { | 565 | void rgb_matrix_decrease_val(void) { |
972 | rgb_matrix_config.val = decrement( rgb_matrix_config.val, 8, 0, RGB_MATRIX_MAXIMUM_BRIGHTNESS ); | 566 | rgb_matrix_config.val = qsub8(rgb_matrix_config.val, RGB_MATRIX_VAL_STEP); |
973 | eeconfig_update_rgb_matrix(rgb_matrix_config.raw); | 567 | eeconfig_update_rgb_matrix(rgb_matrix_config.raw); |
974 | } | 568 | } |
975 | 569 | ||
976 | void rgb_matrix_increase_speed(void) { | 570 | void rgb_matrix_increase_speed(void) { |
977 | rgb_matrix_config.speed = increment( rgb_matrix_config.speed, 1, 0, 3 ); | 571 | rgb_matrix_config.speed = qadd8(rgb_matrix_config.speed, RGB_MATRIX_SPD_STEP); |
978 | eeconfig_update_rgb_matrix(rgb_matrix_config.raw);//EECONFIG needs to be increased to support this | 572 | eeconfig_update_rgb_matrix(rgb_matrix_config.raw);//EECONFIG needs to be increased to support this |
979 | } | 573 | } |
980 | 574 | ||
981 | void rgb_matrix_decrease_speed(void) { | 575 | void rgb_matrix_decrease_speed(void) { |
982 | rgb_matrix_config.speed = decrement( rgb_matrix_config.speed, 1, 0, 3 ); | 576 | rgb_matrix_config.speed = qsub8(rgb_matrix_config.speed, RGB_MATRIX_SPD_STEP); |
983 | eeconfig_update_rgb_matrix(rgb_matrix_config.raw);//EECONFIG needs to be increased to support this | 577 | eeconfig_update_rgb_matrix(rgb_matrix_config.raw);//EECONFIG needs to be increased to support this |
984 | } | 578 | } |
985 | 579 | ||
986 | void rgb_matrix_mode(uint8_t mode) { | 580 | void rgb_matrix_mode(uint8_t mode) { |
987 | rgb_matrix_config.mode = mode; | 581 | rgb_matrix_config.mode = mode; |
988 | eeconfig_update_rgb_matrix(rgb_matrix_config.raw); | 582 | rgb_task_state = STARTING; |
583 | eeconfig_update_rgb_matrix(rgb_matrix_config.raw); | ||
989 | } | 584 | } |
990 | 585 | ||
991 | void rgb_matrix_mode_noeeprom(uint8_t mode) { | 586 | void rgb_matrix_mode_noeeprom(uint8_t mode) { |
992 | rgb_matrix_config.mode = mode; | 587 | rgb_matrix_config.mode = mode; |
993 | } | 588 | } |
994 | 589 | ||
995 | uint8_t rgb_matrix_get_mode(void) { | 590 | uint8_t rgb_matrix_get_mode(void) { |
996 | return rgb_matrix_config.mode; | 591 | return rgb_matrix_config.mode; |
997 | } | 592 | } |
998 | 593 | ||
999 | void rgb_matrix_sethsv(uint16_t hue, uint8_t sat, uint8_t val) { | 594 | void rgb_matrix_sethsv(uint16_t hue, uint8_t sat, uint8_t val) { |
1000 | rgb_matrix_config.hue = hue; | 595 | rgb_matrix_sethsv_noeeprom(hue, sat, val); |
1001 | rgb_matrix_config.sat = sat; | ||
1002 | rgb_matrix_config.val = val; | ||
1003 | eeconfig_update_rgb_matrix(rgb_matrix_config.raw); | 596 | eeconfig_update_rgb_matrix(rgb_matrix_config.raw); |
1004 | } | 597 | } |
1005 | 598 | ||
@@ -1007,4 +600,6 @@ void rgb_matrix_sethsv_noeeprom(uint16_t hue, uint8_t sat, uint8_t val) { | |||
1007 | rgb_matrix_config.hue = hue; | 600 | rgb_matrix_config.hue = hue; |
1008 | rgb_matrix_config.sat = sat; | 601 | rgb_matrix_config.sat = sat; |
1009 | rgb_matrix_config.val = val; | 602 | rgb_matrix_config.val = val; |
603 | if (rgb_matrix_config.val > RGB_MATRIX_MAXIMUM_BRIGHTNESS) | ||
604 | rgb_matrix_config.val = RGB_MATRIX_MAXIMUM_BRIGHTNESS; | ||
1010 | } | 605 | } |
diff --git a/quantum/rgb_matrix.h b/quantum/rgb_matrix.h index e6acd2d4b..855ea0323 100644 --- a/quantum/rgb_matrix.h +++ b/quantum/rgb_matrix.h | |||
@@ -21,32 +21,33 @@ | |||
21 | 21 | ||
22 | #include <stdint.h> | 22 | #include <stdint.h> |
23 | #include <stdbool.h> | 23 | #include <stdbool.h> |
24 | #include "rgb_matrix_types.h" | ||
24 | #include "color.h" | 25 | #include "color.h" |
25 | #include "quantum.h" | 26 | #include "quantum.h" |
26 | 27 | ||
27 | #ifdef IS31FL3731 | 28 | #ifdef IS31FL3731 |
28 | #include "is31fl3731.h" | 29 | #include "is31fl3731.h" |
29 | #elif defined (IS31FL3733) | 30 | #elif defined (IS31FL3733) |
30 | #include "is31fl3733.h" | 31 | #include "is31fl3733.h" |
31 | #endif | 32 | #endif |
32 | 33 | ||
33 | typedef struct Point { | 34 | #ifndef RGB_MATRIX_LED_FLUSH_LIMIT |
34 | uint8_t x; | 35 | #define RGB_MATRIX_LED_FLUSH_LIMIT 16 |
35 | uint8_t y; | 36 | #endif |
36 | } __attribute__((packed)) Point; | ||
37 | 37 | ||
38 | typedef struct rgb_led { | 38 | #ifndef RGB_MATRIX_LED_PROCESS_LIMIT |
39 | union { | 39 | #define RGB_MATRIX_LED_PROCESS_LIMIT (DRIVER_LED_TOTAL + 4) / 5 |
40 | uint8_t raw; | 40 | #endif |
41 | struct { | ||
42 | uint8_t row:4; // 16 max | ||
43 | uint8_t col:4; // 16 max | ||
44 | }; | ||
45 | } matrix_co; | ||
46 | Point point; | ||
47 | uint8_t modifier:1; | ||
48 | } __attribute__((packed)) rgb_led; | ||
49 | 41 | ||
42 | #if defined(RGB_MATRIX_LED_PROCESS_LIMIT) && RGB_MATRIX_LED_PROCESS_LIMIT > 0 && RGB_MATRIX_LED_PROCESS_LIMIT < DRIVER_LED_TOTAL | ||
43 | #define RGB_MATRIX_USE_LIMITS(min, max) uint8_t min = RGB_MATRIX_LED_PROCESS_LIMIT * params->iter; \ | ||
44 | uint8_t max = min + RGB_MATRIX_LED_PROCESS_LIMIT; \ | ||
45 | if (max > DRIVER_LED_TOTAL) \ | ||
46 | max = DRIVER_LED_TOTAL; | ||
47 | #else | ||
48 | #define RGB_MATRIX_USE_LIMITS(min, max) uint8_t min = 0; \ | ||
49 | uint8_t max = DRIVER_LED_TOTAL; | ||
50 | #endif | ||
50 | 51 | ||
51 | extern const rgb_led g_rgb_leds[DRIVER_LED_TOTAL]; | 52 | extern const rgb_led g_rgb_leds[DRIVER_LED_TOTAL]; |
52 | 53 | ||
@@ -56,79 +57,73 @@ typedef struct | |||
56 | uint8_t index; | 57 | uint8_t index; |
57 | } rgb_indicator; | 58 | } rgb_indicator; |
58 | 59 | ||
59 | typedef union { | ||
60 | uint32_t raw; | ||
61 | struct { | ||
62 | bool enable :1; | ||
63 | uint8_t mode :6; | ||
64 | uint16_t hue :9; | ||
65 | uint8_t sat :8; | ||
66 | uint8_t val :8; | ||
67 | uint8_t speed :8;//EECONFIG needs to be increased to support this | ||
68 | }; | ||
69 | } rgb_config_t; | ||
70 | |||
71 | enum rgb_matrix_effects { | 60 | enum rgb_matrix_effects { |
61 | RGB_MATRIX_NONE = 0, | ||
72 | RGB_MATRIX_SOLID_COLOR = 1, | 62 | RGB_MATRIX_SOLID_COLOR = 1, |
73 | #ifndef DISABLE_RGB_MATRIX_ALPHAS_MODS | 63 | #ifndef DISABLE_RGB_MATRIX_ALPHAS_MODS |
74 | RGB_MATRIX_ALPHAS_MODS, | 64 | RGB_MATRIX_ALPHAS_MODS, |
75 | #endif | 65 | #endif // DISABLE_RGB_MATRIX_ALPHAS_MODS |
76 | #ifndef DISABLE_RGB_MATRIX_DUAL_BEACON | ||
77 | RGB_MATRIX_DUAL_BEACON, | ||
78 | #endif | ||
79 | #ifndef DISABLE_RGB_MATRIX_GRADIENT_UP_DOWN | 66 | #ifndef DISABLE_RGB_MATRIX_GRADIENT_UP_DOWN |
80 | RGB_MATRIX_GRADIENT_UP_DOWN, | 67 | RGB_MATRIX_GRADIENT_UP_DOWN, |
81 | #endif | 68 | #endif // DISABLE_RGB_MATRIX_GRADIENT_UP_DOWN |
82 | #ifndef DISABLE_RGB_MATRIX_RAINDROPS | 69 | #ifndef DISABLE_RGB_MATRIX_BREATHING |
83 | RGB_MATRIX_RAINDROPS, | 70 | RGB_MATRIX_BREATHING, |
84 | #endif | 71 | #endif // DISABLE_RGB_MATRIX_BREATHING |
85 | #ifndef DISABLE_RGB_MATRIX_CYCLE_ALL | 72 | #ifndef DISABLE_RGB_MATRIX_CYCLE_ALL |
86 | RGB_MATRIX_CYCLE_ALL, | 73 | RGB_MATRIX_CYCLE_ALL, |
87 | #endif | 74 | #endif // DISABLE_RGB_MATRIX_CYCLE_ALL |
88 | #ifndef DISABLE_RGB_MATRIX_CYCLE_LEFT_RIGHT | 75 | #ifndef DISABLE_RGB_MATRIX_CYCLE_LEFT_RIGHT |
89 | RGB_MATRIX_CYCLE_LEFT_RIGHT, | 76 | RGB_MATRIX_CYCLE_LEFT_RIGHT, |
90 | #endif | 77 | #endif // DISABLE_RGB_MATRIX_CYCLE_LEFT_RIGHT |
91 | #ifndef DISABLE_RGB_MATRIX_CYCLE_UP_DOWN | 78 | #ifndef DISABLE_RGB_MATRIX_CYCLE_UP_DOWN |
92 | RGB_MATRIX_CYCLE_UP_DOWN, | 79 | RGB_MATRIX_CYCLE_UP_DOWN, |
93 | #endif | 80 | #endif // DISABLE_RGB_MATRIX_CYCLE_UP_DOWN |
81 | #ifndef DISABLE_RGB_MATRIX_RAINBOW_MOVING_CHEVRON | ||
82 | RGB_MATRIX_RAINBOW_MOVING_CHEVRON, | ||
83 | #endif // DISABLE_RGB_MATRIX_RAINBOW_MOVING_CHEVRON | ||
84 | #ifndef DISABLE_RGB_MATRIX_DUAL_BEACON | ||
85 | RGB_MATRIX_DUAL_BEACON, | ||
86 | #endif // DISABLE_RGB_MATRIX_DUAL_BEACON | ||
94 | #ifndef DISABLE_RGB_MATRIX_RAINBOW_BEACON | 87 | #ifndef DISABLE_RGB_MATRIX_RAINBOW_BEACON |
95 | RGB_MATRIX_RAINBOW_BEACON, | 88 | RGB_MATRIX_RAINBOW_BEACON, |
96 | #endif | 89 | #endif // DISABLE_RGB_MATRIX_RAINBOW_BEACON |
97 | #ifndef DISABLE_RGB_MATRIX_RAINBOW_PINWHEELS | 90 | #ifndef DISABLE_RGB_MATRIX_RAINBOW_PINWHEELS |
98 | RGB_MATRIX_RAINBOW_PINWHEELS, | 91 | RGB_MATRIX_RAINBOW_PINWHEELS, |
99 | #endif | 92 | #endif // DISABLE_RGB_MATRIX_RAINBOW_PINWHEELS |
100 | #ifndef DISABLE_RGB_MATRIX_RAINBOW_MOVING_CHEVRON | 93 | #ifndef DISABLE_RGB_MATRIX_RAINDROPS |
101 | RGB_MATRIX_RAINBOW_MOVING_CHEVRON, | 94 | RGB_MATRIX_RAINDROPS, |
102 | #endif | 95 | #endif // DISABLE_RGB_MATRIX_RAINDROPS |
103 | #ifndef DISABLE_RGB_MATRIX_JELLYBEAN_RAINDROPS | 96 | #ifndef DISABLE_RGB_MATRIX_JELLYBEAN_RAINDROPS |
104 | RGB_MATRIX_JELLYBEAN_RAINDROPS, | 97 | RGB_MATRIX_JELLYBEAN_RAINDROPS, |
105 | #endif | 98 | #endif // DISABLE_RGB_MATRIX_JELLYBEAN_RAINDROPS |
106 | #ifndef DISABLE_RGB_MATRIX_DIGITAL_RAIN | 99 | #ifndef DISABLE_RGB_MATRIX_DIGITAL_RAIN |
107 | RGB_MATRIX_DIGITAL_RAIN, | 100 | RGB_MATRIX_DIGITAL_RAIN, |
108 | #endif | 101 | #endif // DISABLE_RGB_MATRIX_DIGITAL_RAIN |
109 | #ifdef RGB_MATRIX_KEYPRESSES | 102 | #ifdef RGB_MATRIX_KEYREACTIVE_ENABLED |
110 | #ifndef DISABLE_RGB_MATRIX_SOLID_REACTIVE | 103 | #ifndef DISABLE_RGB_MATRIX_SOLID_REACTIVE_SIMPLE |
111 | RGB_MATRIX_SOLID_REACTIVE, | 104 | RGB_MATRIX_SOLID_REACTIVE_SIMPLE, |
112 | #endif | 105 | #endif // DISABLE_RGB_MATRIX_SOLID_REACTIVE_SIMPLE |
113 | #ifndef DISABLE_RGB_MATRIX_SOLID_REACTIVE_SIMPLE | 106 | #ifndef DISABLE_RGB_MATRIX_SOLID_REACTIVE |
114 | RGB_MATRIX_SOLID_REACTIVE_SIMPLE, | 107 | RGB_MATRIX_SOLID_REACTIVE, |
115 | #endif | 108 | #endif // DISABLE_RGB_MATRIX_SOLID_REACTIVE |
116 | #ifndef DISABLE_RGB_MATRIX_SPLASH | 109 | #ifndef DISABLE_RGB_MATRIX_SPLASH |
117 | RGB_MATRIX_SPLASH, | 110 | RGB_MATRIX_SPLASH, |
118 | #endif | 111 | #endif // DISABLE_RGB_MATRIX_SPLASH |
119 | #ifndef DISABLE_RGB_MATRIX_MULTISPLASH | 112 | #ifndef DISABLE_RGB_MATRIX_MULTISPLASH |
120 | RGB_MATRIX_MULTISPLASH, | 113 | RGB_MATRIX_MULTISPLASH, |
121 | #endif | 114 | #endif // DISABLE_RGB_MATRIX_MULTISPLASH |
122 | #ifndef DISABLE_RGB_MATRIX_SOLID_SPLASH | 115 | #ifndef DISABLE_RGB_MATRIX_SOLID_SPLASH |
123 | RGB_MATRIX_SOLID_SPLASH, | 116 | RGB_MATRIX_SOLID_SPLASH, |
124 | #endif | 117 | #endif // DISABLE_RGB_MATRIX_SOLID_SPLASH |
125 | #ifndef DISABLE_RGB_MATRIX_SOLID_MULTISPLASH | 118 | #ifndef DISABLE_RGB_MATRIX_SOLID_MULTISPLASH |
126 | RGB_MATRIX_SOLID_MULTISPLASH, | 119 | RGB_MATRIX_SOLID_MULTISPLASH, |
127 | #endif | 120 | #endif // DISABLE_RGB_MATRIX_SOLID_MULTISPLASH |
128 | #endif | 121 | #endif // RGB_MATRIX_KEYREACTIVE_ENABLED |
129 | RGB_MATRIX_EFFECT_MAX | 122 | RGB_MATRIX_EFFECT_MAX |
130 | }; | 123 | }; |
131 | 124 | ||
125 | uint8_t rgb_matrix_map_row_column_to_led( uint8_t row, uint8_t column, uint8_t *led_i); | ||
126 | |||
132 | void rgb_matrix_set_color( int index, uint8_t red, uint8_t green, uint8_t blue ); | 127 | void rgb_matrix_set_color( int index, uint8_t red, uint8_t green, uint8_t blue ); |
133 | void rgb_matrix_set_color_all( uint8_t red, uint8_t green, uint8_t blue ); | 128 | void rgb_matrix_set_color_all( uint8_t red, uint8_t green, uint8_t blue ); |
134 | 129 | ||
@@ -162,8 +157,6 @@ void rgb_matrix_decrease(void); | |||
162 | // void backlight_get_key_color( uint8_t led, HSV *hsv ); | 157 | // void backlight_get_key_color( uint8_t led, HSV *hsv ); |
163 | // void backlight_set_key_color( uint8_t row, uint8_t column, HSV hsv ); | 158 | // void backlight_set_key_color( uint8_t row, uint8_t column, HSV hsv ); |
164 | 159 | ||
165 | uint32_t rgb_matrix_get_tick(void); | ||
166 | |||
167 | void rgb_matrix_toggle(void); | 160 | void rgb_matrix_toggle(void); |
168 | void rgb_matrix_enable(void); | 161 | void rgb_matrix_enable(void); |
169 | void rgb_matrix_enable_noeeprom(void); | 162 | void rgb_matrix_enable_noeeprom(void); |
@@ -212,7 +205,6 @@ uint8_t rgb_matrix_get_mode(void); | |||
212 | typedef struct { | 205 | typedef struct { |
213 | /* Perform any initialisation required for the other driver functions to work. */ | 206 | /* Perform any initialisation required for the other driver functions to work. */ |
214 | void (*init)(void); | 207 | void (*init)(void); |
215 | |||
216 | /* Set the colour of a single LED in the buffer. */ | 208 | /* Set the colour of a single LED in the buffer. */ |
217 | void (*set_color)(int index, uint8_t r, uint8_t g, uint8_t b); | 209 | void (*set_color)(int index, uint8_t r, uint8_t g, uint8_t b); |
218 | /* Set the colour of all LEDS on the keyboard in the buffer. */ | 210 | /* Set the colour of all LEDS on the keyboard in the buffer. */ |
diff --git a/quantum/rgb_matrix_animations/alpha_mods_anim.h b/quantum/rgb_matrix_animations/alpha_mods_anim.h new file mode 100644 index 000000000..cc1914d7f --- /dev/null +++ b/quantum/rgb_matrix_animations/alpha_mods_anim.h | |||
@@ -0,0 +1,26 @@ | |||
1 | #pragma once | ||
2 | #ifndef DISABLE_RGB_MATRIX_ALPHAS_MODS | ||
3 | |||
4 | extern const rgb_led g_rgb_leds[DRIVER_LED_TOTAL]; | ||
5 | extern rgb_config_t rgb_matrix_config; | ||
6 | |||
7 | // alphas = color1, mods = color2 | ||
8 | bool rgb_matrix_alphas_mods(effect_params_t* params) { | ||
9 | RGB_MATRIX_USE_LIMITS(led_min, led_max); | ||
10 | |||
11 | HSV hsv = { rgb_matrix_config.hue, rgb_matrix_config.sat, rgb_matrix_config.val }; | ||
12 | RGB rgb1 = hsv_to_rgb(hsv); | ||
13 | hsv.h += rgb_matrix_config.speed; | ||
14 | RGB rgb2 = hsv_to_rgb(hsv); | ||
15 | |||
16 | for (uint8_t i = led_min; i < led_max; i++) { | ||
17 | if (g_rgb_leds[i].modifier) { | ||
18 | rgb_matrix_set_color(i, rgb2.r, rgb2.g, rgb2.b); | ||
19 | } else { | ||
20 | rgb_matrix_set_color(i, rgb1.r, rgb1.g, rgb1.b); | ||
21 | } | ||
22 | } | ||
23 | return led_max < DRIVER_LED_TOTAL; | ||
24 | } | ||
25 | |||
26 | #endif // DISABLE_RGB_MATRIX_ALPHAS_MODS | ||
diff --git a/quantum/rgb_matrix_animations/breathing_anim.h b/quantum/rgb_matrix_animations/breathing_anim.h new file mode 100644 index 000000000..fb90b66bd --- /dev/null +++ b/quantum/rgb_matrix_animations/breathing_anim.h | |||
@@ -0,0 +1,19 @@ | |||
1 | #pragma once | ||
2 | #ifndef DISABLE_RGB_MATRIX_BREATHING | ||
3 | |||
4 | extern rgb_config_t rgb_matrix_config; | ||
5 | |||
6 | bool rgb_matrix_breathing(effect_params_t* params) { | ||
7 | RGB_MATRIX_USE_LIMITS(led_min, led_max); | ||
8 | |||
9 | uint16_t time = scale16by8(g_rgb_counters.tick, rgb_matrix_config.speed / 8); | ||
10 | uint8_t val = scale8(abs8(sin8(time) - 128) * 2, rgb_matrix_config.val); | ||
11 | HSV hsv = { rgb_matrix_config.hue, rgb_matrix_config.sat, val }; | ||
12 | RGB rgb = hsv_to_rgb(hsv); | ||
13 | for (uint8_t i = led_min; i < led_max; i++) { | ||
14 | rgb_matrix_set_color(i, rgb.r, rgb.g, rgb.b); | ||
15 | } | ||
16 | return led_max < DRIVER_LED_TOTAL; | ||
17 | } | ||
18 | |||
19 | #endif // DISABLE_RGB_MATRIX_BREATHING | ||
diff --git a/quantum/rgb_matrix_animations/cycle_all_anim.h b/quantum/rgb_matrix_animations/cycle_all_anim.h new file mode 100644 index 000000000..5c18cfa0c --- /dev/null +++ b/quantum/rgb_matrix_animations/cycle_all_anim.h | |||
@@ -0,0 +1,21 @@ | |||
1 | #pragma once | ||
2 | #ifndef DISABLE_RGB_MATRIX_CYCLE_ALL | ||
3 | |||
4 | extern rgb_counters_t g_rgb_counters; | ||
5 | extern const rgb_led g_rgb_leds[DRIVER_LED_TOTAL]; | ||
6 | extern rgb_config_t rgb_matrix_config; | ||
7 | |||
8 | bool rgb_matrix_cycle_all(effect_params_t* params) { | ||
9 | RGB_MATRIX_USE_LIMITS(led_min, led_max); | ||
10 | |||
11 | HSV hsv = { 0, rgb_matrix_config.sat, rgb_matrix_config.val }; | ||
12 | uint8_t time = scale16by8(g_rgb_counters.tick, rgb_matrix_config.speed / 4); | ||
13 | for (uint8_t i = led_min; i < led_max; i++) { | ||
14 | hsv.h = time; | ||
15 | RGB rgb = hsv_to_rgb(hsv); | ||
16 | rgb_matrix_set_color(i, rgb.r, rgb.g, rgb.b); | ||
17 | } | ||
18 | return led_max < DRIVER_LED_TOTAL; | ||
19 | } | ||
20 | |||
21 | #endif // DISABLE_RGB_MATRIX_CYCLE_ALL | ||
diff --git a/quantum/rgb_matrix_animations/cycle_left_right_anim.h b/quantum/rgb_matrix_animations/cycle_left_right_anim.h new file mode 100644 index 000000000..f519aeb47 --- /dev/null +++ b/quantum/rgb_matrix_animations/cycle_left_right_anim.h | |||
@@ -0,0 +1,22 @@ | |||
1 | #pragma once | ||
2 | #ifndef DISABLE_RGB_MATRIX_CYCLE_LEFT_RIGHT | ||
3 | |||
4 | extern rgb_counters_t g_rgb_counters; | ||
5 | extern const rgb_led g_rgb_leds[DRIVER_LED_TOTAL]; | ||
6 | extern rgb_config_t rgb_matrix_config; | ||
7 | |||
8 | bool rgb_matrix_cycle_left_right(effect_params_t* params) { | ||
9 | RGB_MATRIX_USE_LIMITS(led_min, led_max); | ||
10 | |||
11 | HSV hsv = { 0, rgb_matrix_config.sat, rgb_matrix_config.val }; | ||
12 | uint8_t time = scale16by8(g_rgb_counters.tick, rgb_matrix_config.speed / 4); | ||
13 | for (uint8_t i = led_min; i < led_max; i++) { | ||
14 | point_t point = g_rgb_leds[i].point; | ||
15 | hsv.h = point.x - time; | ||
16 | RGB rgb = hsv_to_rgb(hsv); | ||
17 | rgb_matrix_set_color(i, rgb.r, rgb.g, rgb.b); | ||
18 | } | ||
19 | return led_max < DRIVER_LED_TOTAL; | ||
20 | } | ||
21 | |||
22 | #endif // DISABLE_RGB_MATRIX_CYCLE_LEFT_RIGHT | ||
diff --git a/quantum/rgb_matrix_animations/cycle_up_down_anim.h b/quantum/rgb_matrix_animations/cycle_up_down_anim.h new file mode 100644 index 000000000..8b91d890d --- /dev/null +++ b/quantum/rgb_matrix_animations/cycle_up_down_anim.h | |||
@@ -0,0 +1,22 @@ | |||
1 | #pragma once | ||
2 | #ifndef DISABLE_RGB_MATRIX_CYCLE_UP_DOWN | ||
3 | |||
4 | extern rgb_counters_t g_rgb_counters; | ||
5 | extern const rgb_led g_rgb_leds[DRIVER_LED_TOTAL]; | ||
6 | extern rgb_config_t rgb_matrix_config; | ||
7 | |||
8 | bool rgb_matrix_cycle_up_down(effect_params_t* params) { | ||
9 | RGB_MATRIX_USE_LIMITS(led_min, led_max); | ||
10 | |||
11 | HSV hsv = { 0, rgb_matrix_config.sat, rgb_matrix_config.val }; | ||
12 | uint8_t time = scale16by8(g_rgb_counters.tick, rgb_matrix_config.speed / 4); | ||
13 | for (uint8_t i = led_min; i < led_max; i++) { | ||
14 | point_t point = g_rgb_leds[i].point; | ||
15 | hsv.h = point.y - time; | ||
16 | RGB rgb = hsv_to_rgb(hsv); | ||
17 | rgb_matrix_set_color(i, rgb.r, rgb.g, rgb.b); | ||
18 | } | ||
19 | return led_max < DRIVER_LED_TOTAL; | ||
20 | } | ||
21 | |||
22 | #endif // DISABLE_RGB_MATRIX_CYCLE_UP_DOWN | ||
diff --git a/quantum/rgb_matrix_animations/digital_rain_anim.h b/quantum/rgb_matrix_animations/digital_rain_anim.h new file mode 100644 index 000000000..4ba3c1c87 --- /dev/null +++ b/quantum/rgb_matrix_animations/digital_rain_anim.h | |||
@@ -0,0 +1,74 @@ | |||
1 | #pragma once | ||
2 | #ifndef DISABLE_RGB_MATRIX_DIGITAL_RAIN | ||
3 | |||
4 | #ifndef RGB_DIGITAL_RAIN_DROPS | ||
5 | // lower the number for denser effect/wider keyboard | ||
6 | #define RGB_DIGITAL_RAIN_DROPS 24 | ||
7 | #endif | ||
8 | |||
9 | bool rgb_matrix_digital_rain(effect_params_t* params) { | ||
10 | // algorithm ported from https://github.com/tremby/Kaleidoscope-LEDEffect-DigitalRain | ||
11 | const uint8_t drop_ticks = 28; | ||
12 | const uint8_t pure_green_intensity = 0xd0; | ||
13 | const uint8_t max_brightness_boost = 0xc0; | ||
14 | const uint8_t max_intensity = 0xff; | ||
15 | |||
16 | static uint8_t map[MATRIX_COLS][MATRIX_ROWS] = {{0}}; | ||
17 | static uint8_t drop = 0; | ||
18 | |||
19 | if (params->init) { | ||
20 | rgb_matrix_set_color_all(0, 0, 0); | ||
21 | memset(map, 0, sizeof map); | ||
22 | drop = 0; | ||
23 | } | ||
24 | for (uint8_t col = 0; col < MATRIX_COLS; col++) { | ||
25 | for (uint8_t row = 0; row < MATRIX_ROWS; row++) { | ||
26 | if (row == 0 && drop == 0 && rand() < RAND_MAX / RGB_DIGITAL_RAIN_DROPS) { | ||
27 | // top row, pixels have just fallen and we're | ||
28 | // making a new rain drop in this column | ||
29 | map[col][row] = max_intensity; | ||
30 | } | ||
31 | else if (map[col][row] > 0 && map[col][row] < max_intensity) { | ||
32 | // neither fully bright nor dark, decay it | ||
33 | map[col][row]--; | ||
34 | } | ||
35 | // set the pixel colour | ||
36 | uint8_t led[LED_HITS_TO_REMEMBER]; | ||
37 | uint8_t led_count = rgb_matrix_map_row_column_to_led(row, col, led); | ||
38 | |||
39 | // TODO: multiple leds are supported mapped to the same row/column | ||
40 | if (led_count > 0) { | ||
41 | if (map[col][row] > pure_green_intensity) { | ||
42 | const uint8_t boost = (uint8_t) ((uint16_t) max_brightness_boost * (map[col][row] - pure_green_intensity) / (max_intensity - pure_green_intensity)); | ||
43 | rgb_matrix_set_color(led[0], boost, max_intensity, boost); | ||
44 | } | ||
45 | else { | ||
46 | const uint8_t green = (uint8_t) ((uint16_t) max_intensity * map[col][row] / pure_green_intensity); | ||
47 | rgb_matrix_set_color(led[0], 0, green, 0); | ||
48 | } | ||
49 | } | ||
50 | } | ||
51 | } | ||
52 | if (++drop > drop_ticks) { | ||
53 | // reset drop timer | ||
54 | drop = 0; | ||
55 | for (uint8_t row = MATRIX_ROWS - 1; row > 0; row--) { | ||
56 | for (uint8_t col = 0; col < MATRIX_COLS; col++) { | ||
57 | // if ths is on the bottom row and bright allow decay | ||
58 | if (row == MATRIX_ROWS - 1 && map[col][row] == max_intensity) { | ||
59 | map[col][row]--; | ||
60 | } | ||
61 | // check if the pixel above is bright | ||
62 | if (map[col][row - 1] == max_intensity) { | ||
63 | // allow old bright pixel to decay | ||
64 | map[col][row - 1]--; | ||
65 | // make this pixel bright | ||
66 | map[col][row] = max_intensity; | ||
67 | } | ||
68 | } | ||
69 | } | ||
70 | } | ||
71 | return false; | ||
72 | } | ||
73 | |||
74 | #endif // DISABLE_RGB_MATRIX_DIGITAL_RAIN | ||
diff --git a/quantum/rgb_matrix_animations/dual_beacon_anim.h b/quantum/rgb_matrix_animations/dual_beacon_anim.h new file mode 100644 index 000000000..dda315780 --- /dev/null +++ b/quantum/rgb_matrix_animations/dual_beacon_anim.h | |||
@@ -0,0 +1,24 @@ | |||
1 | #pragma once | ||
2 | #ifndef DISABLE_RGB_MATRIX_DUAL_BEACON | ||
3 | |||
4 | extern rgb_counters_t g_rgb_counters; | ||
5 | extern const rgb_led g_rgb_leds[DRIVER_LED_TOTAL]; | ||
6 | extern rgb_config_t rgb_matrix_config; | ||
7 | |||
8 | bool rgb_matrix_dual_beacon(effect_params_t* params) { | ||
9 | RGB_MATRIX_USE_LIMITS(led_min, led_max); | ||
10 | |||
11 | HSV hsv = { 0, rgb_matrix_config.sat, rgb_matrix_config.val }; | ||
12 | uint16_t time = scale16by8(g_rgb_counters.tick, rgb_matrix_config.speed / 4); | ||
13 | int8_t cos_value = cos8(time) - 128; | ||
14 | int8_t sin_value = sin8(time) - 128; | ||
15 | for (uint8_t i = led_min; i < led_max; i++) { | ||
16 | point_t point = g_rgb_leds[i].point; | ||
17 | hsv.h = ((point.y - 32) * cos_value + (point.x - 112) * sin_value) / 128 + rgb_matrix_config.hue; | ||
18 | RGB rgb = hsv_to_rgb(hsv); | ||
19 | rgb_matrix_set_color(i, rgb.r, rgb.g, rgb.b); | ||
20 | } | ||
21 | return led_max < DRIVER_LED_TOTAL; | ||
22 | } | ||
23 | |||
24 | #endif // DISABLE_RGB_MATRIX_DUAL_BEACON | ||
diff --git a/quantum/rgb_matrix_animations/gradient_up_down_anim.h b/quantum/rgb_matrix_animations/gradient_up_down_anim.h new file mode 100644 index 000000000..11498e22f --- /dev/null +++ b/quantum/rgb_matrix_animations/gradient_up_down_anim.h | |||
@@ -0,0 +1,22 @@ | |||
1 | #pragma once | ||
2 | #ifndef DISABLE_RGB_MATRIX_GRADIENT_UP_DOWN | ||
3 | |||
4 | extern const rgb_led g_rgb_leds[DRIVER_LED_TOTAL]; | ||
5 | extern rgb_config_t rgb_matrix_config; | ||
6 | |||
7 | bool rgb_matrix_gradient_up_down(effect_params_t* params) { | ||
8 | RGB_MATRIX_USE_LIMITS(led_min, led_max); | ||
9 | |||
10 | HSV hsv = { 0, rgb_matrix_config.sat, rgb_matrix_config.val }; | ||
11 | uint8_t scale = scale8(64, rgb_matrix_config.speed); | ||
12 | for (uint8_t i = led_min; i < led_max; i++) { | ||
13 | point_t point = g_rgb_leds[i].point; | ||
14 | // The y range will be 0..64, map this to 0..4 | ||
15 | // Relies on hue being 8-bit and wrapping | ||
16 | hsv.h = rgb_matrix_config.hue + scale * (point.y >> 4); | ||
17 | RGB rgb = hsv_to_rgb(hsv); | ||
18 | rgb_matrix_set_color(i, rgb.r, rgb.g, rgb.b); | ||
19 | } | ||
20 | return led_max < DRIVER_LED_TOTAL; | ||
21 | } | ||
22 | #endif // DISABLE_RGB_MATRIX_GRADIENT_UP_DOWN | ||
diff --git a/quantum/rgb_matrix_animations/jellybean_raindrops_anim.h b/quantum/rgb_matrix_animations/jellybean_raindrops_anim.h new file mode 100644 index 000000000..01ff5c230 --- /dev/null +++ b/quantum/rgb_matrix_animations/jellybean_raindrops_anim.h | |||
@@ -0,0 +1,30 @@ | |||
1 | #pragma once | ||
2 | #ifndef DISABLE_RGB_MATRIX_JELLYBEAN_RAINDROPS | ||
3 | |||
4 | extern rgb_counters_t g_rgb_counters; | ||
5 | extern const rgb_led g_rgb_leds[DRIVER_LED_TOTAL]; | ||
6 | extern rgb_config_t rgb_matrix_config; | ||
7 | |||
8 | static void jellybean_raindrops_set_color(int i) { | ||
9 | HSV hsv = { rand() & 0xFF , rand() & 0xFF, rgb_matrix_config.val }; | ||
10 | RGB rgb = hsv_to_rgb(hsv); | ||
11 | rgb_matrix_set_color(i, rgb.r, rgb.g, rgb.b); | ||
12 | } | ||
13 | |||
14 | bool rgb_matrix_jellybean_raindrops(effect_params_t* params) { | ||
15 | if (!params->init) { | ||
16 | // Change one LED every tick, make sure speed is not 0 | ||
17 | if (scale16by8(g_rgb_counters.tick, qadd8(rgb_matrix_config.speed, 16)) % 5 == 0) { | ||
18 | jellybean_raindrops_set_color(rand() % DRIVER_LED_TOTAL); | ||
19 | } | ||
20 | return false; | ||
21 | } | ||
22 | |||
23 | RGB_MATRIX_USE_LIMITS(led_min, led_max); | ||
24 | for (int i = led_min; i < led_max; i++) { | ||
25 | jellybean_raindrops_set_color(i); | ||
26 | } | ||
27 | return led_max < DRIVER_LED_TOTAL; | ||
28 | } | ||
29 | |||
30 | #endif // DISABLE_RGB_MATRIX_JELLYBEAN_RAINDROPS | ||
diff --git a/quantum/rgb_matrix_animations/rainbow_beacon_anim.h b/quantum/rgb_matrix_animations/rainbow_beacon_anim.h new file mode 100644 index 000000000..3c15e64ab --- /dev/null +++ b/quantum/rgb_matrix_animations/rainbow_beacon_anim.h | |||
@@ -0,0 +1,24 @@ | |||
1 | #pragma once | ||
2 | #ifndef DISABLE_RGB_MATRIX_RAINBOW_BEACON | ||
3 | |||
4 | extern rgb_counters_t g_rgb_counters; | ||
5 | extern const rgb_led g_rgb_leds[DRIVER_LED_TOTAL]; | ||
6 | extern rgb_config_t rgb_matrix_config; | ||
7 | |||
8 | bool rgb_matrix_rainbow_beacon(effect_params_t* params) { | ||
9 | RGB_MATRIX_USE_LIMITS(led_min, led_max); | ||
10 | |||
11 | HSV hsv = { 0, rgb_matrix_config.sat, rgb_matrix_config.val }; | ||
12 | uint16_t time = scale16by8(g_rgb_counters.tick, rgb_matrix_config.speed / 4); | ||
13 | int16_t cos_value = 2 * (cos8(time) - 128); | ||
14 | int16_t sin_value = 2 * (sin8(time) - 128); | ||
15 | for (uint8_t i = led_min; i < led_max; i++) { | ||
16 | point_t point = g_rgb_leds[i].point; | ||
17 | hsv.h = ((point.y - 32) * cos_value + (point.x - 112) * sin_value) / 128 + rgb_matrix_config.hue; | ||
18 | RGB rgb = hsv_to_rgb(hsv); | ||
19 | rgb_matrix_set_color(i, rgb.r, rgb.g, rgb.b); | ||
20 | } | ||
21 | return led_max < DRIVER_LED_TOTAL; | ||
22 | } | ||
23 | |||
24 | #endif // DISABLE_RGB_MATRIX_RAINBOW_BEACON | ||
diff --git a/quantum/rgb_matrix_animations/rainbow_moving_chevron_anim.h b/quantum/rgb_matrix_animations/rainbow_moving_chevron_anim.h new file mode 100644 index 000000000..0d11d5280 --- /dev/null +++ b/quantum/rgb_matrix_animations/rainbow_moving_chevron_anim.h | |||
@@ -0,0 +1,22 @@ | |||
1 | #pragma once | ||
2 | #ifndef DISABLE_RGB_MATRIX_RAINBOW_MOVING_CHEVRON | ||
3 | |||
4 | extern rgb_counters_t g_rgb_counters; | ||
5 | extern const rgb_led g_rgb_leds[DRIVER_LED_TOTAL]; | ||
6 | extern rgb_config_t rgb_matrix_config; | ||
7 | |||
8 | bool rgb_matrix_rainbow_moving_chevron(effect_params_t* params) { | ||
9 | RGB_MATRIX_USE_LIMITS(led_min, led_max); | ||
10 | |||
11 | HSV hsv = { 0, rgb_matrix_config.sat, rgb_matrix_config.val }; | ||
12 | uint8_t time = scale16by8(g_rgb_counters.tick, rgb_matrix_config.speed / 4); | ||
13 | for (uint8_t i = led_min; i < led_max; i++) { | ||
14 | point_t point = g_rgb_leds[i].point; | ||
15 | hsv.h = abs8(point.y - 32) + (point.x - time) + rgb_matrix_config.hue; | ||
16 | RGB rgb = hsv_to_rgb(hsv); | ||
17 | rgb_matrix_set_color(i, rgb.r, rgb.g, rgb.b); | ||
18 | } | ||
19 | return led_max < DRIVER_LED_TOTAL; | ||
20 | } | ||
21 | |||
22 | #endif // DISABLE_RGB_MATRIX_RAINBOW_MOVING_CHEVRON | ||
diff --git a/quantum/rgb_matrix_animations/rainbow_pinwheels_anim.h b/quantum/rgb_matrix_animations/rainbow_pinwheels_anim.h new file mode 100644 index 000000000..d7cd42cbe --- /dev/null +++ b/quantum/rgb_matrix_animations/rainbow_pinwheels_anim.h | |||
@@ -0,0 +1,24 @@ | |||
1 | #pragma once | ||
2 | #ifndef DISABLE_RGB_MATRIX_RAINBOW_PINWHEELS | ||
3 | |||
4 | extern rgb_counters_t g_rgb_counters; | ||
5 | extern const rgb_led g_rgb_leds[DRIVER_LED_TOTAL]; | ||
6 | extern rgb_config_t rgb_matrix_config; | ||
7 | |||
8 | bool rgb_matrix_rainbow_pinwheels(effect_params_t* params) { | ||
9 | RGB_MATRIX_USE_LIMITS(led_min, led_max); | ||
10 | |||
11 | HSV hsv = { 0, rgb_matrix_config.sat, rgb_matrix_config.val }; | ||
12 | uint16_t time = scale16by8(g_rgb_counters.tick, rgb_matrix_config.speed / 4); | ||
13 | int16_t cos_value = 3 * (cos8(time) - 128); | ||
14 | int16_t sin_value = 3 * (sin8(time) - 128); | ||
15 | for (uint8_t i = led_min; i < led_max; i++) { | ||
16 | point_t point = g_rgb_leds[i].point; | ||
17 | hsv.h = ((point.y - 32) * cos_value + (56 - abs8(point.x - 112)) * sin_value) / 128 + rgb_matrix_config.hue; | ||
18 | RGB rgb = hsv_to_rgb(hsv); | ||
19 | rgb_matrix_set_color(i, rgb.r, rgb.g, rgb.b); | ||
20 | } | ||
21 | return led_max < DRIVER_LED_TOTAL; | ||
22 | } | ||
23 | |||
24 | #endif // DISABLE_RGB_MATRIX_RAINBOW_PINWHEELS | ||
diff --git a/quantum/rgb_matrix_animations/raindrops_anim.h b/quantum/rgb_matrix_animations/raindrops_anim.h new file mode 100644 index 000000000..fc721375b --- /dev/null +++ b/quantum/rgb_matrix_animations/raindrops_anim.h | |||
@@ -0,0 +1,40 @@ | |||
1 | #pragma once | ||
2 | #ifndef DISABLE_RGB_MATRIX_RAINDROPS | ||
3 | #include "rgb_matrix_types.h" | ||
4 | |||
5 | extern rgb_counters_t g_rgb_counters; | ||
6 | extern rgb_config_t rgb_matrix_config; | ||
7 | |||
8 | static void raindrops_set_color(int i) { | ||
9 | HSV hsv = { 0 , rgb_matrix_config.sat, rgb_matrix_config.val }; | ||
10 | |||
11 | // Take the shortest path between hues | ||
12 | int16_t deltaH = ((rgb_matrix_config.hue + 180) % 360 - rgb_matrix_config.hue) / 4; | ||
13 | if (deltaH > 127) { | ||
14 | deltaH -= 256; | ||
15 | } else if (deltaH < -127) { | ||
16 | deltaH += 256; | ||
17 | } | ||
18 | |||
19 | hsv.h = rgb_matrix_config.hue + (deltaH * (rand() & 0x03)); | ||
20 | RGB rgb = hsv_to_rgb(hsv); | ||
21 | rgb_matrix_set_color(i, rgb.r, rgb.g, rgb.b); | ||
22 | } | ||
23 | |||
24 | bool rgb_matrix_raindrops(effect_params_t* params) { | ||
25 | if (!params->init) { | ||
26 | // Change one LED every tick, make sure speed is not 0 | ||
27 | if (scale16by8(g_rgb_counters.tick, qadd8(rgb_matrix_config.speed, 16)) % 10 == 0) { | ||
28 | raindrops_set_color(rand() % DRIVER_LED_TOTAL); | ||
29 | } | ||
30 | return false; | ||
31 | } | ||
32 | |||
33 | RGB_MATRIX_USE_LIMITS(led_min, led_max); | ||
34 | for (int i = led_min; i < led_max; i++) { | ||
35 | raindrops_set_color(i); | ||
36 | } | ||
37 | return led_max < DRIVER_LED_TOTAL; | ||
38 | } | ||
39 | |||
40 | #endif // DISABLE_RGB_MATRIX_RAINDROPS | ||
diff --git a/quantum/rgb_matrix_animations/solid_color_anim.h b/quantum/rgb_matrix_animations/solid_color_anim.h new file mode 100644 index 000000000..24a197beb --- /dev/null +++ b/quantum/rgb_matrix_animations/solid_color_anim.h | |||
@@ -0,0 +1,14 @@ | |||
1 | #pragma once | ||
2 | |||
3 | extern rgb_config_t rgb_matrix_config; | ||
4 | |||
5 | bool rgb_matrix_solid_color(effect_params_t* params) { | ||
6 | RGB_MATRIX_USE_LIMITS(led_min, led_max); | ||
7 | |||
8 | HSV hsv = { rgb_matrix_config.hue, rgb_matrix_config.sat, rgb_matrix_config.val }; | ||
9 | RGB rgb = hsv_to_rgb(hsv); | ||
10 | for (uint8_t i = led_min; i < led_max; i++) { | ||
11 | rgb_matrix_set_color(i, rgb.r, rgb.g, rgb.b); | ||
12 | } | ||
13 | return led_max < DRIVER_LED_TOTAL; | ||
14 | } | ||
diff --git a/quantum/rgb_matrix_animations/solid_reactive_anim.h b/quantum/rgb_matrix_animations/solid_reactive_anim.h new file mode 100644 index 000000000..220e54233 --- /dev/null +++ b/quantum/rgb_matrix_animations/solid_reactive_anim.h | |||
@@ -0,0 +1,33 @@ | |||
1 | #pragma once | ||
2 | #if defined(RGB_MATRIX_KEYREACTIVE_ENABLED) | ||
3 | #ifndef DISABLE_RGB_MATRIX_SOLID_REACTIVE | ||
4 | |||
5 | extern rgb_config_t rgb_matrix_config; | ||
6 | extern last_hit_t g_last_hit_tracker; | ||
7 | |||
8 | bool rgb_matrix_solid_reactive(effect_params_t* params) { | ||
9 | RGB_MATRIX_USE_LIMITS(led_min, led_max); | ||
10 | |||
11 | HSV hsv = { rgb_matrix_config.hue, 255, rgb_matrix_config.val }; | ||
12 | // Max tick based on speed scale ensures results from scale16by8 with rgb_matrix_config.speed are no greater than 255 | ||
13 | uint16_t max_tick = 65535 / rgb_matrix_config.speed; | ||
14 | // Relies on hue being 8-bit and wrapping | ||
15 | for (uint8_t i = led_min; i < led_max; i++) { | ||
16 | uint16_t tick = max_tick; | ||
17 | for(uint8_t j = 0; j < g_last_hit_tracker.count; j++) { | ||
18 | if (g_last_hit_tracker.index[j] == i && g_last_hit_tracker.tick[j] < tick) { | ||
19 | tick = g_last_hit_tracker.tick[j]; | ||
20 | break; | ||
21 | } | ||
22 | } | ||
23 | |||
24 | uint16_t offset = scale16by8(tick, rgb_matrix_config.speed); | ||
25 | hsv.h = rgb_matrix_config.hue + qsub8(130, offset); | ||
26 | RGB rgb = hsv_to_rgb(hsv); | ||
27 | rgb_matrix_set_color(i, rgb.r, rgb.g, rgb.b); | ||
28 | } | ||
29 | return led_max < DRIVER_LED_TOTAL; | ||
30 | } | ||
31 | |||
32 | #endif // DISABLE_RGB_MATRIX_RAINBOW_MOVING_CHEVRON | ||
33 | #endif // defined(RGB_MATRIX_KEYREACTIVE_ENABLED) | ||
diff --git a/quantum/rgb_matrix_animations/solid_reactive_simple_anim.h b/quantum/rgb_matrix_animations/solid_reactive_simple_anim.h new file mode 100644 index 000000000..e84cd6939 --- /dev/null +++ b/quantum/rgb_matrix_animations/solid_reactive_simple_anim.h | |||
@@ -0,0 +1,32 @@ | |||
1 | #pragma once | ||
2 | #ifdef RGB_MATRIX_KEYREACTIVE_ENABLED | ||
3 | #ifndef DISABLE_RGB_MATRIX_SOLID_REACTIVE_SIMPLE | ||
4 | |||
5 | extern rgb_config_t rgb_matrix_config; | ||
6 | extern last_hit_t g_last_hit_tracker; | ||
7 | |||
8 | bool rgb_matrix_solid_reactive_simple(effect_params_t* params) { | ||
9 | RGB_MATRIX_USE_LIMITS(led_min, led_max); | ||
10 | |||
11 | HSV hsv = { rgb_matrix_config.hue, rgb_matrix_config.sat, 0 }; | ||
12 | // Max tick based on speed scale ensures results from scale16by8 with rgb_matrix_config.speed are no greater than 255 | ||
13 | uint16_t max_tick = 65535 / rgb_matrix_config.speed; | ||
14 | for (uint8_t i = led_min; i < led_max; i++) { | ||
15 | uint16_t tick = max_tick; | ||
16 | for(uint8_t j = 0; j < g_last_hit_tracker.count; j++) { | ||
17 | if (g_last_hit_tracker.index[j] == i && g_last_hit_tracker.tick[j] < tick) { | ||
18 | tick = g_last_hit_tracker.tick[j]; | ||
19 | break; | ||
20 | } | ||
21 | } | ||
22 | |||
23 | uint16_t offset = scale16by8(tick, rgb_matrix_config.speed); | ||
24 | hsv.v = scale8(255 - offset, rgb_matrix_config.val); | ||
25 | RGB rgb = hsv_to_rgb(hsv); | ||
26 | rgb_matrix_set_color(i, rgb.r, rgb.g, rgb.b); | ||
27 | } | ||
28 | return led_max < DRIVER_LED_TOTAL; | ||
29 | } | ||
30 | |||
31 | #endif // DISABLE_RGB_MATRIX_SOLID_REACTIVE_SIMPLE | ||
32 | #endif // RGB_MATRIX_KEYREACTIVE_ENABLED | ||
diff --git a/quantum/rgb_matrix_animations/solid_splash_anim.h b/quantum/rgb_matrix_animations/solid_splash_anim.h new file mode 100644 index 000000000..82ac055b8 --- /dev/null +++ b/quantum/rgb_matrix_animations/solid_splash_anim.h | |||
@@ -0,0 +1,42 @@ | |||
1 | #pragma once | ||
2 | #ifdef RGB_MATRIX_KEYREACTIVE_ENABLED | ||
3 | #if !defined(DISABLE_RGB_MATRIX_SOLID_SPLASH) || !defined(DISABLE_RGB_MATRIX_SOLID_MULTISPLASH) | ||
4 | |||
5 | extern const rgb_led g_rgb_leds[DRIVER_LED_TOTAL]; | ||
6 | extern rgb_config_t rgb_matrix_config; | ||
7 | extern last_hit_t g_last_hit_tracker; | ||
8 | |||
9 | static bool rgb_matrix_solid_multisplash_range(uint8_t start, effect_params_t* params) { | ||
10 | RGB_MATRIX_USE_LIMITS(led_min, led_max); | ||
11 | |||
12 | HSV hsv = { rgb_matrix_config.hue, rgb_matrix_config.sat, 0 }; | ||
13 | uint8_t count = g_last_hit_tracker.count; | ||
14 | for (uint8_t i = led_min; i < led_max; i++) { | ||
15 | hsv.v = 0; | ||
16 | point_t point = g_rgb_leds[i].point; | ||
17 | for (uint8_t j = start; j < count; j++) { | ||
18 | int16_t dx = point.x - g_last_hit_tracker.x[j]; | ||
19 | int16_t dy = point.y - g_last_hit_tracker.y[j]; | ||
20 | uint8_t dist = sqrt16(dx * dx + dy * dy); | ||
21 | uint16_t effect = scale16by8(g_last_hit_tracker.tick[j], rgb_matrix_config.speed) - dist; | ||
22 | if (effect > 255) | ||
23 | effect = 255; | ||
24 | hsv.v = qadd8(hsv.v, 255 - effect); | ||
25 | } | ||
26 | hsv.v = scale8(hsv.v, rgb_matrix_config.val); | ||
27 | RGB rgb = hsv_to_rgb(hsv); | ||
28 | rgb_matrix_set_color(i, rgb.r, rgb.g, rgb.b); | ||
29 | } | ||
30 | return led_max < DRIVER_LED_TOTAL; | ||
31 | } | ||
32 | |||
33 | bool rgb_matrix_solid_multisplash(effect_params_t* params) { | ||
34 | return rgb_matrix_solid_multisplash_range(0, params); | ||
35 | } | ||
36 | |||
37 | bool rgb_matrix_solid_splash(effect_params_t* params) { | ||
38 | return rgb_matrix_solid_multisplash_range(qsub8(g_last_hit_tracker.count, 1), params); | ||
39 | } | ||
40 | |||
41 | #endif // !defined(DISABLE_RGB_MATRIX_SPLASH) && !defined(DISABLE_RGB_MATRIX_MULTISPLASH) | ||
42 | #endif // RGB_MATRIX_KEYREACTIVE_ENABLED | ||
diff --git a/quantum/rgb_matrix_animations/splash_anim.h b/quantum/rgb_matrix_animations/splash_anim.h new file mode 100644 index 000000000..829d30eef --- /dev/null +++ b/quantum/rgb_matrix_animations/splash_anim.h | |||
@@ -0,0 +1,44 @@ | |||
1 | #pragma once | ||
2 | #ifdef RGB_MATRIX_KEYREACTIVE_ENABLED | ||
3 | #if !defined(DISABLE_RGB_MATRIX_SPLASH) || !defined(DISABLE_RGB_MATRIX_MULTISPLASH) | ||
4 | |||
5 | extern const rgb_led g_rgb_leds[DRIVER_LED_TOTAL]; | ||
6 | extern rgb_config_t rgb_matrix_config; | ||
7 | extern last_hit_t g_last_hit_tracker; | ||
8 | |||
9 | static bool rgb_matrix_multisplash_range(uint8_t start, effect_params_t* params) { | ||
10 | RGB_MATRIX_USE_LIMITS(led_min, led_max); | ||
11 | |||
12 | HSV hsv = { 0, rgb_matrix_config.sat, 0 }; | ||
13 | uint8_t count = g_last_hit_tracker.count; | ||
14 | for (uint8_t i = led_min; i < led_max; i++) { | ||
15 | hsv.h = rgb_matrix_config.hue; | ||
16 | hsv.v = 0; | ||
17 | point_t point = g_rgb_leds[i].point; | ||
18 | for (uint8_t j = start; j < count; j++) { | ||
19 | int16_t dx = point.x - g_last_hit_tracker.x[j]; | ||
20 | int16_t dy = point.y - g_last_hit_tracker.y[j]; | ||
21 | uint8_t dist = sqrt16(dx * dx + dy * dy); | ||
22 | uint16_t effect = scale16by8(g_last_hit_tracker.tick[j], rgb_matrix_config.speed) - dist; | ||
23 | if (effect > 255) | ||
24 | effect = 255; | ||
25 | hsv.h += effect; | ||
26 | hsv.v = qadd8(hsv.v, 255 - effect); | ||
27 | } | ||
28 | hsv.v = scale8(hsv.v, rgb_matrix_config.val); | ||
29 | RGB rgb = hsv_to_rgb(hsv); | ||
30 | rgb_matrix_set_color(i, rgb.r, rgb.g, rgb.b); | ||
31 | } | ||
32 | return led_max < DRIVER_LED_TOTAL; | ||
33 | } | ||
34 | |||
35 | bool rgb_matrix_multisplash(effect_params_t* params) { | ||
36 | return rgb_matrix_multisplash_range(0, params); | ||
37 | } | ||
38 | |||
39 | bool rgb_matrix_splash(effect_params_t* params) { | ||
40 | return rgb_matrix_multisplash_range(qsub8(g_last_hit_tracker.count, 1), params); | ||
41 | } | ||
42 | |||
43 | #endif // !defined(DISABLE_RGB_MATRIX_SPLASH) || !defined(DISABLE_RGB_MATRIX_MULTISPLASH) | ||
44 | #endif // RGB_MATRIX_KEYREACTIVE_ENABLED | ||
diff --git a/quantum/rgb_matrix_types.h b/quantum/rgb_matrix_types.h new file mode 100644 index 000000000..f7643d2b0 --- /dev/null +++ b/quantum/rgb_matrix_types.h | |||
@@ -0,0 +1,90 @@ | |||
1 | #pragma once | ||
2 | |||
3 | #include <stdint.h> | ||
4 | #include <stdbool.h> | ||
5 | |||
6 | #if defined(__GNUC__) | ||
7 | #define PACKED __attribute__ ((__packed__)) | ||
8 | #else | ||
9 | #define PACKED | ||
10 | #endif | ||
11 | |||
12 | #if defined(_MSC_VER) | ||
13 | #pragma pack( push, 1 ) | ||
14 | #endif | ||
15 | |||
16 | #if defined(RGB_MATRIX_KEYPRESSES) || defined(RGB_MATRIX_KEYRELEASES) | ||
17 | #define RGB_MATRIX_KEYREACTIVE_ENABLED | ||
18 | #endif | ||
19 | |||
20 | // Last led hit | ||
21 | #ifndef LED_HITS_TO_REMEMBER | ||
22 | #define LED_HITS_TO_REMEMBER 8 | ||
23 | #endif // LED_HITS_TO_REMEMBER | ||
24 | |||
25 | #ifdef RGB_MATRIX_KEYREACTIVE_ENABLED | ||
26 | typedef struct PACKED { | ||
27 | uint8_t count; | ||
28 | uint8_t x[LED_HITS_TO_REMEMBER]; | ||
29 | uint8_t y[LED_HITS_TO_REMEMBER]; | ||
30 | uint8_t index[LED_HITS_TO_REMEMBER]; | ||
31 | uint16_t tick[LED_HITS_TO_REMEMBER]; | ||
32 | } last_hit_t; | ||
33 | #endif // RGB_MATRIX_KEYREACTIVE_ENABLED | ||
34 | |||
35 | typedef enum rgb_task_states { | ||
36 | STARTING, | ||
37 | RENDERING, | ||
38 | FLUSHING, | ||
39 | SYNCING | ||
40 | } rgb_task_states; | ||
41 | |||
42 | typedef uint8_t led_flags_t; | ||
43 | |||
44 | typedef struct PACKED { | ||
45 | uint8_t iter; | ||
46 | led_flags_t flags; | ||
47 | bool init; | ||
48 | } effect_params_t; | ||
49 | |||
50 | typedef struct PACKED { | ||
51 | // Global tick at 20 Hz | ||
52 | uint32_t tick; | ||
53 | // Ticks since this key was last hit. | ||
54 | uint32_t any_key_hit; | ||
55 | } rgb_counters_t; | ||
56 | |||
57 | typedef struct PACKED { | ||
58 | uint8_t x; | ||
59 | uint8_t y; | ||
60 | } point_t; | ||
61 | |||
62 | typedef union { | ||
63 | uint8_t raw; | ||
64 | struct { | ||
65 | uint8_t row:4; // 16 max | ||
66 | uint8_t col:4; // 16 max | ||
67 | }; | ||
68 | } matrix_co_t; | ||
69 | |||
70 | typedef struct PACKED { | ||
71 | matrix_co_t matrix_co; | ||
72 | point_t point; | ||
73 | uint8_t modifier:1; | ||
74 | } rgb_led; | ||
75 | |||
76 | typedef union { | ||
77 | uint32_t raw; | ||
78 | struct PACKED { | ||
79 | bool enable :1; | ||
80 | uint8_t mode :7; | ||
81 | uint8_t hue :8; | ||
82 | uint8_t sat :8; | ||
83 | uint8_t val :8; | ||
84 | uint8_t speed :8;//EECONFIG needs to be increased to support this | ||
85 | }; | ||
86 | } rgb_config_t; | ||
87 | |||
88 | #if defined(_MSC_VER) | ||
89 | #pragma pack( pop ) | ||
90 | #endif | ||