diff options
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 | ||
