smalrubot 0.0.5 → 0.0.6

This diff represents the content of publicly available package versions that have been released to one of the supported registries. The information contained in this diff is provided for informational purposes only and reflects changes between package versions as they appear in their respective public registries.
checksums.yaml CHANGED
@@ -1,7 +1,7 @@
1
1
  ---
2
2
  SHA1:
3
- metadata.gz: 0bc7247c9f6d62a1898cf5a1545dc8874f260f58
4
- data.tar.gz: 98476c029588dde1b6ddefcd008042156b6c15cf
3
+ metadata.gz: 3ce651f57013d0e5338ab3e30e112f500741fc04
4
+ data.tar.gz: e285691b27ab53bac6b01ebe2b8747aaeb3029fb
5
5
  SHA512:
6
- metadata.gz: 3401a90486d3930086d6296b73230a25a5df9d34cb380afadff63ede7cf33c7e0c59bbf86bc20ae89918f26ec7f22f8203024a0c0d4af80ccbd0d4561cb92a43
7
- data.tar.gz: 7d81e11de51989d7ee32384f1264eddde0e0a77c3bb17078e06dee38b7d89e6d42e7aad02092f294c53bf04b83768f4edf704f349cab78cdd56e0f8b8d0cc605
6
+ metadata.gz: b0b3b177c7f63a7969c5d7492d1ea35e5b381812276446715c903d43d3cc26b1e59d09c1792116dafe5b8b7de939200b67af98deedb24b0bd17cda18f3076d96
7
+ data.tar.gz: 0f1808e56cebd435cc0d67b02c86928153985c8e0309e334c598f06448f81dd7e554c42c619af0ab69c3c3a9e19c90ff5cfc134e4dc842383b36cc3d3fffc3ee
data/LEGAL CHANGED
@@ -80,3 +80,19 @@ src/lib/Dino.h
80
80
  Copyright (c) 2012 Austin
81
81
  These files were released under the MIT license:
82
82
  https://github.com/austinbv/dino/blob/master/LICENSE .
