TLIGHT_PRODUCTS / WS281X

Important changes to repositories hosted on mbed.com

Mbed hosted mercurial repositories are deprecated and are due to be permanently deleted in July 2026.

To keep a copy of this software download the repository Zip archive or clone locally using Mercurial.

It is also possible to export all your personal repositories from the account settings page.

WS281X.cpp@19:48ac403f172f, 2016-08-23 (annotated)

Committer:
mutech
Date:
Tue Aug 23 20:26:29 2016 +0000
Revision:
19:48ac403f172f
Parent:
18:d2d14429f7ab
Child:
20:28fe0d0d081b
WS2811/WS2812 Library;

Who changed what in which revision?

UserRevisionLine numberNew contents of line
mutech 0:dff187a80020 1 /* WS281X.cpp (for LPC82X/STM32F0x/STM32F746xx)
mutech 0:dff187a80020 2 * mbed Microcontroller Library
mutech 0:dff187a80020 3 * Copyright (c) 2016 muetch, t.kuroki, MIT License
mutech 0:dff187a80020 4 *
mutech 0:dff187a80020 5 * Permission is hereby granted, free of charge, to any person obtaining a copy of this software
mutech 0:dff187a80020 6 * and associated documentation files (the "Software"), to deal in the Software without restriction,
mutech 0:dff187a80020 7 * including without limitation the rights to use, copy, modify, merge, publish, distribute,
mutech 0:dff187a80020 8 * sublicense, and/or sell copies of the Software, and to permit persons to whom the Software is
mutech 0:dff187a80020 9 * furnished to do so, subject to the following conditions:
mutech 0:dff187a80020 10 *
mutech 0:dff187a80020 11 * The above copyright notice and this permission notice shall be included in all copies or
mutech 0:dff187a80020 12 * substantial portions of the Software.
mutech 0:dff187a80020 13 *
mutech 0:dff187a80020 14 * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR IMPLIED, INCLUDING
mutech 0:dff187a80020 15 * BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND
mutech 0:dff187a80020 16 * NONINFRINGEMENT. IN NO EVENT SHALL THE AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM,
mutech 0:dff187a80020 17 * DAMAGES OR OTHER LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM,
mutech 0:dff187a80020 18 * OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN THE SOFTWARE.
mutech 0:dff187a80020 19 */
mutech 0:dff187a80020 20
mutech 0:dff187a80020 21 #include "WS281X.h"
mutech 6:5aff0da4b663 22 #if defined(TARGET_STM)
mutech 0:dff187a80020 23 #include "pinmap.h"
mutech 6:5aff0da4b663 24 #endif
mutech 0:dff187a80020 25
mutech 4:4af895bb2979 26 // TARGET_STM32F7
mutech 0:dff187a80020 27 // TARGET_DISCO_F746NG
mutech 0:dff187a80020 28 // TARGET_NUCLEO_F746ZG
mutech 4:4af895bb2979 29 // TARGET_STM32F0
mutech 0:dff187a80020 30 // TARGET_NUCLEO_F030R8
mutech 0:dff187a80020 31 // TARGET_NUCLEO_F070RB
mutech 17:55c563d45bfa 32 // TARGET_NUCLEO_F072RB
mutech 4:4af895bb2979 33 // TARGET_LPC82X
mutech 0:dff187a80020 34 // TARGET_LPC824
mutech 0:dff187a80020 35
mutech 0:dff187a80020 36 //----------------------------------------------------------------------------
mutech 0:dff187a80020 37 WS281X::WS281X(PinName wirePin, PinMode pinMode, int numPixels, RGBOrder rgbOrder)
mutech 9:087006b19049 38 : _wirePin(wirePin), _gpio(), _buf_owner(false)
mutech 9:087006b19049 39 {
mutech 9:087006b19049 40 gpio_init_inout(&_gpio, wirePin, PIN_OUTPUT, pinMode, 0);
mutech 9:087006b19049 41 #if defined(TARGET_STM)
mutech 9:087006b19049 42 pin_mode_ex(wirePin, pinMode);
mutech 9:087006b19049 43 #endif
mutech 9:087006b19049 44
mutech 9:087006b19049 45 setRGBOrder(rgbOrder);
mutech 9:087006b19049 46 _dummyPixel = 0;
mutech 9:087006b19049 47 setPixelBuffer(0, numPixels);
mutech 9:087006b19049 48 }
mutech 9:087006b19049 49
mutech 9:087006b19049 50 WS281X::WS281X(PinName wirePin, PinMode pinMode,
mutech 9:087006b19049 51 RGBColor *Buffer, int numPixels, RGBOrder rgbOrder)
mutech 9:087006b19049 52 : _wirePin(wirePin), _gpio(), _buf_owner(false)
mutech 0:dff187a80020 53 {
mutech 0:dff187a80020 54 gpio_init_inout(&_gpio, wirePin, PIN_OUTPUT, pinMode, 0);
mutech 0:dff187a80020 55 #if defined(TARGET_STM)
mutech 0:dff187a80020 56 pin_mode_ex(wirePin, pinMode);
mutech 0:dff187a80020 57 #endif
mutech 0:dff187a80020 58
mutech 0:dff187a80020 59 setRGBOrder(rgbOrder);
mutech 0:dff187a80020 60 _dummyPixel = 0;
mutech 9:087006b19049 61 setPixelBuffer(Buffer, numPixels);
mutech 0:dff187a80020 62 }
mutech 0:dff187a80020 63
mutech 0:dff187a80020 64 WS281X::~WS281X()
mutech 0:dff187a80020 65 {
mutech 9:087006b19049 66 if (_buf_owner && _pixels)
mutech 9:087006b19049 67 delete[] _pixels;
mutech 9:087006b19049 68 }
mutech 9:087006b19049 69
mutech 9:087006b19049 70 void WS281X::setPixelBuffer(RGBColor *Buffer, int numPixels)
mutech 9:087006b19049 71 {
mutech 9:087006b19049 72 if (_buf_owner && _pixels)
mutech 0:dff187a80020 73 delete[] _pixels;
mutech 9:087006b19049 74
mutech 9:087006b19049 75 _buf_owner = false;
mutech 9:087006b19049 76 _pixels = Buffer;
mutech 9:087006b19049 77
mutech 9:087006b19049 78 _numPixels = (numPixels < 0) ? 0 : (numPixels > MAX_PIXELS) ? MAX_PIXELS : numPixels;
mutech 9:087006b19049 79 if (!_pixels && _numPixels > 0)
mutech 9:087006b19049 80 {
mutech 9:087006b19049 81 _pixels = new RGBColor[_numPixels];
mutech 9:087006b19049 82 _buf_owner = true;
mutech 9:087006b19049 83 }
mutech 9:087006b19049 84
mutech 9:087006b19049 85 clear();
mutech 0:dff187a80020 86 }
mutech 0:dff187a80020 87
mutech 0:dff187a80020 88 #if defined(TARGET_STM)
mutech 6:5aff0da4b663 89 /**
mutech 6:5aff0da4b663 90 * Configure pin pull-up/pull-down/OpenDrain
mutech 6:5aff0da4b663 91 * typedef enum {
mutech 6:5aff0da4b663 92 * PullNone = 0,
mutech 6:5aff0da4b663 93 * PullUp = 1,
mutech 6:5aff0da4b663 94 * PullDown = 2,
mutech 6:5aff0da4b663 95 * OpenDrain = 3,
mutech 6:5aff0da4b663 96 * PullDefault = PullNone
mutech 6:5aff0da4b663 97 * } PinMode;
mutech 6:5aff0da4b663 98 */
mutech 0:dff187a80020 99 void WS281X::pin_mode_ex(PinName pin, PinMode mode)
mutech 0:dff187a80020 100 {
mutech 6:5aff0da4b663 101 int port_index = STM_PORT(pin);
mutech 6:5aff0da4b663 102 int pin_index = STM_PIN(pin);
mutech 6:5aff0da4b663 103 int offset = pin_index << 1;
mutech 6:5aff0da4b663 104 GPIO_TypeDef * port_reg = ((GPIO_TypeDef *) (GPIOA_BASE + (port_index << 10)));
mutech 6:5aff0da4b663 105
mutech 6:5aff0da4b663 106 // Configure pull-up/pull-down resistors
mutech 6:5aff0da4b663 107 uint32_t pupd = (uint32_t)mode & 3;
mutech 6:5aff0da4b663 108 if (pupd > 2)
mutech 6:5aff0da4b663 109 pupd = 0; // Open-drain = No pull-up/No pull-down
mutech 6:5aff0da4b663 110
mutech 0:dff187a80020 111 if (mode == OpenDrain)
mutech 0:dff187a80020 112 {
mutech 6:5aff0da4b663 113 port_reg->PUPDR &= ~(0x3 << offset); // Open-drain = No pull-up/No pull-down
mutech 6:5aff0da4b663 114 port_reg->OTYPER |= 1 << pin_index;
mutech 0:dff187a80020 115 }
mutech 0:dff187a80020 116 else
mutech 6:5aff0da4b663 117 {
mutech 6:5aff0da4b663 118 port_reg->OTYPER &= ~(1 << pin_index);
mutech 6:5aff0da4b663 119 // pin_mode(pin, mode);
mutech 6:5aff0da4b663 120 port_reg->PUPDR &= ~(0x3 << offset);
mutech 6:5aff0da4b663 121 port_reg->PUPDR |= (mode & 0x03) << offset;
mutech 6:5aff0da4b663 122 }
mutech 0:dff187a80020 123 }
mutech 0:dff187a80020 124 #endif
mutech 0:dff187a80020 125
mutech 0:dff187a80020 126 void WS281X::setRGBOrder(RGBOrder rgbOrder)
mutech 0:dff187a80020 127 {
mutech 0:dff187a80020 128 _rgbOrder = rgbOrder;
mutech 0:dff187a80020 129 switch(_rgbOrder)
mutech 0:dff187a80020 130 {
mutech 6:5aff0da4b663 131 case RGB: _1st = 0; _2nd = 1; _3rd = 2; break;
mutech 6:5aff0da4b663 132 case RBG: _1st = 0; _2nd = 2; _3rd = 1; break;
mutech 6:5aff0da4b663 133 case GRB: _1st = 1; _2nd = 0; _3rd = 2; break;
mutech 6:5aff0da4b663 134 case GBR: _1st = 2; _2nd = 0; _3rd = 1; break;
mutech 6:5aff0da4b663 135 case BRG: _1st = 1; _2nd = 2; _3rd = 0; break;
mutech 6:5aff0da4b663 136 case BGR: _1st = 2; _2nd = 1; _3rd = 0; break;
mutech 6:5aff0da4b663 137 default: _1st = 0; _2nd = 1; _3rd = 2; break;
mutech 0:dff187a80020 138 }
mutech 0:dff187a80020 139 }
mutech 0:dff187a80020 140
mutech 17:55c563d45bfa 141 //#define _nop1() __nop()
mutech 19:48ac403f172f 142 #define _nop1() do {asm volatile ("nop"); } while(0)
mutech 17:55c563d45bfa 143 #define _nop2() _nop1(); _nop1()
mutech 0:dff187a80020 144 #define _nop3() _nop1(); _nop2()
mutech 0:dff187a80020 145 #define _nop4() _nop2(); _nop2()
mutech 0:dff187a80020 146 #define _nop5() _nop1(); _nop4()
mutech 0:dff187a80020 147 #define _nop6() _nop2(); _nop4()
mutech 0:dff187a80020 148 #define _nop7() _nop3(); _nop4()
mutech 0:dff187a80020 149 #define _nop8() _nop4(); _nop4()
mutech 0:dff187a80020 150 #define _nop9() _nop1(); _nop8()
mutech 0:dff187a80020 151 #define _nop10() _nop2(); _nop8()
mutech 0:dff187a80020 152 #define _nop11() _nop3(); _nop8()
mutech 0:dff187a80020 153 #define _nop12() _nop4(); _nop8()
mutech 0:dff187a80020 154 #define _nop13() _nop5(); _nop8()
mutech 0:dff187a80020 155 #define _nop14() _nop6(); _nop8()
mutech 0:dff187a80020 156 #define _nop15() _nop7(); _nop8()
mutech 0:dff187a80020 157 #define _nop16() _nop8(); _nop8()
mutech 0:dff187a80020 158
mutech 4:4af895bb2979 159 #if defined(TARGET_LPC82X)
mutech 5:8e6835a94e10 160 // LPCXpresso824-MAX (30MHz)
mutech 0:dff187a80020 161 #define DELAY_T0H() do{ _nop2(); }while(0)
mutech 0:dff187a80020 162 #define DELAY_T1H() do{ _nop6(); }while(0)
mutech 0:dff187a80020 163 #define DELAY_TLOW() do{ _nop6(); }while(0)
mutech 0:dff187a80020 164 #define DELAY_TLOW2() //do{ _nop2(); }while(0)
mutech 4:4af895bb2979 165 #define DELAY_SPACE() do{ _nop4(); }while(0)
mutech 4:4af895bb2979 166 #define DELAY_NEXT() //do{ _nop1(); }while(0)
mutech 0:dff187a80020 167 #endif
mutech 0:dff187a80020 168
mutech 0:dff187a80020 169 #if defined(TARGET_STM32F0)
mutech 5:8e6835a94e10 170 // NUCLEO-F030R8 (48MHz)
mutech 5:8e6835a94e10 171 // NUCLEO-F070RB (48MHz)
mutech 0:dff187a80020 172 #define DELAY_T0H() do{ _nop8(); _nop4(); }while(0)
mutech 0:dff187a80020 173 #define DELAY_T1H() do{ _nop8(); _nop8(); }while(0)
mutech 0:dff187a80020 174 #define DELAY_TLOW() do{ _nop16(); }while(0)
mutech 0:dff187a80020 175 #define DELAY_TLOW2() //do{ _nop8(); _nop4(); }while(0)
mutech 4:4af895bb2979 176 #define DELAY_SPACE() do{ _nop8(); _nop6(); }while(0)
mutech 4:4af895bb2979 177 #define DELAY_NEXT() do{ _nop8(); }while(0)
mutech 0:dff187a80020 178 #endif
mutech 0:dff187a80020 179
mutech 6:5aff0da4b663 180 #if defined(TARGET_NUCLEO_F446RE)
mutech 6:5aff0da4b663 181 // NUCLEO-F446RE (180MHz)
mutech 6:5aff0da4b663 182 #define USE_DELAYFUNC 1
mutech 6:5aff0da4b663 183 #define T0H (18)
mutech 6:5aff0da4b663 184 #define T0L (58-T0H)
mutech 6:5aff0da4b663 185 #define T1H (40)
mutech 6:5aff0da4b663 186 #define T1L (58-T1H)
mutech 6:5aff0da4b663 187
mutech 6:5aff0da4b663 188 #define DELAY_T0H() _delay(T0H)
mutech 6:5aff0da4b663 189 #define DELAY_T1H() _delay(T1H-T0H)
mutech 6:5aff0da4b663 190 #define DELAY_TLOW() _delay(T1L)
mutech 6:5aff0da4b663 191 #define DELAY_TLOW2() //DELAY_TLOW()
mutech 6:5aff0da4b663 192 #define DELAY_SPACE() _delay(T1L-2)
mutech 6:5aff0da4b663 193 #define DELAY_NEXT() _delay(16)
mutech 6:5aff0da4b663 194 #endif
mutech 6:5aff0da4b663 195
mutech 4:4af895bb2979 196 #if defined(TARGET_NUCLEO_F746ZG)
mutech 4:4af895bb2979 197 // NUCLEO-F746ZG (216MHz)
mutech 6:5aff0da4b663 198 #define USE_DELAYFUNC 1
mutech 0:dff187a80020 199 #define T0H (35)
mutech 5:8e6835a94e10 200 #define T0L (130-T0H)
mutech 4:4af895bb2979 201 #define T1H (75)
mutech 5:8e6835a94e10 202 #define T1L (130-T1H)
mutech 0:dff187a80020 203
mutech 0:dff187a80020 204 #define DELAY_T0H() _delay(T0H)
mutech 0:dff187a80020 205 #define DELAY_T1H() _delay(T1H-T0H)
mutech 0:dff187a80020 206 #define DELAY_TLOW() _delay(T1L)
mutech 0:dff187a80020 207 #define DELAY_TLOW2() //DELAY_TLOW()
mutech 5:8e6835a94e10 208 #define DELAY_SPACE() _delay(T1L+20)
mutech 4:4af895bb2979 209 #define DELAY_NEXT() _delay(50)
mutech 4:4af895bb2979 210 #endif
mutech 0:dff187a80020 211
mutech 4:4af895bb2979 212 #if defined(TARGET_DISCO_F746NG)
mutech 4:4af895bb2979 213 // TARGET_DISCO_F746NG (216MHz)
mutech 6:5aff0da4b663 214 #define USE_DELAYFUNC 1
mutech 4:4af895bb2979 215 #define T0H (35)
mutech 6:5aff0da4b663 216 #define T0L (125-T0H)
mutech 6:5aff0da4b663 217 #define T1H (90)
mutech 6:5aff0da4b663 218 #define T1L (125-T1H)
mutech 4:4af895bb2979 219
mutech 4:4af895bb2979 220 #define DELAY_T0H() _delay(T0H)
mutech 4:4af895bb2979 221 #define DELAY_T1H() _delay(T1H-T0H)
mutech 4:4af895bb2979 222 #define DELAY_TLOW() _delay(T1L)
mutech 4:4af895bb2979 223 #define DELAY_TLOW2() //DELAY_TLOW()
mutech 6:5aff0da4b663 224 #define DELAY_SPACE() _delay(T1L-5)
mutech 6:5aff0da4b663 225 #define DELAY_NEXT() _delay(40)
mutech 4:4af895bb2979 226 #endif
mutech 4:4af895bb2979 227
mutech 6:5aff0da4b663 228 #if defined(USE_DELAYFUNC) && (USE_DELAYFUNC != 0)
mutech 6:5aff0da4b663 229 static inline __attribute__((always_inline))
mutech 6:5aff0da4b663 230 void _delay(int value)
mutech 0:dff187a80020 231 {
mutech 0:dff187a80020 232 do { __nop(); } while (--value);
mutech 0:dff187a80020 233 }
mutech 0:dff187a80020 234 #endif
mutech 0:dff187a80020 235
mutech 0:dff187a80020 236 inline __attribute__((always_inline))
mutech 0:dff187a80020 237 void WS281X::writeByte(__IO regsize_t *reg_set, __IO regsize_t *reg_clr, regsize_t *mask, uint8_t value)
mutech 0:dff187a80020 238 {
mutech 0:dff187a80020 239 do
mutech 0:dff187a80020 240 {
mutech 6:5aff0da4b663 241 #if 1
mutech 0:dff187a80020 242 // bit7
mutech 0:dff187a80020 243 *reg_set = mask[0];
mutech 0:dff187a80020 244 DELAY_T0H();
mutech 0:dff187a80020 245 *reg_clr = mask[(value >> 7) & 1];
mutech 0:dff187a80020 246 DELAY_T1H();
mutech 0:dff187a80020 247 *reg_clr = mask[0];
mutech 0:dff187a80020 248 DELAY_TLOW();
mutech 0:dff187a80020 249
mutech 0:dff187a80020 250 // bit6
mutech 0:dff187a80020 251 *reg_set = mask[0];
mutech 0:dff187a80020 252 DELAY_T0H();
mutech 0:dff187a80020 253 *reg_clr = mask[(value >> 6) & 1];
mutech 0:dff187a80020 254 DELAY_T1H();
mutech 0:dff187a80020 255 *reg_clr = mask[0];
mutech 0:dff187a80020 256 DELAY_TLOW();
mutech 0:dff187a80020 257
mutech 0:dff187a80020 258 // bit5
mutech 0:dff187a80020 259 *reg_set = mask[0];
mutech 0:dff187a80020 260 DELAY_T0H();
mutech 0:dff187a80020 261 *reg_clr = mask[(value >> 5) & 1];
mutech 0:dff187a80020 262 DELAY_T1H();
mutech 0:dff187a80020 263 *reg_clr = mask[0];
mutech 0:dff187a80020 264 DELAY_TLOW();
mutech 0:dff187a80020 265
mutech 0:dff187a80020 266 // bit4
mutech 0:dff187a80020 267 *reg_set = mask[0];
mutech 0:dff187a80020 268 DELAY_T0H();
mutech 0:dff187a80020 269 *reg_clr = mask[(value >> 4) & 1];
mutech 0:dff187a80020 270 DELAY_T1H();
mutech 0:dff187a80020 271 *reg_clr = mask[0];
mutech 0:dff187a80020 272 DELAY_TLOW();
mutech 6:5aff0da4b663 273 #endif
mutech 0:dff187a80020 274
mutech 0:dff187a80020 275 // bit3
mutech 0:dff187a80020 276 *reg_set = mask[0];
mutech 0:dff187a80020 277 DELAY_T0H();
mutech 0:dff187a80020 278 *reg_clr = mask[(value >> 3) & 1];
mutech 0:dff187a80020 279 DELAY_T1H();
mutech 0:dff187a80020 280 *reg_clr = mask[0];
mutech 0:dff187a80020 281 DELAY_TLOW();
mutech 0:dff187a80020 282
mutech 0:dff187a80020 283 // bit2
mutech 0:dff187a80020 284 *reg_set = mask[0];
mutech 0:dff187a80020 285 DELAY_T0H();
mutech 0:dff187a80020 286 *reg_clr = mask[(value >> 2) & 1];
mutech 0:dff187a80020 287 DELAY_T1H();
mutech 0:dff187a80020 288 *reg_clr = mask[0];
mutech 0:dff187a80020 289 DELAY_TLOW();
mutech 0:dff187a80020 290
mutech 0:dff187a80020 291 // bit1
mutech 0:dff187a80020 292 *reg_set = mask[0];
mutech 0:dff187a80020 293 DELAY_T0H();
mutech 0:dff187a80020 294 *reg_clr = mask[(value >> 1) & 1];
mutech 0:dff187a80020 295 DELAY_T1H();
mutech 0:dff187a80020 296 *reg_clr = mask[0];
mutech 0:dff187a80020 297 DELAY_TLOW();
mutech 0:dff187a80020 298
mutech 0:dff187a80020 299 // bit0
mutech 0:dff187a80020 300 *reg_set = mask[0];
mutech 0:dff187a80020 301 DELAY_T0H();
mutech 0:dff187a80020 302 *reg_clr = mask[(value >> 0) & 1];
mutech 0:dff187a80020 303 DELAY_T1H();
mutech 0:dff187a80020 304 *reg_clr = mask[0];
mutech 0:dff187a80020 305 DELAY_TLOW2();
mutech 0:dff187a80020 306
mutech 0:dff187a80020 307 } while (0);
mutech 0:dff187a80020 308 }
mutech 0:dff187a80020 309
mutech 0:dff187a80020 310 void WS281X::show()
mutech 0:dff187a80020 311 {
mutech 0:dff187a80020 312 // CPU_FREQ = 30MHz -> 0.0333us/cycle
mutech 0:dff187a80020 313 // WS2811 0: 0.25us+1.0us, 1: 1.0us+0.25us
mutech 0:dff187a80020 314 // WS2812 0: 0.45us+0.8us, 1: 0.8us+0.45us
mutech 0:dff187a80020 315
mutech 9:087006b19049 316 if (!_pixels)
mutech 9:087006b19049 317 return;
mutech 9:087006b19049 318
mutech 0:dff187a80020 319 #if defined(TARGET_NXP)
mutech 0:dff187a80020 320 __IO uint32_t *reg_set = _gpio.reg_set;
mutech 0:dff187a80020 321 __IO uint32_t *reg_clr = _gpio.reg_clr;
mutech 0:dff187a80020 322 uint32_t mask[2] = { _gpio.mask, 0 };
mutech 0:dff187a80020 323 #elif defined(TARGET_STM32F0) || defined(TARGET_STM32F1)
mutech 0:dff187a80020 324 __IO uint32_t *reg_set = _gpio.reg_set;
mutech 0:dff187a80020 325 __IO uint32_t *reg_clr = _gpio.reg_clr;
mutech 0:dff187a80020 326 uint32_t mask[2] = { _gpio.mask, 0 };
mutech 0:dff187a80020 327 #elif defined(TARGET_STM)
mutech 0:dff187a80020 328 __IO uint16_t *reg_set = (__IO uint16_t *)_gpio.reg_set_clr;
mutech 0:dff187a80020 329 __IO uint16_t *reg_clr = reg_set + 1;
mutech 0:dff187a80020 330 uint16_t mask[2] = { _gpio.mask, 0 };
mutech 0:dff187a80020 331 #endif
mutech 0:dff187a80020 332
mutech 0:dff187a80020 333 uint8_t *pix = (uint8_t *)_pixels;
mutech 0:dff187a80020 334 uint8_t *end = pix + (_numPixels * sizeof(_pixels[0]));
mutech 0:dff187a80020 335
mutech 0:dff187a80020 336 __disable_irq(); // Disable interrupts temporarily because we don't want our pulse timing to be messed up.
mutech 0:dff187a80020 337
mutech 0:dff187a80020 338 uint8_t value;
mutech 0:dff187a80020 339 do
mutech 0:dff187a80020 340 {
mutech 0:dff187a80020 341 value = pix[_1st];
mutech 0:dff187a80020 342 writeByte(reg_set, reg_clr, mask, value);
mutech 0:dff187a80020 343 DELAY_SPACE();
mutech 0:dff187a80020 344
mutech 0:dff187a80020 345 value = pix[_2nd];
mutech 0:dff187a80020 346 writeByte(reg_set, reg_clr, mask, value);
mutech 0:dff187a80020 347 DELAY_SPACE();
mutech 0:dff187a80020 348
mutech 0:dff187a80020 349 value = pix[_3rd];
mutech 0:dff187a80020 350 writeByte(reg_set, reg_clr, mask, value);
mutech 0:dff187a80020 351 pix += sizeof(_pixels[0]);
mutech 0:dff187a80020 352 DELAY_NEXT();
mutech 0:dff187a80020 353 } while (pix < end);
mutech 0:dff187a80020 354
mutech 0:dff187a80020 355 __enable_irq(); // Re-enable interrupts now that we are done.
mutech 0:dff187a80020 356
mutech 0:dff187a80020 357 wait_us(50);
mutech 0:dff187a80020 358 }
mutech 0:dff187a80020 359
mutech 8:0617f524d67d 360 // 指定位置のピクセルへ色配列を指定サイズ分をコピーする
mutech 8:0617f524d67d 361 void WS281X::setColor(int index, RGBColor *color, int len)
mutech 8:0617f524d67d 362 {
mutech 9:087006b19049 363 if (!_pixels || len < 1 || (uint16_t)index >= _numPixels)
mutech 8:0617f524d67d 364 return;
mutech 8:0617f524d67d 365 if (index + len > _numPixels)
mutech 8:0617f524d67d 366 len = _numPixels - index;
mutech 8:0617f524d67d 367 do
mutech 8:0617f524d67d 368 {
mutech 8:0617f524d67d 369 _pixels[index] = *color;
mutech 8:0617f524d67d 370 ++index;
mutech 8:0617f524d67d 371 ++color;
mutech 8:0617f524d67d 372 } while (--len);
mutech 8:0617f524d67d 373 }
mutech 8:0617f524d67d 374
mutech 8:0617f524d67d 375 // 指定位置のピクセルから指定色を指定サイズ分書き込む
mutech 8:0617f524d67d 376 void WS281X::fillColor(int index, const RGBColor color, int len)
mutech 8:0617f524d67d 377 {
mutech 9:087006b19049 378 if (!_pixels || len < 1 || (uint16_t)index >= _numPixels)
mutech 8:0617f524d67d 379 return;
mutech 8:0617f524d67d 380 if (index + len > _numPixels)
mutech 8:0617f524d67d 381 len = _numPixels - index;
mutech 8:0617f524d67d 382 do
mutech 8:0617f524d67d 383 {
mutech 8:0617f524d67d 384 _pixels[index] = color;
mutech 8:0617f524d67d 385 ++index;
mutech 8:0617f524d67d 386 } while (--len);
mutech 8:0617f524d67d 387 }
mutech 8:0617f524d67d 388
mutech 0:dff187a80020 389 // 先頭から指定サイズ分のブロックをバッファの最後までコピーする
mutech 0:dff187a80020 390 void WS281X::repeatBlock(int block_size)
mutech 0:dff187a80020 391 {
mutech 9:087006b19049 392 if (!_pixels || block_size < 1 || block_size >= _numPixels)
mutech 0:dff187a80020 393 return;
mutech 0:dff187a80020 394
mutech 0:dff187a80020 395 RGBColor *dest = _pixels + block_size;
mutech 0:dff187a80020 396 int left = _numPixels - block_size;
mutech 0:dff187a80020 397 while (left > block_size)
mutech 0:dff187a80020 398 {
mutech 0:dff187a80020 399 memcpy(dest, _pixels, block_size * sizeof(_pixels[0]));
mutech 0:dff187a80020 400 dest += block_size;
mutech 0:dff187a80020 401 left -= block_size;
mutech 0:dff187a80020 402 block_size <<= 1; // 次回は２倍のサイズの転送
mutech 0:dff187a80020 403 }
mutech 0:dff187a80020 404 memcpy(dest, _pixels, left * sizeof(_pixels[0]));
mutech 0:dff187a80020 405 }
mutech 0:dff187a80020 406
mutech 0:dff187a80020 407 // 指定色でバッファを埋める
mutech 8:0617f524d67d 408 void WS281X::clear(const RGBColor color)
mutech 0:dff187a80020 409 {
mutech 9:087006b19049 410 if (_pixels)
mutech 9:087006b19049 411 {
mutech 9:087006b19049 412 _pixels[0] = color;
mutech 9:087006b19049 413 repeatBlock(1);
mutech 9:087006b19049 414 }
mutech 0:dff187a80020 415 }
mutech 0:dff187a80020 416
mutech 0:dff187a80020 417 // 指定色でバッファを埋めた後表示
mutech 8:0617f524d67d 418 void WS281X::show(const RGBColor color)
mutech 0:dff187a80020 419 {
mutech 0:dff187a80020 420 clear(color);
mutech 0:dff187a80020 421 show();
mutech 0:dff187a80020 422 }
mutech 0:dff187a80020 423
mutech 0:dff187a80020 424 //----------------------------------------------------------------------------