83
+
84
+ sketch/lib/Adafruit_NeoPixel.cpp
85
+ sketch/lib/Adafruit_NeoPixel.h
86
+
87
+ These were copied from adafruit/Adafruit_NeoPixel ( https://github.com/adafruit/Adafruit_NeoPixel )
88
+ NeoPixel is free software: you can redistribute it and/or modify
89
+ it under the terms of the GNU Lesser General Public License as
90
+ published by the Free Software Foundation, either version 3 of
91
+ the License, or (at your option) any later version.
92
+ NeoPixel is distributed in the hope that it will be useful,
93
+ but WITHOUT ANY WARRANTY; without even the implied warranty of
94
+ MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
95
+ GNU Lesser General Public License for more details.
96
+ You should have received a copy of the GNU Lesser General Public
97
+ License along with NeoPixel. If not, see
98
+ <http://www.gnu.org/licenses/>.
data/README.md CHANGED
@@ -33,7 +33,24 @@ $ gem install smalrubot
33
33
 
34
34
  ## Usage
35
35
 
36
- TODO: Write usage instructions here
36
+ ### Prepare the Bootstrapper
37
+
38
+ Use the included command line tool to create a folder with the Arduino sketch you want to use and optionally configure it.
39
+
40
+ ```shell
41
+ # If using Smalrubot V3, this is all you should need:
42
+ smalrubot generate-sketch sr
43
+
44
+ # If using Smalrubot S1 (a.k.a Studuino), this is all you should need:
45
+ smalrubot generate-sketch sr_studu
46
+ ```
47
+
48
+ ### Upload The Bootstrapper
49
+
50
+ * Connect the Arduino to a USB port on your machine, regardless of which sketch you're using.
51
+ * Open [the normal Arduino IDE](http://arduino.cc/en/Main/Software)
52
+ * Open the `.ino` file in the sketch folder you just generated.
53
+ * Click the upload button (an arrow).
37
54
 
38
55
  ## Contributing
39
56
 
@@ -86,6 +86,9 @@ $options[:sketch_names].uniq.each do |sketch_name|
86
86
  File.open(dest_implementation, 'w') { |f| f.write implementation }
87
87
  File.open(dest_sketch, 'w') { |f| f.write sketch }
88
88
 
89
+ %w(Adafruit_NeoPixel.cpp Adafruit_NeoPixel.h).each do |name|
90
+ FileUtils.cp(File.join(src_dir, 'lib', name), File.join(dest_dir, name))
91
+ end
89
92
  if sketch_name == 'sr_studu'
90
93
  %w(SrStuduino.cpp SrStuduino.h).each do |name|
91
94
  FileUtils.cp(File.join(src_dir, 'lib', name), File.join(dest_dir, name))
@@ -4,12 +4,14 @@ Smalrubot.debug_mode = true
4
4
  board = Smalrubot::Board.new(Smalrubot::TxRx::Serial.new)
5
5
 
6
6
  =begin
7
- board.digital_write(13, 255)
7
+ # LED
8
+ board.digital_write(13, Smalrubot::Board::HIGH)
8
9
  sleep(5)
9
- board.digital_write(13, 0)
10
+ board.digital_write(13, Smalrubot::Board::LOW)
10
11
  =end
11
12
 
12
13
  =begin
14
+ # Analog sensor
13
15
  10.times do
14
16
  p board.analog_read(0)
15
17
  sleep(0.5)
@@ -17,9 +19,36 @@ end
17
19
  =end
18
20
 
19
21
  =begin
22
+ # Button
20
23
  10.times do
21
24
  p board.digital_read(3)
22
25
  p board.digital_read(4)
23
26
  sleep(0.5)
24
27
  end
25
28
  =end
29
+
30
+ =begin
31
+ # Adafruit NeoPixel
32
+ board.set_neo_pixel_pin(5)
33
+
34
+ 3.times do |i|
35
+ 0.step(255, 16).each do |j|
36
+ color = [0, 0, 0]
37
+ color[i] = j
38
+ board.set_neo_pixel_color(0, *color)
39
+ board.show_neo_pixel
40
+ sleep(0.1)
41
+ end
42
+
43
+ 255.step(0, -16).each do |j|
44
+ color = [0, 0, 0]
45
+ color[i] = j
46
+ board.set_neo_pixel_color(0, *color)
47
+ board.show_neo_pixel
48
+ sleep(0.1)
49
+ end
50
+
51
+ board.set_neo_pixel_color(0, 0, 0, 0)
52
+ board.show_neo_pixel
53
+ end
54
+ =end
@@ -35,10 +35,14 @@ module Smalrubot
35
35
  end
36
36
 
37
37
  WRITE_COMMANDS = {
38
- digital_write: '01',
39
- analog_write: '03',
40
- servo_toggle: '08',
41
- servo_write: '09',
38
+ digital_write: '01',
39
+ analog_write: '03',
40
+ servo_toggle: '08',
41
+ servo_write: '09',
42
+ set_neo_pixel_pin: '10',
43
+ set_neo_pixel_num_pixels: '11',
44
+ set_neo_pixel_color: '12',
45
+ show_neo_pixel: '13',
42
46
 
43
47
  set_dc_motor_calibration: '20',
44
48
  init_dc_motor_port: '22',
@@ -51,15 +55,21 @@ module Smalrubot
51
55
  }
52
56
 
53
57
  WRITE_COMMANDS.each_key do |command|
54
- define_method(command) do |pin, value=nil|
58
+ define_method(command) do |pin = 0, *value|
55
59
  cmd = normalize_cmd(WRITE_COMMANDS[command])
56
- write("#{cmd}#{normalize_pin(pin)}#{normalize_value(value)}")
60
+ if value.empty?
61
+ value = [nil]
62
+ end
63
+ values = value.map { |v|
64
+ normalize_value(v)
65
+ }
66
+ write("#{cmd}#{normalize_pin(pin)}#{values.join}")
57
67
  end
58
68
  end
59
69
 
60
70
  READ_COMMANDS = {
61
- digital_read: '02',
62
- analog_read: '04',
71
+ digital_read: '02',
72
+ analog_read: '04',
63
73
 
64
74
  get_touch_sensor_value: '61',
65
75
  get_light_sensor_value: '62',
@@ -1,3 +1,3 @@
1
1
  module Smalrubot
2
- VERSION = '0.0.5'
2
+ VERSION = '0.0.6'
3
3
  end
@@ -0,0 +1,1029 @@
1
+ /*-------------------------------------------------------------------------
2
+ Arduino library to control a wide variety of WS2811- and WS2812-based RGB
3
+ LED devices such as Adafruit FLORA RGB Smart Pixels and NeoPixel strips.
4
+ Currently handles 400 and 800 KHz bitstreams on 8, 12 and 16 MHz ATmega
5
+ MCUs, with LEDs wired for RGB or GRB color order. 8 MHz MCUs provide
6
+ output on PORTB and PORTD, while 16 MHz chips can handle most output pins
7
+ (possible exception with upper PORT registers on the Arduino Mega).
8
+
9
+ Written by Phil Burgess / Paint Your Dragon for Adafruit Industries,
10
+ contributions by PJRC and other members of the open source community.
11
+
12
+ Adafruit invests time and resources providing this open source code,
13
+ please support Adafruit and open-source hardware by purchasing products
14
+ from Adafruit!
15
+
16
+ -------------------------------------------------------------------------
17
+ This file is part of the Adafruit NeoPixel library.
18
+
19
+ NeoPixel is free software: you can redistribute it and/or modify
20
+ it under the terms of the GNU Lesser General Public License as
21
+ published by the Free Software Foundation, either version 3 of
22
+ the License, or (at your option) any later version.
23
+
24
+ NeoPixel is distributed in the hope that it will be useful,
25
+ but WITHOUT ANY WARRANTY; without even the implied warranty of
26
+ MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
27
+ GNU Lesser General Public License for more details.
28
+
29
+ You should have received a copy of the GNU Lesser General Public
30
+ License along with NeoPixel. If not, see
31
+ <http://www.gnu.org/licenses/>.
32
+ -------------------------------------------------------------------------*/
33
+
34
+ #include "Adafruit_NeoPixel.h"
35
+
36
+ Adafruit_NeoPixel::Adafruit_NeoPixel(uint16_t n, uint8_t p, uint8_t t) :
37
+ numLEDs(n), numBytes(n * 3), pin(p), brightness(0),
38
+ pixels(NULL), type(t), endTime(0)
39
+ #ifdef __AVR__
40
+ ,port(portOutputRegister(digitalPinToPort(p))),
41
+ pinMask(digitalPinToBitMask(p))
42
+ #endif
43
+ {
44
+ if((pixels = (uint8_t *)malloc(numBytes))) {
45
+ memset(pixels, 0, numBytes);
46
+ }
47
+ if(t & NEO_GRB) { // GRB vs RGB; might add others if needed
48
+ rOffset = 1;
49
+ gOffset = 0;
50
+ bOffset = 2;
51
+ } else if (t & NEO_BRG) {
52
+ rOffset = 1;
53
+ gOffset = 2;
54
+ bOffset = 0;
55
+ } else {
56
+ rOffset = 0;
57
+ gOffset = 1;
58
+ bOffset = 2;
59
+ }
60
+
61
+ }
62
+
63
+ Adafruit_NeoPixel::~Adafruit_NeoPixel() {
64
+ if(pixels) free(pixels);
65
+ pinMode(pin, INPUT);
66
+ }
67
+
68
+ void Adafruit_NeoPixel::begin(void) {
69
+ pinMode(pin, OUTPUT);
70
+ digitalWrite(pin, LOW);
71
+ }
72
+
73
+ void Adafruit_NeoPixel::show(void) {
74
+
75
+ if(!pixels) return;
76
+
77
+ // Data latch = 50+ microsecond pause in the output stream. Rather than
78
+ // put a delay at the end of the function, the ending time is noted and
79
+ // the function will simply hold off (if needed) on issuing the
80
+ // subsequent round of data until the latch time has elapsed. This
81
+ // allows the mainline code to start generating the next frame of data
82
+ // rather than stalling for the latch.
83
+ while(!canShow());
84
+ // endTime is a private member (rather than global var) so that mutliple
85
+ // instances on different pins can be quickly issued in succession (each
86
+ // instance doesn't delay the next).
87
+
88
+ // In order to make this code runtime-configurable to work with any pin,
89
+ // SBI/CBI instructions are eschewed in favor of full PORT writes via the
90
+ // OUT or ST instructions. It relies on two facts: that peripheral
91
+ // functions (such as PWM) take precedence on output pins, so our PORT-
92
+ // wide writes won't interfere, and that interrupts are globally disabled
93
+ // while data is being issued to the LEDs, so no other code will be
94
+ // accessing the PORT. The code takes an initial 'snapshot' of the PORT
95
+ // state, computes 'pin high' and 'pin low' values, and writes these back
96
+ // to the PORT register as needed.
97
+
98
+ noInterrupts(); // Need 100% focus on instruction timing
99
+
100
+ #ifdef __AVR__
101
+
102
+ volatile uint16_t
103
+ i = numBytes; // Loop counter
104
+ volatile uint8_t
105
+ *ptr = pixels, // Pointer to next byte
106
+ b = *ptr++, // Current byte value
107
+ hi, // PORT w/output bit set high
108
+ lo; // PORT w/output bit set low
109
+
110
+ // Hand-tuned assembly code issues data to the LED drivers at a specific
111
+ // rate. There's separate code for different CPU speeds (8, 12, 16 MHz)
112
+ // for both the WS2811 (400 KHz) and WS2812 (800 KHz) drivers. The
113
+ // datastream timing for the LED drivers allows a little wiggle room each
114
+ // way (listed in the datasheets), so the conditions for compiling each
115
+ // case are set up for a range of frequencies rather than just the exact
116
+ // 8, 12 or 16 MHz values, permitting use with some close-but-not-spot-on
117
+ // devices (e.g. 16.5 MHz DigiSpark). The ranges were arrived at based
118
+ // on the datasheet figures and have not been extensively tested outside
119
+ // the canonical 8/12/16 MHz speeds; there's no guarantee these will work
120
+ // close to the extremes (or possibly they could be pushed further).
121
+ // Keep in mind only one CPU speed case actually gets compiled; the
122
+ // resulting program isn't as massive as it might look from source here.
123
+
124
+ // 8 MHz(ish) AVR ---------------------------------------------------------
125
+ #if (F_CPU >= 7400000UL) && (F_CPU <= 9500000UL)
126
+
127
+ #ifdef NEO_KHZ400
128
+ if((type & NEO_SPDMASK) == NEO_KHZ800) { // 800 KHz bitstream
129
+ #endif
130
+
131
+ volatile uint8_t n1, n2 = 0; // First, next bits out
132
+
133
+ // Squeezing an 800 KHz stream out of an 8 MHz chip requires code
134
+ // specific to each PORT register. At present this is only written
135
+ // to work with pins on PORTD or PORTB, the most likely use case --
136
+ // this covers all the pins on the Adafruit Flora and the bulk of
137
+ // digital pins on the Arduino Pro 8 MHz (keep in mind, this code
138
+ // doesn't even get compiled for 16 MHz boards like the Uno, Mega,
139
+ // Leonardo, etc., so don't bother extending this out of hand).
140
+ // Additional PORTs could be added if you really need them, just
141
+ // duplicate the else and loop and change the PORT. Each add'l
142
+ // PORT will require about 150(ish) bytes of program space.
143
+
144
+ // 10 instruction clocks per bit: HHxxxxxLLL
145
+ // OUT instructions: ^ ^ ^ (T=0,2,7)
146
+
147
+ #ifdef PORTD // PORTD isn't present on ATtiny85, etc.
148
+
149
+ if(port == &PORTD) {
150
+
151
+ hi = PORTD | pinMask;
152
+ lo = PORTD & ~pinMask;
153
+ n1 = lo;
154
+ if(b & 0x80) n1 = hi;
155
+
156
+ // Dirty trick: RJMPs proceeding to the next instruction are used
157
+ // to delay two clock cycles in one instruction word (rather than
158
+ // using two NOPs). This was necessary in order to squeeze the
159
+ // loop down to exactly 64 words -- the maximum possible for a
160
+ // relative branch.
161
+
162
+ asm volatile(
163
+ "headD:" "\n\t" // Clk Pseudocode
164
+ // Bit 7:
165
+ "out %[port] , %[hi]" "\n\t" // 1 PORT = hi
166
+ "mov %[n2] , %[lo]" "\n\t" // 1 n2 = lo
167
+ "out %[port] , %[n1]" "\n\t" // 1 PORT = n1
168
+ "rjmp .+0" "\n\t" // 2 nop nop
169
+ "sbrc %[byte] , 6" "\n\t" // 1-2 if(b & 0x40)
170
+ "mov %[n2] , %[hi]" "\n\t" // 0-1 n2 = hi
171
+ "out %[port] , %[lo]" "\n\t" // 1 PORT = lo
172
+ "rjmp .+0" "\n\t" // 2 nop nop
173
+ // Bit 6:
174
+ "out %[port] , %[hi]" "\n\t" // 1 PORT = hi
175
+ "mov %[n1] , %[lo]" "\n\t" // 1 n1 = lo
176
+ "out %[port] , %[n2]" "\n\t" // 1 PORT = n2
177
+ "rjmp .+0" "\n\t" // 2 nop nop
178
+ "sbrc %[byte] , 5" "\n\t" // 1-2 if(b & 0x20)
179
+ "mov %[n1] , %[hi]" "\n\t" // 0-1 n1 = hi
180
+ "out %[port] , %[lo]" "\n\t" // 1 PORT = lo
181
+ "rjmp .+0" "\n\t" // 2 nop nop
182
+ // Bit 5:
183
+ "out %[port] , %[hi]" "\n\t" // 1 PORT = hi
184
+ "mov %[n2] , %[lo]" "\n\t" // 1 n2 = lo
185
+ "out %[port] , %[n1]" "\n\t" // 1 PORT = n1
186
+ "rjmp .+0" "\n\t" // 2 nop nop
187
+ "sbrc %[byte] , 4" "\n\t" // 1-2 if(b & 0x10)
188
+ "mov %[n2] , %[hi]" "\n\t" // 0-1 n2 = hi
189
+ "out %[port] , %[lo]" "\n\t" // 1 PORT = lo
190
+ "rjmp .+0" "\n\t" // 2 nop nop
191
+ // Bit 4:
192
+ "out %[port] , %[hi]" "\n\t" // 1 PORT = hi
193
+ "mov %[n1] , %[lo]" "\n\t" // 1 n1 = lo
194
+ "out %[port] , %[n2]" "\n\t" // 1 PORT = n2
195
+ "rjmp .+0" "\n\t" // 2 nop nop
196
+ "sbrc %[byte] , 3" "\n\t" // 1-2 if(b & 0x08)
197
+ "mov %[n1] , %[hi]" "\n\t" // 0-1 n1 = hi
198
+ "out %[port] , %[lo]" "\n\t" // 1 PORT = lo
199
+ "rjmp .+0" "\n\t" // 2 nop nop
200
+ // Bit 3:
201
+ "out %[port] , %[hi]" "\n\t" // 1 PORT = hi
202
+ "mov %[n2] , %[lo]" "\n\t" // 1 n2 = lo
203
+ "out %[port] , %[n1]" "\n\t" // 1 PORT = n1
204
+ "rjmp .+0" "\n\t" // 2 nop nop
205
+ "sbrc %[byte] , 2" "\n\t" // 1-2 if(b & 0x04)
206
+ "mov %[n2] , %[hi]" "\n\t" // 0-1 n2 = hi
207
+ "out %[port] , %[lo]" "\n\t" // 1 PORT = lo
208
+ "rjmp .+0" "\n\t" // 2 nop nop
209
+ // Bit 2:
210
+ "out %[port] , %[hi]" "\n\t" // 1 PORT = hi
211
+ "mov %[n1] , %[lo]" "\n\t" // 1 n1 = lo
212
+ "out %[port] , %[n2]" "\n\t" // 1 PORT = n2
213
+ "rjmp .+0" "\n\t" // 2 nop nop
214
+ "sbrc %[byte] , 1" "\n\t" // 1-2 if(b & 0x02)
215
+ "mov %[n1] , %[hi]" "\n\t" // 0-1 n1 = hi
216
+ "out %[port] , %[lo]" "\n\t" // 1 PORT = lo
217
+ "rjmp .+0" "\n\t" // 2 nop nop
218
+ // Bit 1:
219
+ "out %[port] , %[hi]" "\n\t" // 1 PORT = hi
220
+ "mov %[n2] , %[lo]" "\n\t" // 1 n2 = lo
221
+ "out %[port] , %[n1]" "\n\t" // 1 PORT = n1
222
+ "rjmp .+0" "\n\t" // 2 nop nop
223
+ "sbrc %[byte] , 0" "\n\t" // 1-2 if(b & 0x01)
224
+ "mov %[n2] , %[hi]" "\n\t" // 0-1 n2 = hi
225
+ "out %[port] , %[lo]" "\n\t" // 1 PORT = lo
226
+ "sbiw %[count], 1" "\n\t" // 2 i-- (don't act on Z flag yet)
227
+ // Bit 0:
228
+ "out %[port] , %[hi]" "\n\t" // 1 PORT = hi
229
+ "mov %[n1] , %[lo]" "\n\t" // 1 n1 = lo
230
+ "out %[port] , %[n2]" "\n\t" // 1 PORT = n2
231
+ "ld %[byte] , %a[ptr]+" "\n\t" // 2 b = *ptr++
232
+ "sbrc %[byte] , 7" "\n\t" // 1-2 if(b & 0x80)
233
+ "mov %[n1] , %[hi]" "\n\t" // 0-1 n1 = hi
234
+ "out %[port] , %[lo]" "\n\t" // 1 PORT = lo
235
+ "brne headD" "\n" // 2 while(i) (Z flag set above)
236
+ : [byte] "+r" (b),
237
+ [n1] "+r" (n1),
238
+ [n2] "+r" (n2),
239
+ [count] "+w" (i)
240
+ : [port] "I" (_SFR_IO_ADDR(PORTD)),
241
+ [ptr] "e" (ptr),
242
+ [hi] "r" (hi),
243
+ [lo] "r" (lo));
244
+
245
+ } else if(port == &PORTB) {
246
+
247
+ #endif // PORTD
248
+
249
+ // Same as above, just switched to PORTB and stripped of comments.
250
+ hi = PORTB | pinMask;
251
+ lo = PORTB & ~pinMask;
252
+ n1 = lo;
253
+ if(b & 0x80) n1 = hi;
254
+
255
+ asm volatile(
256
+ "headB:" "\n\t"
257
+ "out %[port] , %[hi]" "\n\t"
258
+ "mov %[n2] , %[lo]" "\n\t"
259
+ "out %[port] , %[n1]" "\n\t"
260
+ "rjmp .+0" "\n\t"
261
+ "sbrc %[byte] , 6" "\n\t"
262
+ "mov %[n2] , %[hi]" "\n\t"
263
+ "out %[port] , %[lo]" "\n\t"
264
+ "rjmp .+0" "\n\t"
265
+ "out %[port] , %[hi]" "\n\t"
266
+ "mov %[n1] , %[lo]" "\n\t"
267
+ "out %[port] , %[n2]" "\n\t"
268
+ "rjmp .+0" "\n\t"
269
+ "sbrc %[byte] , 5" "\n\t"
270
+ "mov %[n1] , %[hi]" "\n\t"
271
+ "out %[port] , %[lo]" "\n\t"
272
+ "rjmp .+0" "\n\t"
273
+ "out %[port] , %[hi]" "\n\t"
274
+ "mov %[n2] , %[lo]" "\n\t"
275
+ "out %[port] , %[n1]" "\n\t"
276
+ "rjmp .+0" "\n\t"
277
+ "sbrc %[byte] , 4" "\n\t"
278
+ "mov %[n2] , %[hi]" "\n\t"
279
+ "out %[port] , %[lo]" "\n\t"
280
+ "rjmp .+0" "\n\t"
281
+ "out %[port] , %[hi]" "\n\t"
282
+ "mov %[n1] , %[lo]" "\n\t"
283
+ "out %[port] , %[n2]" "\n\t"
284
+ "rjmp .+0" "\n\t"
285
+ "sbrc %[byte] , 3" "\n\t"
286
+ "mov %[n1] , %[hi]" "\n\t"
287
+ "out %[port] , %[lo]" "\n\t"
288
+ "rjmp .+0" "\n\t"
289
+ "out %[port] , %[hi]" "\n\t"
290
+ "mov %[n2] , %[lo]" "\n\t"
291
+ "out %[port] , %[n1]" "\n\t"
292
+ "rjmp .+0" "\n\t"
293
+ "sbrc %[byte] , 2" "\n\t"
294
+ "mov %[n2] , %[hi]" "\n\t"
295
+ "out %[port] , %[lo]" "\n\t"
296
+ "rjmp .+0" "\n\t"
297
+ "out %[port] , %[hi]" "\n\t"
298
+ "mov %[n1] , %[lo]" "\n\t"
299
+ "out %[port] , %[n2]" "\n\t"
300
+ "rjmp .+0" "\n\t"
301
+ "sbrc %[byte] , 1" "\n\t"
302
+ "mov %[n1] , %[hi]" "\n\t"
303
+ "out %[port] , %[lo]" "\n\t"
304
+ "rjmp .+0" "\n\t"
305
+ "out %[port] , %[hi]" "\n\t"
306
+ "mov %[n2] , %[lo]" "\n\t"
307
+ "out %[port] , %[n1]" "\n\t"
308
+ "rjmp .+0" "\n\t"
309
+ "sbrc %[byte] , 0" "\n\t"
310
+ "mov %[n2] , %[hi]" "\n\t"
311
+ "out %[port] , %[lo]" "\n\t"
312
+ "sbiw %[count], 1" "\n\t"
313
+ "out %[port] , %[hi]" "\n\t"
314
+ "mov %[n1] , %[lo]" "\n\t"
315
+ "out %[port] , %[n2]" "\n\t"
316
+ "ld %[byte] , %a[ptr]+" "\n\t"
317
+ "sbrc %[byte] , 7" "\n\t"
318
+ "mov %[n1] , %[hi]" "\n\t"
319
+ "out %[port] , %[lo]" "\n\t"
320
+ "brne headB" "\n"
321
+ : [byte] "+r" (b), [n1] "+r" (n1), [n2] "+r" (n2), [count] "+w" (i)
322
+ : [port] "I" (_SFR_IO_ADDR(PORTB)), [ptr] "e" (ptr), [hi] "r" (hi),
323
+ [lo] "r" (lo));
324
+
325
+ #ifdef PORTD
326
+ } // endif PORTB
327
+ #endif
328
+
329
+ #ifdef NEO_KHZ400
330
+ } else { // end 800 KHz, do 400 KHz
331
+
332
+ // Timing is more relaxed; unrolling the inner loop for each bit is
333
+ // not necessary. Still using the peculiar RJMPs as 2X NOPs, not out
334
+ // of need but just to trim the code size down a little.
335
+ // This 400-KHz-datastream-on-8-MHz-CPU code is not quite identical
336
+ // to the 800-on-16 code later -- the hi/lo timing between WS2811 and
337
+ // WS2812 is not simply a 2:1 scale!
338
+
339
+ // 20 inst. clocks per bit: HHHHxxxxxxLLLLLLLLLL
340
+ // ST instructions: ^ ^ ^ (T=0,4,10)
341
+
342
+ volatile uint8_t next, bit;
343
+
344
+ hi = *port | pinMask;
345
+ lo = *port & ~pinMask;
346
+ next = lo;
347
+ bit = 8;
348
+
349
+ asm volatile(
350
+ "head20:" "\n\t" // Clk Pseudocode (T = 0)
351
+ "st %a[port], %[hi]" "\n\t" // 2 PORT = hi (T = 2)
352
+ "sbrc %[byte] , 7" "\n\t" // 1-2 if(b & 128)
353
+ "mov %[next], %[hi]" "\n\t" // 0-1 next = hi (T = 4)
354
+ "st %a[port], %[next]" "\n\t" // 2 PORT = next (T = 6)
355
+ "mov %[next] , %[lo]" "\n\t" // 1 next = lo (T = 7)
356
+ "dec %[bit]" "\n\t" // 1 bit-- (T = 8)
357
+ "breq nextbyte20" "\n\t" // 1-2 if(bit == 0)
358
+ "rol %[byte]" "\n\t" // 1 b <<= 1 (T = 10)
359
+ "st %a[port], %[lo]" "\n\t" // 2 PORT = lo (T = 12)
360
+ "rjmp .+0" "\n\t" // 2 nop nop (T = 14)
361
+ "rjmp .+0" "\n\t" // 2 nop nop (T = 16)
362
+ "rjmp .+0" "\n\t" // 2 nop nop (T = 18)
363
+ "rjmp head20" "\n\t" // 2 -> head20 (next bit out)
364
+ "nextbyte20:" "\n\t" // (T = 10)
365
+ "st %a[port], %[lo]" "\n\t" // 2 PORT = lo (T = 12)
366
+ "nop" "\n\t" // 1 nop (T = 13)
367
+ "ldi %[bit] , 8" "\n\t" // 1 bit = 8 (T = 14)
368
+ "ld %[byte] , %a[ptr]+" "\n\t" // 2 b = *ptr++ (T = 16)
369
+ "sbiw %[count], 1" "\n\t" // 2 i-- (T = 18)
370
+ "brne head20" "\n" // 2 if(i != 0) -> (next byte)
371
+ : [port] "+e" (port),
372
+ [byte] "+r" (b),
373
+ [bit] "+r" (bit),
374
+ [next] "+r" (next),
375
+ [count] "+w" (i)
376
+ : [hi] "r" (hi),
377
+ [lo] "r" (lo),
378
+ [ptr] "e" (ptr));
379
+ }
380
+ #endif
381
+
382
+ // 12 MHz(ish) AVR --------------------------------------------------------
383
+ #elif (F_CPU >= 11100000UL) && (F_CPU <= 14300000UL)
384
+
385
+ #ifdef NEO_KHZ400
386
+ if((type & NEO_SPDMASK) == NEO_KHZ800) { // 800 KHz bitstream
387
+ #endif
388
+
389
+ // In the 12 MHz case, an optimized 800 KHz datastream (no dead time
390
+ // between bytes) requires a PORT-specific loop similar to the 8 MHz
391
+ // code (but a little more relaxed in this case).
392
+
393
+ // 15 instruction clocks per bit: HHHHxxxxxxLLLLL
394
+ // OUT instructions: ^ ^ ^ (T=0,4,10)
395
+
396
+ volatile uint8_t next;
397
+
398
+ #ifdef PORTD
399
+
400
+ if(port == &PORTD) {
401
+
402
+ hi = PORTD | pinMask;
403
+ lo = PORTD & ~pinMask;
404
+ next = lo;
405
+ if(b & 0x80) next = hi;
406
+
407
+ // Don't "optimize" the OUT calls into the bitTime subroutine;
408
+ // we're exploiting the RCALL and RET as 3- and 4-cycle NOPs!
409
+ asm volatile(
410
+ "headD:" "\n\t" // (T = 0)
411
+ "out %[port], %[hi]" "\n\t" // (T = 1)
412
+ "rcall bitTimeD" "\n\t" // Bit 7 (T = 15)
413
+ "out %[port], %[hi]" "\n\t"
414
+ "rcall bitTimeD" "\n\t" // Bit 6
415
+ "out %[port], %[hi]" "\n\t"
416
+ "rcall bitTimeD" "\n\t" // Bit 5
417
+ "out %[port], %[hi]" "\n\t"
418
+ "rcall bitTimeD" "\n\t" // Bit 4
419
+ "out %[port], %[hi]" "\n\t"
420
+ "rcall bitTimeD" "\n\t" // Bit 3
421
+ "out %[port], %[hi]" "\n\t"
422
+ "rcall bitTimeD" "\n\t" // Bit 2
423
+ "out %[port], %[hi]" "\n\t"
424
+ "rcall bitTimeD" "\n\t" // Bit 1
425
+ // Bit 0:
426
+ "out %[port] , %[hi]" "\n\t" // 1 PORT = hi (T = 1)
427
+ "rjmp .+0" "\n\t" // 2 nop nop (T = 3)
428
+ "ld %[byte] , %a[ptr]+" "\n\t" // 2 b = *ptr++ (T = 5)
429
+ "out %[port] , %[next]" "\n\t" // 1 PORT = next (T = 6)
430
+ "mov %[next] , %[lo]" "\n\t" // 1 next = lo (T = 7)
431
+ "sbrc %[byte] , 7" "\n\t" // 1-2 if(b & 0x80) (T = 8)
432
+ "mov %[next] , %[hi]" "\n\t" // 0-1 next = hi (T = 9)
433
+ "nop" "\n\t" // 1 (T = 10)
434
+ "out %[port] , %[lo]" "\n\t" // 1 PORT = lo (T = 11)
435
+ "sbiw %[count], 1" "\n\t" // 2 i-- (T = 13)
436
+ "brne headD" "\n\t" // 2 if(i != 0) -> (next byte)
437
+ "rjmp doneD" "\n\t"
438
+ "bitTimeD:" "\n\t" // nop nop nop (T = 4)
439
+ "out %[port], %[next]" "\n\t" // 1 PORT = next (T = 5)
440
+ "mov %[next], %[lo]" "\n\t" // 1 next = lo (T = 6)
441
+ "rol %[byte]" "\n\t" // 1 b <<= 1 (T = 7)
442
+ "sbrc %[byte], 7" "\n\t" // 1-2 if(b & 0x80) (T = 8)
443
+ "mov %[next], %[hi]" "\n\t" // 0-1 next = hi (T = 9)
444
+ "nop" "\n\t" // 1 (T = 10)
445
+ "out %[port], %[lo]" "\n\t" // 1 PORT = lo (T = 11)
446
+ "ret" "\n\t" // 4 nop nop nop nop (T = 15)
447
+ "doneD:" "\n"
448
+ : [byte] "+r" (b),
449
+ [next] "+r" (next),
450
+ [count] "+w" (i)
451
+ : [port] "I" (_SFR_IO_ADDR(PORTD)),
452
+ [ptr] "e" (ptr),
453
+ [hi] "r" (hi),
454
+ [lo] "r" (lo));
455
+
456
+ } else if(port == &PORTB) {
457
+
458
+ #endif // PORTD
459
+
460
+ hi = PORTB | pinMask;
461
+ lo = PORTB & ~pinMask;
462
+ next = lo;
463
+ if(b & 0x80) next = hi;
464
+
465
+ // Same as above, just set for PORTB & stripped of comments
466
+ asm volatile(
467
+ "headB:" "\n\t"
468
+ "out %[port], %[hi]" "\n\t"
469
+ "rcall bitTimeB" "\n\t"
470
+ "out %[port], %[hi]" "\n\t"
471
+ "rcall bitTimeB" "\n\t"
472
+ "out %[port], %[hi]" "\n\t"
473
+ "rcall bitTimeB" "\n\t"
474
+ "out %[port], %[hi]" "\n\t"
475
+ "rcall bitTimeB" "\n\t"
476
+ "out %[port], %[hi]" "\n\t"
477
+ "rcall bitTimeB" "\n\t"
478
+ "out %[port], %[hi]" "\n\t"
479
+ "rcall bitTimeB" "\n\t"
480
+ "out %[port], %[hi]" "\n\t"
481
+ "rcall bitTimeB" "\n\t"
482
+ "out %[port] , %[hi]" "\n\t"
483
+ "rjmp .+0" "\n\t"
484
+ "ld %[byte] , %a[ptr]+" "\n\t"
485
+ "out %[port] , %[next]" "\n\t"
486
+ "mov %[next] , %[lo]" "\n\t"
487
+ "sbrc %[byte] , 7" "\n\t"
488
+ "mov %[next] , %[hi]" "\n\t"
489
+ "nop" "\n\t"
490
+ "out %[port] , %[lo]" "\n\t"
491
+ "sbiw %[count], 1" "\n\t"
492
+ "brne headB" "\n\t"
493
+ "rjmp doneB" "\n\t"
494
+ "bitTimeB:" "\n\t"
495
+ "out %[port], %[next]" "\n\t"
496
+ "mov %[next], %[lo]" "\n\t"
497
+ "rol %[byte]" "\n\t"
498
+ "sbrc %[byte], 7" "\n\t"
499
+ "mov %[next], %[hi]" "\n\t"
500
+ "nop" "\n\t"
501
+ "out %[port], %[lo]" "\n\t"
502
+ "ret" "\n\t"
503
+ "doneB:" "\n"
504
+ : [byte] "+r" (b), [next] "+r" (next), [count] "+w" (i)
505
+ : [port] "I" (_SFR_IO_ADDR(PORTB)), [ptr] "e" (ptr), [hi] "r" (hi),
506
+ [lo] "r" (lo));
507
+
508
+ #ifdef PORTD
509
+ }
510
+ #endif
511
+
512
+ #ifdef NEO_KHZ400
513
+ } else { // 400 KHz
514
+
515
+ // 30 instruction clocks per bit: HHHHHHxxxxxxxxxLLLLLLLLLLLLLLL
516
+ // ST instructions: ^ ^ ^ (T=0,6,15)
517
+
518
+ volatile uint8_t next, bit;
519
+
520
+ hi = *port | pinMask;
521
+ lo = *port & ~pinMask;
522
+ next = lo;
523
+ bit = 8;
524
+
525
+ asm volatile(
526
+ "head30:" "\n\t" // Clk Pseudocode (T = 0)
527
+ "st %a[port], %[hi]" "\n\t" // 2 PORT = hi (T = 2)
528
+ "sbrc %[byte] , 7" "\n\t" // 1-2 if(b & 128)
529
+ "mov %[next], %[hi]" "\n\t" // 0-1 next = hi (T = 4)
530
+ "rjmp .+0" "\n\t" // 2 nop nop (T = 6)
531
+ "st %a[port], %[next]" "\n\t" // 2 PORT = next (T = 8)
532
+ "rjmp .+0" "\n\t" // 2 nop nop (T = 10)
533
+ "rjmp .+0" "\n\t" // 2 nop nop (T = 12)
534
+ "rjmp .+0" "\n\t" // 2 nop nop (T = 14)
535
+ "nop" "\n\t" // 1 nop (T = 15)
536
+ "st %a[port], %[lo]" "\n\t" // 2 PORT = lo (T = 17)
537
+ "rjmp .+0" "\n\t" // 2 nop nop (T = 19)
538
+ "dec %[bit]" "\n\t" // 1 bit-- (T = 20)
539
+ "breq nextbyte30" "\n\t" // 1-2 if(bit == 0)
540
+ "rol %[byte]" "\n\t" // 1 b <<= 1 (T = 22)
541
+ "rjmp .+0" "\n\t" // 2 nop nop (T = 24)
542
+ "rjmp .+0" "\n\t" // 2 nop nop (T = 26)
543
+ "rjmp .+0" "\n\t" // 2 nop nop (T = 28)
544
+ "rjmp head30" "\n\t" // 2 -> head30 (next bit out)
545
+ "nextbyte30:" "\n\t" // (T = 22)
546
+ "nop" "\n\t" // 1 nop (T = 23)
547
+ "ldi %[bit] , 8" "\n\t" // 1 bit = 8 (T = 24)
548
+ "ld %[byte] , %a[ptr]+" "\n\t" // 2 b = *ptr++ (T = 26)
549
+ "sbiw %[count], 1" "\n\t" // 2 i-- (T = 28)
550
+ "brne head30" "\n" // 1-2 if(i != 0) -> (next byte)
551
+ : [port] "+e" (port),
552
+ [byte] "+r" (b),
553
+ [bit] "+r" (bit),
554
+ [next] "+r" (next),
555
+ [count] "+w" (i)
556
+ : [hi] "r" (hi),
557
+ [lo] "r" (lo),
558
+ [ptr] "e" (ptr));
559
+ }
560
+ #endif
561
+
562
+ // 16 MHz(ish) AVR --------------------------------------------------------
563
+ #elif (F_CPU >= 15400000UL) && (F_CPU <= 19000000L)
564
+
565
+ #ifdef NEO_KHZ400
566
+ if((type & NEO_SPDMASK) == NEO_KHZ800) { // 800 KHz bitstream
567
+ #endif
568
+
569
+ // WS2811 and WS2812 have different hi/lo duty cycles; this is
570
+ // similar but NOT an exact copy of the prior 400-on-8 code.
571
+
572
+ // 20 inst. clocks per bit: HHHHHxxxxxxxxLLLLLLL
573
+ // ST instructions: ^ ^ ^ (T=0,5,13)
574
+
575
+ volatile uint8_t next, bit;
576
+
577
+ hi = *port | pinMask;
578
+ lo = *port & ~pinMask;
579
+ next = lo;
580
+ bit = 8;
581
+
582
+ asm volatile(
583
+ "head20:" "\n\t" // Clk Pseudocode (T = 0)
584
+ "st %a[port], %[hi]" "\n\t" // 2 PORT = hi (T = 2)
585
+ "sbrc %[byte], 7" "\n\t" // 1-2 if(b & 128)
586
+ "mov %[next], %[hi]" "\n\t" // 0-1 next = hi (T = 4)
587
+ "dec %[bit]" "\n\t" // 1 bit-- (T = 5)
588
+ "st %a[port], %[next]" "\n\t" // 2 PORT = next (T = 7)
589
+ "mov %[next] , %[lo]" "\n\t" // 1 next = lo (T = 8)
590
+ "breq nextbyte20" "\n\t" // 1-2 if(bit == 0) (from dec above)
591
+ "rol %[byte]" "\n\t" // 1 b <<= 1 (T = 10)
592
+ "rjmp .+0" "\n\t" // 2 nop nop (T = 12)
593
+ "nop" "\n\t" // 1 nop (T = 13)
594
+ "st %a[port], %[lo]" "\n\t" // 2 PORT = lo (T = 15)
595
+ "nop" "\n\t" // 1 nop (T = 16)
596
+ "rjmp .+0" "\n\t" // 2 nop nop (T = 18)
597
+ "rjmp head20" "\n\t" // 2 -> head20 (next bit out)
598
+ "nextbyte20:" "\n\t" // (T = 10)
599
+ "ldi %[bit] , 8" "\n\t" // 1 bit = 8 (T = 11)
600
+ "ld %[byte] , %a[ptr]+" "\n\t" // 2 b = *ptr++ (T = 13)
601
+ "st %a[port], %[lo]" "\n\t" // 2 PORT = lo (T = 15)
602
+ "nop" "\n\t" // 1 nop (T = 16)
603
+ "sbiw %[count], 1" "\n\t" // 2 i-- (T = 18)
604
+ "brne head20" "\n" // 2 if(i != 0) -> (next byte)
605
+ : [port] "+e" (port),
606
+ [byte] "+r" (b),
607
+ [bit] "+r" (bit),
608
+ [next] "+r" (next),
609
+ [count] "+w" (i)
610
+ : [ptr] "e" (ptr),
611
+ [hi] "r" (hi),
612
+ [lo] "r" (lo));
613
+
614
+ #ifdef NEO_KHZ400
615
+ } else { // 400 KHz
616
+
617
+ // The 400 KHz clock on 16 MHz MCU is the most 'relaxed' version.
618
+
619
+ // 40 inst. clocks per bit: HHHHHHHHxxxxxxxxxxxxLLLLLLLLLLLLLLLLLLLL
620
+ // ST instructions: ^ ^ ^ (T=0,8,20)
621
+
622
+ volatile uint8_t next, bit;
623
+
624
+ hi = *port | pinMask;
625
+ lo = *port & ~pinMask;
626
+ next = lo;
627
+ bit = 8;
628
+
629
+ asm volatile(
630
+ "head40:" "\n\t" // Clk Pseudocode (T = 0)
631
+ "st %a[port], %[hi]" "\n\t" // 2 PORT = hi (T = 2)
632
+ "sbrc %[byte] , 7" "\n\t" // 1-2 if(b & 128)
633
+ "mov %[next] , %[hi]" "\n\t" // 0-1 next = hi (T = 4)
634
+ "rjmp .+0" "\n\t" // 2 nop nop (T = 6)
635
+ "rjmp .+0" "\n\t" // 2 nop nop (T = 8)
636
+ "st %a[port], %[next]" "\n\t" // 2 PORT = next (T = 10)
637
+ "rjmp .+0" "\n\t" // 2 nop nop (T = 12)
638
+ "rjmp .+0" "\n\t" // 2 nop nop (T = 14)
639
+ "rjmp .+0" "\n\t" // 2 nop nop (T = 16)
640
+ "rjmp .+0" "\n\t" // 2 nop nop (T = 18)
641
+ "rjmp .+0" "\n\t" // 2 nop nop (T = 20)
642
+ "st %a[port], %[lo]" "\n\t" // 2 PORT = lo (T = 22)
643
+ "nop" "\n\t" // 1 nop (T = 23)
644
+ "mov %[next] , %[lo]" "\n\t" // 1 next = lo (T = 24)
645
+ "dec %[bit]" "\n\t" // 1 bit-- (T = 25)
646
+ "breq nextbyte40" "\n\t" // 1-2 if(bit == 0)
647
+ "rol %[byte]" "\n\t" // 1 b <<= 1 (T = 27)
648
+ "nop" "\n\t" // 1 nop (T = 28)
649
+ "rjmp .+0" "\n\t" // 2 nop nop (T = 30)
650
+ "rjmp .+0" "\n\t" // 2 nop nop (T = 32)
651
+ "rjmp .+0" "\n\t" // 2 nop nop (T = 34)
652
+ "rjmp .+0" "\n\t" // 2 nop nop (T = 36)
653
+ "rjmp .+0" "\n\t" // 2 nop nop (T = 38)
654
+ "rjmp head40" "\n\t" // 2 -> head40 (next bit out)
655
+ "nextbyte40:" "\n\t" // (T = 27)
656
+ "ldi %[bit] , 8" "\n\t" // 1 bit = 8 (T = 28)
657
+ "ld %[byte] , %a[ptr]+" "\n\t" // 2 b = *ptr++ (T = 30)
658
+ "rjmp .+0" "\n\t" // 2 nop nop (T = 32)
659
+ "st %a[port], %[lo]" "\n\t" // 2 PORT = lo (T = 34)
660
+ "rjmp .+0" "\n\t" // 2 nop nop (T = 36)
661
+ "sbiw %[count], 1" "\n\t" // 2 i-- (T = 38)
662
+ "brne head40" "\n" // 1-2 if(i != 0) -> (next byte)
663
+ : [port] "+e" (port),
664
+ [byte] "+r" (b),
665
+ [bit] "+r" (bit),
666
+ [next] "+r" (next),
667
+ [count] "+w" (i)
668
+ : [ptr] "e" (ptr),
669
+ [hi] "r" (hi),
670
+ [lo] "r" (lo));
671
+ }
672
+ #endif
673
+
674
+ #else
675
+ #error "CPU SPEED NOT SUPPORTED"
676
+ #endif
677
+
678
+ #elif defined(__arm__)
679
+
680
+ #if defined(__MK20DX128__) || defined(__MK20DX256__) // Teensy 3.0 & 3.1
681
+ #define CYCLES_800_T0H (F_CPU / 4000000)
682
+ #define CYCLES_800_T1H (F_CPU / 1250000)
683
+ #define CYCLES_800 (F_CPU / 800000)
684
+ #define CYCLES_400_T0H (F_CPU / 2000000)
685
+ #define CYCLES_400_T1H (F_CPU / 833333)
686
+ #define CYCLES_400 (F_CPU / 400000)
687
+
688
+ uint8_t *p = pixels,
689
+ *end = p + numBytes, pix, mask;
690
+ volatile uint8_t *set = portSetRegister(pin),
691
+ *clr = portClearRegister(pin);
692
+ uint32_t cyc;
693
+
694
+ ARM_DEMCR |= ARM_DEMCR_TRCENA;
695
+ ARM_DWT_CTRL |= ARM_DWT_CTRL_CYCCNTENA;
696
+
697
+ #ifdef NEO_KHZ400
698
+ if((type & NEO_SPDMASK) == NEO_KHZ800) { // 800 KHz bitstream
699
+ #endif
700
+ cyc = ARM_DWT_CYCCNT + CYCLES_800;
701
+ while(p < end) {
702
+ pix = *p++;
703
+ for(mask = 0x80; mask; mask >>= 1) {
704
+ while(ARM_DWT_CYCCNT - cyc < CYCLES_800);
705
+ cyc = ARM_DWT_CYCCNT;
706
+ *set = 1;
707
+ if(pix & mask) {
708
+ while(ARM_DWT_CYCCNT - cyc < CYCLES_800_T1H);
709
+ } else {
710
+ while(ARM_DWT_CYCCNT - cyc < CYCLES_800_T0H);
711
+ }
712
+ *clr = 1;
713
+ }
714
+ }
715
+ while(ARM_DWT_CYCCNT - cyc < CYCLES_800);
716
+ #ifdef NEO_KHZ400
717
+ } else { // 400 kHz bitstream
718
+ cyc = ARM_DWT_CYCCNT + CYCLES_400;
719
+ while(p < end) {
720
+ pix = *p++;
721
+ for(mask = 0x80; mask; mask >>= 1) {
722
+ while(ARM_DWT_CYCCNT - cyc < CYCLES_400);
723
+ cyc = ARM_DWT_CYCCNT;
724
+ *set = 1;
725
+ if(pix & mask) {
726
+ while(ARM_DWT_CYCCNT - cyc < CYCLES_400_T1H);
727
+ } else {
728
+ while(ARM_DWT_CYCCNT - cyc < CYCLES_400_T0H);
729
+ }
730
+ *clr = 1;
731
+ }
732
+ }
733
+ while(ARM_DWT_CYCCNT - cyc < CYCLES_400);
734
+ }
735
+ #endif
736
+
737
+
738
+
739
+
740
+
741
+ #elif defined(__MKL26Z64__) // Teensy-LC
742
+
743
+ #if F_CPU == 48000000
744
+ uint8_t *p = pixels,
745
+ pix, count, dly,
746
+ bitmask = digitalPinToBitMask(pin);
747
+ volatile uint8_t *reg = portSetRegister(pin);
748
+ uint32_t num = numBytes;
749
+ asm volatile(
750
+ "L%=_begin:" "\n\t"
751
+ "ldrb %[pix], [%[p], #0]" "\n\t"
752
+ "lsl %[pix], #24" "\n\t"
753
+ "movs %[count], #7" "\n\t"
754
+ "L%=_loop:" "\n\t"
755
+ "lsl %[pix], #1" "\n\t"
756
+ "bcs L%=_loop_one" "\n\t"
757
+ "L%=_loop_zero:"
758
+ "strb %[bitmask], [%[reg], #0]" "\n\t"
759
+ "movs %[dly], #4" "\n\t"
760
+ "L%=_loop_delay_T0H:" "\n\t"
761
+ "sub %[dly], #1" "\n\t"
762
+ "bne L%=_loop_delay_T0H" "\n\t"
763
+ "strb %[bitmask], [%[reg], #4]" "\n\t"
764
+ "movs %[dly], #13" "\n\t"
765
+ "L%=_loop_delay_T0L:" "\n\t"
766
+ "sub %[dly], #1" "\n\t"
767
+ "bne L%=_loop_delay_T0L" "\n\t"
768
+ "b L%=_next" "\n\t"
769
+ "L%=_loop_one:"
770
+ "strb %[bitmask], [%[reg], #0]" "\n\t"
771
+ "movs %[dly], #13" "\n\t"
772
+ "L%=_loop_delay_T1H:" "\n\t"
773
+ "sub %[dly], #1" "\n\t"
774
+ "bne L%=_loop_delay_T1H" "\n\t"
775
+ "strb %[bitmask], [%[reg], #4]" "\n\t"
776
+ "movs %[dly], #4" "\n\t"
777
+ "L%=_loop_delay_T1L:" "\n\t"
778
+ "sub %[dly], #1" "\n\t"
779
+ "bne L%=_loop_delay_T1L" "\n\t"
780
+ "nop" "\n\t"
781
+ "L%=_next:" "\n\t"
782
+ "sub %[count], #1" "\n\t"
783
+ "bne L%=_loop" "\n\t"
784
+ "lsl %[pix], #1" "\n\t"
785
+ "bcs L%=_last_one" "\n\t"
786
+ "L%=_last_zero:"
787
+ "strb %[bitmask], [%[reg], #0]" "\n\t"
788
+ "movs %[dly], #4" "\n\t"
789
+ "L%=_last_delay_T0H:" "\n\t"
790
+ "sub %[dly], #1" "\n\t"
791
+ "bne L%=_last_delay_T0H" "\n\t"
792
+ "strb %[bitmask], [%[reg], #4]" "\n\t"
793
+ "movs %[dly], #10" "\n\t"
794
+ "L%=_last_delay_T0L:" "\n\t"
795
+ "sub %[dly], #1" "\n\t"
796
+ "bne L%=_last_delay_T0L" "\n\t"
797
+ "b L%=_repeat" "\n\t"
798
+ "L%=_last_one:"
799
+ "strb %[bitmask], [%[reg], #0]" "\n\t"
800
+ "movs %[dly], #13" "\n\t"
801
+ "L%=_last_delay_T1H:" "\n\t"
802
+ "sub %[dly], #1" "\n\t"
803
+ "bne L%=_last_delay_T1H" "\n\t"
804
+ "strb %[bitmask], [%[reg], #4]" "\n\t"
805
+ "movs %[dly], #1" "\n\t"
806
+ "L%=_last_delay_T1L:" "\n\t"
807
+ "sub %[dly], #1" "\n\t"
808
+ "bne L%=_last_delay_T1L" "\n\t"
809
+ "nop" "\n\t"
810
+ "L%=_repeat:" "\n\t"
811
+ "add %[p], #1" "\n\t"
812
+ "sub %[num], #1" "\n\t"
813
+ "bne L%=_begin" "\n\t"
814
+ "L%=_done:" "\n\t"
815
+ : [p] "+r" (p),
816
+ [pix] "=&r" (pix),
817
+ [count] "=&r" (count),
818
+ [dly] "=&r" (dly),
819
+ [num] "+r" (num)
820
+ : [bitmask] "r" (bitmask),
821
+ [reg] "r" (reg)
822
+ );
823
+ #else
824
+ #error "Sorry, only 48 MHz is supported, please set Tools > CPU Speed to 48 MHz"
825
+ #endif
826
+
827
+
828
+ #else // Arduino Due
829
+
830
+ #define SCALE VARIANT_MCK / 2UL / 1000000UL
831
+ #define INST (2UL * F_CPU / VARIANT_MCK)
832
+ #define TIME_800_0 ((int)(0.40 * SCALE + 0.5) - (5 * INST))
833
+ #define TIME_800_1 ((int)(0.80 * SCALE + 0.5) - (5 * INST))
834
+ #define PERIOD_800 ((int)(1.25 * SCALE + 0.5) - (5 * INST))
835
+ #define TIME_400_0 ((int)(0.50 * SCALE + 0.5) - (5 * INST))
836
+ #define TIME_400_1 ((int)(1.20 * SCALE + 0.5) - (5 * INST))
837
+ #define PERIOD_400 ((int)(2.50 * SCALE + 0.5) - (5 * INST))
838
+
839
+ int pinMask, time0, time1, period, t;
840
+ Pio *port;
841
+ volatile WoReg *portSet, *portClear, *timeValue, *timeReset;
842
+ uint8_t *p, *end, pix, mask;
843
+
844
+ pmc_set_writeprotect(false);
845
+ pmc_enable_periph_clk((uint32_t)TC3_IRQn);
846
+ TC_Configure(TC1, 0,
847
+ TC_CMR_WAVE | TC_CMR_WAVSEL_UP | TC_CMR_TCCLKS_TIMER_CLOCK1);
848
+ TC_Start(TC1, 0);
849
+
850
+ pinMask = g_APinDescription[pin].ulPin; // Don't 'optimize' these into
851
+ port = g_APinDescription[pin].pPort; // declarations above. Want to
852
+ portSet = &(port->PIO_SODR); // burn a few cycles after
853
+ portClear = &(port->PIO_CODR); // starting timer to minimize
854
+ timeValue = &(TC1->TC_CHANNEL[0].TC_CV); // the initial 'while'.
855
+ timeReset = &(TC1->TC_CHANNEL[0].TC_CCR);
856
+ p = pixels;
857
+ end = p + numBytes;
858
+ pix = *p++;
859
+ mask = 0x80;
860
+
861
+ #ifdef NEO_KHZ400
862
+ if((type & NEO_SPDMASK) == NEO_KHZ800) { // 800 KHz bitstream
863
+ #endif
864
+ time0 = TIME_800_0;
865
+ time1 = TIME_800_1;
866
+ period = PERIOD_800;
867
+ #ifdef NEO_KHZ400
868
+ } else { // 400 KHz bitstream
869
+ time0 = TIME_400_0;
870
+ time1 = TIME_400_1;
871
+ period = PERIOD_400;
872
+ }
873
+ #endif
874
+
875
+ for(t = time0;; t = time0) {
876
+ if(pix & mask) t = time1;
877
+ while(*timeValue < period);
878
+ *portSet = pinMask;
879
+ *timeReset = TC_CCR_CLKEN | TC_CCR_SWTRG;
880
+ while(*timeValue < t);
881
+ *portClear = pinMask;
882
+ if(!(mask >>= 1)) { // This 'inside-out' loop logic utilizes
883
+ if(p >= end) break; // idle time to minimize inter-byte delays.
884
+ pix = *p++;
885
+ mask = 0x80;
886
+ }
887
+ }
888
+ while(*timeValue < period); // Wait for last bit
889
+ TC_Stop(TC1, 0);
890
+
891
+ #endif // end Arduino Due
892
+
893
+ #endif // end Architecture select
894
+
895
+ interrupts();
896
+ endTime = micros(); // Save EOD time for latch on next call
897
+ }
898
+
899
+ // Set the output pin number
900
+ void Adafruit_NeoPixel::setPin(uint8_t p) {
901
+ pinMode(pin, INPUT);
902
+ pin = p;
903
+ pinMode(p, OUTPUT);
904
+ digitalWrite(p, LOW);
905
+ #ifdef __AVR__
906
+ port = portOutputRegister(digitalPinToPort(p));
907
+ pinMask = digitalPinToBitMask(p);
908
+ #endif
909
+ }
910
+
911
+ // Set pixel color from separate R,G,B components:
912
+ void Adafruit_NeoPixel::setPixelColor(
913
+ uint16_t n, uint8_t r, uint8_t g, uint8_t b) {
914
+ if(n < numLEDs) {
915
+ if(brightness) { // See notes in setBrightness()
916
+ r = (r * brightness) >> 8;
917
+ g = (g * brightness) >> 8;
918
+ b = (b * brightness) >> 8;
919
+ }
920
+ uint8_t *p = &pixels[n * 3];
921
+ p[rOffset] = r;
922
+ p[gOffset] = g;
923
+ p[bOffset] = b;
924
+ }
925
+ }
926
+
927
+ // Set pixel color from 'packed' 32-bit RGB color:
928
+ void Adafruit_NeoPixel::setPixelColor(uint16_t n, uint32_t c) {
929
+ if(n < numLEDs) {
930
+ uint8_t
931
+ r = (uint8_t)(c >> 16),
932
+ g = (uint8_t)(c >> 8),
933
+ b = (uint8_t)c;
934
+ if(brightness) { // See notes in setBrightness()
935
+ r = (r * brightness) >> 8;
936
+ g = (g * brightness) >> 8;
937
+ b = (b * brightness) >> 8;
938
+ }
939
+ uint8_t *p = &pixels[n * 3];
940
+ p[rOffset] = r;
941
+ p[gOffset] = g;
942
+ p[bOffset] = b;
943
+ }
944
+ }
945
+
946
+ // Convert separate R,G,B into packed 32-bit RGB color.
947
+ // Packed format is always RGB, regardless of LED strand color order.
948
+ uint32_t Adafruit_NeoPixel::Color(uint8_t r, uint8_t g, uint8_t b) {
949
+ return ((uint32_t)r << 16) | ((uint32_t)g << 8) | b;
950
+ }
951
+
952
+ // Query color from previously-set pixel (returns packed 32-bit RGB value)
953
+ uint32_t Adafruit_NeoPixel::getPixelColor(uint16_t n) const {
954
+ if(n >= numLEDs) {
955
+ // Out of bounds, return no color.
956
+ return 0;
957
+ }
958
+ uint8_t *p = &pixels[n * 3];
959
+ uint32_t c = ((uint32_t)p[rOffset] << 16) |
960
+ ((uint32_t)p[gOffset] << 8) |
961
+ (uint32_t)p[bOffset];
962
+ // Adjust this back up to the true color, as setting a pixel color will
963
+ // scale it back down again.
964
+ if(brightness) { // See notes in setBrightness()
965
+ //Cast the color to a byte array
966
+ uint8_t * c_ptr =reinterpret_cast<uint8_t*>(&c);
967
+ c_ptr[0] = (c_ptr[0] << 8)/brightness;
968
+ c_ptr[1] = (c_ptr[1] << 8)/brightness;
969
+ c_ptr[2] = (c_ptr[2] << 8)/brightness;
970
+ }
971
+ return c; // Pixel # is out of bounds
972
+ }
973
+
974
+ // Returns pointer to pixels[] array. Pixel data is stored in device-
975
+ // native format and is not translated here. Application will need to be
976
+ // aware whether pixels are RGB vs. GRB and handle colors appropriately.
977
+ uint8_t *Adafruit_NeoPixel::getPixels(void) const {
978
+ return pixels;
979
+ }
980
+
981
+ uint16_t Adafruit_NeoPixel::numPixels(void) const {
982
+ return numLEDs;
983
+ }
984
+
985
+ // Adjust output brightness; 0=darkest (off), 255=brightest. This does
986
+ // NOT immediately affect what's currently displayed on the LEDs. The
987
+ // next call to show() will refresh the LEDs at this level. However,
988
+ // this process is potentially "lossy," especially when increasing
989
+ // brightness. The tight timing in the WS2811/WS2812 code means there
990
+ // aren't enough free cycles to perform this scaling on the fly as data
991
+ // is issued. So we make a pass through the existing color data in RAM
992
+ // and scale it (subsequent graphics commands also work at this
993
+ // brightness level). If there's a significant step up in brightness,
994
+ // the limited number of steps (quantization) in the old data will be
995
+ // quite visible in the re-scaled version. For a non-destructive
996
+ // change, you'll need to re-render the full strip data. C'est la vie.
997
+ void Adafruit_NeoPixel::setBrightness(uint8_t b) {
998
+ // Stored brightness value is different than what's passed.
999
+ // This simplifies the actual scaling math later, allowing a fast
1000
+ // 8x8-bit multiply and taking the MSB. 'brightness' is a uint8_t,
1001
+ // adding 1 here may (intentionally) roll over...so 0 = max brightness
1002
+ // (color values are interpreted literally; no scaling), 1 = min
1003
+ // brightness (off), 255 = just below max brightness.
1004
+ uint8_t newBrightness = b + 1;
1005
+ if(newBrightness != brightness) { // Compare against prior value
1006
+ // Brightness has changed -- re-scale existing data in RAM
1007
+ uint8_t c,
1008
+ *ptr = pixels,
1009
+ oldBrightness = brightness - 1; // De-wrap old brightness value
1010
+ uint16_t scale;
1011
+ if(oldBrightness == 0) scale = 0; // Avoid /0
1012
+ else if(b == 255) scale = 65535 / oldBrightness;
1013
+ else scale = (((uint16_t)newBrightness << 8) - 1) / oldBrightness;
1014
+ for(uint16_t i=0; i<numBytes; i++) {
1015
+ c = *ptr;
1016
+ *ptr++ = (c * scale) >> 8;
1017
+ }
1018
+ brightness = newBrightness;
1019
+ }
1020
+ }
1021
+
1022
+ //Return the brightness value
1023
+ uint8_t Adafruit_NeoPixel::getBrightness(void) const {
1024
+ return brightness - 1;
1025
+ }
1026
+
1027
+ void Adafruit_NeoPixel::clear() {
1028
+ memset(pixels, 0, numBytes);
1029
+ }