/
led.html
500 lines (461 loc) · 30 KB
/
led.html
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
106
107
108
109
110
111
112
113
114
115
116
117
118
119
120
121
122
123
124
125
126
127
128
129
130
131
132
133
134
135
136
137
138
139
140
141
142
143
144
145
146
147
148
149
150
151
152
153
154
155
156
157
158
159
160
161
162
163
164
165
166
167
168
169
170
171
172
173
174
175
176
177
178
179
180
181
182
183
184
185
186
187
188
189
190
191
192
193
194
195
196
197
198
199
200
201
202
203
204
205
206
207
208
209
210
211
212
213
214
215
216
217
218
219
220
221
222
223
224
225
226
227
228
229
230
231
232
233
234
235
236
237
238
239
240
241
242
243
244
245
246
247
248
249
250
251
252
253
254
255
256
257
258
259
260
261
262
263
264
265
266
267
268
269
270
271
272
273
274
275
276
277
278
279
280
281
282
283
284
285
286
287
288
289
290
291
292
293
294
295
296
297
298
299
300
301
302
303
304
305
306
307
308
309
310
311
312
313
314
315
316
317
318
319
320
321
322
323
324
325
326
327
328
329
330
331
332
333
334
335
336
337
338
339
340
341
342
343
344
345
346
347
348
349
350
351
352
353
354
355
356
357
358
359
360
361
362
363
364
365
366
367
368
369
370
371
372
373
374
375
376
377
378
379
380
381
382
383
384
385
386
387
388
389
390
391
392
393
394
395
396
397
398
399
400
401
402
403
404
405
406
407
408
409
410
411
412
413
414
415
416
417
418
419
420
421
422
423
424
425
426
427
428
429
430
431
432
433
434
435
436
437
438
439
440
441
442
443
444
445
446
447
448
449
450
451
452
453
454
455
456
457
458
459
460
461
462
463
464
465
466
467
468
469
470
471
472
473
474
475
476
477
478
479
480
481
482
483
484
485
486
487
488
489
490
491
492
493
494
495
496
497
498
499
500
---
layout: default
permalink: /led/
---
<div class="container mt-5">
<h1 class="kk">LEDs the KnightKrawler Way</h1>
<div class="row">
<div class="col-md-12">
<!--Overview statement card-->
<div class="card card-kk mr-5">
<div class="card-heading">
Goals
</div>
<div class="card-body">
<p class="center">
<img src="/assets/images/leds/fullWired.jpg" width="100%" />
</p>
<p>
After a few years of failed attempts at LEDs, including a few rounds of magic smoke and burned-out controllers,
KnightKrawler set off to create a uniform way to control LEDs. The goal was to create a
setup that
would work the same on the robot, or at a desk. We wanted a way to have several "training
setups" that worked identical
to the way it would work on the robot connected to a RoboRio. This resulted in a few
concrete design guidelines.
</p>
<p>
<strong>WS2812b LEDs</strong><br />
We decided to standardize on WS2812b LEDs. These LEDs are 5 volts and low power consumption.
More importantly, they are low cost and easy to find.
This type of LEDs also opened up the opportunity to created additional LED projects, such as
an LED display panel for the robot cart, or wearable LEDs for hats and vests.
Using 12V automotive LEDs often found on FRC robots would have made these other projects
more complicated or impossible. We alos decided to purchase LEDs enclosed with a waterproof
rubber sleeve. While the waterproof part isn't necessary, the rubble sleeve protects against
accidental shorts and offers some protection to the strip.
</p>
<p>
<strong>ESP32 Co-processor</strong><br />
While many teams are using an Arduino for LED control. The very limited processing power
and memory, coupled with price of Arduino processors was a bad combination.
The ESP32 chips run the same Ardunio code.
and there are many ESP32 platforms for under $10 which offer significantly more power and
memory in a much smaller package.
</p>
<p>
<strong>Easy and Safe Power</strong><br />
We wanted the co-processor to always be run from USB power. It is possible to directly power
a co-processor from a battery, since most chips have a VIN (Voltage In) pin.
While correct wiring practices will ensure that this can be done safely, there is always the
possibility that a cheap ESP32 manufacturer or a mistake in wiring could send reverse
voltage back
into laptop. Your $10 LED processor could severely damage your very expensive computer. To
reduct this risk, we decided to ensure the ESP32 co-processor is always powered off USB.
This creates
the need for a powered USB plug. However, but adding this plug is makes a training setup
very simple for students to understand. They can plug the ESP32 into the computer to program
it, when doing so
the processor is powered by the laptop. Then unplugging the processor from the laptop and
into the USB power source on the training setup, puts the chip on the independent power
source. Our training
setup runs on a 12v robot battery. For training, a student simply grabs a robot battery,
sets it on the desk, and the entire system is ready to go. This also makes it possible for
the same setup to
be used for lights on the pit, robot cart, or anywhere you want to display LEDs.
</p>
<p>
<strong>Easy to Troubleshoot Signaling</strong><br />
Communicating between the RoboRio and a co-processor can be a challenge for any team to figure out,
especially new teams. Worse, it can become near impossible to troubleshoot more complicated computer
protocols such as SPI or I2C if you are not an expert and choose to communicate to your
co-processor this way. Adding to the complexity, how do you simulate a call from the RoboRio
to change the light pattern if you are communicating over SPI or I2C if you don't have
a RoboRio? So, KnightKrawler uses a very simple approach to changing the light pattern. We
use binary signals and DIO. This will be explained in detail later, but using simple HIGH or
LOW pin voltages,
(similar to a DIO sensor such as a limit switch), allows for troubleshooting with simple
debug statements or even a voltage meter. Each pin on the co-processor can represent a
binary number.
If pins 0,2,and 3 are being signaled, this would represent the binary number 1011 or the
number 13 (1 + 4 + 8) in decimal. Very few teams are using all 10 DIO pins on their Robio.
Having just 5 of the 10 pins
available means you have 2^5 (32) different light patterns you can code. Adding a screen to
your processor makes debugging even easier.
</p>
<p>
<strong>Female Pin Sockets</strong><br />
The diagram indicates two pin socket strips will be used. These are only necessary if you plan to create a test box (below).
It is possible to use jumper wires directly from the pins on the ESP32 co-processor board directly to ground for testing.
For connecting to the RoboRio, these pins can be wired directly to the RoboRio DIO pins through a ribbon cable or jumper wires.
</p>
</div>
</div>
</div>
</div>
<div class="row">
<div class="col-md-12">
<!--Shopping List Card-->
<div class="card card-kk mr-5 mt-3">
<div class="card-heading">
Shopping List
</div>
<div class="card-body">
<p>
We assume you will want at least a couple LED of setups so you can have one on the robot, and
more for testing. Some parts are as cheap to buy in bulk as they are to buy 1. Here is the
list of parts we purchase.
</p>
<ul>
<li><a href="https://amzn.to/4aiC1El" target="_blank">ESP32 Processor</a></li>
<li><a href="https://amzn.to/3VQWefM" target="_blank">12v to 5v Power Converter</a></li>
<li><a href="https://amzn.to/49li7Hl" target="_blank">USB Charger Socket</a></li>
<li><a href="https://amzn.to/3J4A6Hf" target="_blank">OLED Display</a></li>
<li><a href="https://amzn.to/4aFKEZ4" target="_blank">Female Header Socket</a></li>
<li><a href="https://amzn.to/3TMJ1SG" target="_blank">Male Header Pins</a></li>
<li><a href="https://amzn.to/3JaGtsx" target="_blank">WS2812B Waterproof LED Strip</a></li>
<li><a href="https://amzn.to/3PS5Hjh" target="_blank">Lever Wire Connectors</a></li>
<li><a href="https://amzn.to/3vEinDy" target="_blank">Jumper Wires</a></li>
<li><a href="https://amzn.to/3VHD24c" target="_blank">PCB Boards (optional)</a></li>
</ul>
<p>
You will need wire and a connection to your robot battery. KnightKrawler uses the <a
href="https://www.andymark.com/products/sb-50a-app-connector-with-contacts"
target="_blank">Anderson connector</a> for our batteries.
It is wise to separate the resting setup from the battery with
<a href="https://www.andymark.com/products/powerpole-kit-8-red-and-black-housings-16-contacts" target="_blank"> Anderson Powerpole connectors.</a>
By doing this, it is possible to connect your testing rig directly to the PDH on the
robot more easily.
</p>
</div>
</div>
</div>
</div>
<div class="row">
<div class="col-md-12">
<div class="card card-kk mr-5 mt-3">
<div class="card-heading">
Wiring
</div>
<div class="card-body">
<p class="center">
<img src="/assets/images/leds/ledSetup.png" width="100%" />
</p>
<p>
<strong>Common Ground</strong><br />
A common mistake in wiring and working with a co-processor is establishing a common ground. When the co-processor is connected to a laptop, it receives its
positive and negative power connection through the USB cable to the laptop. However, we cannot power the LEDs off the power that comes from the USB port.
There just isn't enough power, so power is supplied through the robot battery. The ESP32 processor is attempting to control the LEDs through a signal wire
connected to pin 2 in the diagram above. A problem is created when the co-processor is powered from the laptop, and the LEDs are powered by the battery.
There must be "common ground". Notice in the diagram that the ESP32 has a ground connection to the battery that powers the LEDs. If your LED lights flicker erratically,
you are probably missing a common ground.
</p>
<p>
<strong>DIO Input</strong><br />
In the diagram. The female header sockets for DIO input is connected on pins D13, D12, D14, D27, D26, D25, D33, and D32. The pin order may seem illogical and we agree. Different manufacturers will use different
pin numbering. This diagram uses the Upesy Wroom DevKit linked in the shopping list. We have also used the more expensive <a href="https://amzn.to/3PJSskL" target="_blank">HiLetgo</a>
board with integrated screen, which has a very different pin numbering scheme. However, we have noticed a delay in the screen and do recommend this co-processor if you want very quick light
changes for your robot.
</p>
<p>
<strong>Pull-Up</strong><br />
There is a concept in circuitry called a "Pull-Up Resistor" or "Pull-Up Circuit". In electricity, when attempting to read a DIO signal, you really need to have a HIGH (3.3V) signal or a LOW (0V - Ground) signal.
This can be an abstract concept to first grasp and there a many YouTube videos explaining this. In practice with a pin is not connected to anything at all, it is "floating", which means it could read either
HIGH or LOW and can fluctuate depending on static in the air and a variety of other things. Pull-up circuits allow a pin to read high when nothing is connected. Nearly all boards including the RoboRio and ESP32 include
the ability to tell a pin to turn on the build in pull-up resister. Some boards have the option for pull-down circuits but it is less widely supported and therefore not a reliable way to write code. Unfortunately, this means
when we write code we have to assume with a pin reads high the circuit is open (off) and when it reads low it is closed (on). To make this work, we have to connect the other set of female header pins to ground. It seems
backwards to the person new to electronics, so for now just trust this is the easiest way to make this system work.
</p>
<p>
<strong>Screens</strong><br />
There are many shapes, sized and styles of screens. We have chosen this screen for cost and compact size. Most screens have a simple I2C connection using the "CL" (clock) and "DA" (data) pins. It makes
programming a display easy. Make sure your display is powered from the 3V output on the co-processor, not 5V pin.
</p>
<p>
<strong>Power</strong><br />
We selected a low cost 12V to 5V converter for powering the LEDs and a simple USB power socket. More robust converters are available they my tolerate brown-outs more gracefully, but we have not encountered an issue so far.
The converter for the LEDs can supply up to 3 amps. If you are attempting to run multiple strips or panels you may need a converter that can supply more amps.
On the standard LED wire harness, white is ground (negative), green is signal, and red is power (positive).
</p>
<p>
<strong>Pins</strong><br />
Selecting pins to use in wiring your lights can vary. The diagram only shows the pins we have used for DIO input, and for signaling the LEDs (pin 2). A word of caution, verify the input pins support "Pull-Up" mode in
your code before soldering anything. We found that not all pins on the Upesy Wroom kit support the pull-up feature.
</p>
</div>
</div>
</div>
</div>
<div class="row">
<div class="col-md-12">
<div class="card card-kk mr-5 mt-3">
<div class="card-heading">
Training Case
</div>
<div class="card-body">
<p class="center">
<img src="/assets/images/leds/assembled.jpg" width="100%" />
</p>
<p>
<strong>Models</strong><br />
Download the models from <a href="https://www.printables.com/model/831289" target="_blank">Printables.com</a>
</p>
<p class="center">
<strong>Circuit Board</strong><br />
<div class="row">
<div class="col-md-6 col-sm-12">
<img class="center" src="/assets/images/leds/topEmpty.jpg" width="100%" />
</div>
<div class="col-md-6 col-sm-12">
<img class="center" src="/assets/images/leds/boardBack.jpg" width="100%" />
</div>
</div>
<div class="row">
<div class="col-md-6 col-sm-12">
<img class="center" src="/assets/images/leds/ledBoard.png" width="100%" />
</div>
<div class="col-md-6 col-sm-12">
<img class="center" src="/assets/images/leds/ledBoardSolder.png" width="100%" />
</div>
</div>
</p>
<p>
To create the KnightKrawler training setup using the 3D printed case above, a 18x24 PCB board and female pin sockets are needed. The diagram above shows the position of the female pin headers on the circuit board (top side).
Female pin headers can be cut to the desired number of pins using a side cutter or any snips you have available. Sandpaper can be used to create a nice flat end to your cut female pin headers.
From the back side, solder the female pin headers into the board and connect each pin as shown in the diagram using your preferred soldering method. In the photo shown, wires from a CAT-5 cable were
used to connect the pins. You may prefer a different way to create your PCB. In the diagram, a green "X" indicates a ground wire is needed to attach to the battery negative lead (common ground). A pink "X" indicates a
lead wire is needed to connect to the signal for the LED strip. These wires should be about 6" long. See the diagram above under the "Wiring" header to see how they are connected to the other components.
</p>
<p>
NOTE: the soldering diagram is only viable when using the Upesy Wroom Dev kit ESP32 board. You may need to adjust the soldering pattern to fit the pins on your micro processor board.
</p>
<p>
Secure the PCB board to the 3D printed case using small screws. We used 2mm screws in our assembly. Depending on your 3D printer nozzle and layer settings, the fit may be snug and can take some wiggling
to get in place. If the openings are too small in the corners it may be necessary to sand them open with small strips of sand paper, or to remove some plastic using an exacto knife.
</p>
<p class="center">
<strong>Assembly</strong><br />
<div class="row">
<div class="col-md-4 col-sm-12">
<img class="center" src="/assets/images/leds/caseInsides.png" width="100%" />
</div>
<div class="col-md-4 col-sm-12">
<img class="center" src="/assets/images/leds/buckConverter.jpg" width="100%" />
</div>
<div class="col-md-4 col-sm-12">
<img class="center" src="/assets/images/leds/wires.jpg" width="100%" />
</div>
</div>
</p>
<p>
There are two dividers that go inside the case. One snaps in to protect the solder connections on the PCB board from any power wires that could break a solder connection. The other divider is a mount
for the 12v to 5v converter we recommend. Use small screws to secure the PCB Board to the case, as well as the bottom of the case. 2mm diameter screws work well.
Insert the circular USB socket in the round hole and attach the 12v to 5v convert to vertical divider using small nuts and bolts (3mm) and slide into place. Connect all wires following the wiring diagram above using lever nuts and
organize the wires inside the case. Use small zip ties to secure wires for the battery power and LED lights. Secure the back of the case to the main body, again using small 2mm screws.
</p>
</div>
</div>
</div>
</div>
<div class="row">
<div class="col-md-12">
<div class="card card-kk mr-5 mt-3">
<div class="card-heading">
Completed Case
</div>
<div class="card-body">
<p class="center">
<img src="/assets/images/leds/topConnected.jpg" width="100%" />
</p>
<p>
Once fully assembled, a USB cable will be used to power the micro processor from the USB ports. Jumper wires will be used to bridge the header sockets to test input that will eventually come from the RoboRio.
</p>
</div>
</div>
</div>
</div>
<div class="row">
<div class="col-md-12">
<div class="card card-kk mr-5 mt-3">
<div class="card-heading">
RoboRio Code
</div>
<div class="card-body">
<p>
For reasons stated in the "Goals" section of this page, KnightKrawler uses a very simple approach to changing the light pattern. We
use binary signals and DIO. Eash pin represents a bit in a byte (1+2+4+8+16+32+64+128). While this gives you the option of 256 light patterns,
in practice you are unlikely to need more than 4 or 5 pins (16-32 patterns).
This approach makes it easy for a student to use jumper wires to connect the pins on the ESP32 to a ground connection, closing the circuit to
represent a number the ESP32 code can read. If you passed over the "Pull-Up" section of the wiring description, go back and read that now.
</p>
<p>
Bellow is example Java code used by KnightKrawler during the 2024 season. This code is part of the robot code that runs on the RoboRio
</p>
<hr/>
<pre>
package frc.robot.subsystems;
import edu.wpi.first.wpilibj.DigitalOutput;
import edu.wpi.first.wpilibj.DriverStation;
import edu.wpi.first.wpilibj2.command.SubsystemBase;
import frc.robot.Constants;
import frc.robot.RobotState;
import frc.robot.auto.AutoFactory.Auto;
import frc.robot.util.io.Dashboard;
/**
* Subsystem to control the robot's LEDs, by determining what number should be encoded to DIO pins and
* sent to the Arduino we used for controlling the patterns and colors
*/
public class LedSubsystem extends SubsystemBase {
private static LedSubsystem INSTANCE;
private final DigitalOutput codeChannel1, codeChannel2, codeChannel3, codeChannel4;
private LEDStatusMode currentStatusMode;
private boolean disablePeriodicEval = false;
private LedSubsystem() {
// DIO outputs
codeChannel1 = new DigitalOutput(Constants.LEDs.CHANNEL_1_PIN);
codeChannel2 = new DigitalOutput(Constants.LEDs.CHANNEL_2_PIN);
codeChannel3 = new DigitalOutput(Constants.LEDs.CHANNEL_3_PIN);
codeChannel4 = new DigitalOutput(Constants.LEDs.CHANNEL_4_PIN);
currentStatusMode = LEDStatusMode.OFF;
}
public static LedSubsystem getInstance() { // Method to allow calling this class and getting the single instance from anywhere, creating the instance if the first time.
if (INSTANCE == null) {
INSTANCE = new LedSubsystem();
}
return INSTANCE;
}
public static enum LEDStatusMode {
OFF(0),
DANGER(1),
INTAKE(2),
HAS_NOTE(3),
AIMING(4),
AIMING_ON_TARGET(5),
SHOOTING(6),
SHOOTING_ON_TARGET(7),
DONE_SHOOTING(8),
NO_AUTO(9),
BLUE_AUTO(10),
RED_AUTO(11),
AMP_IDLE(12);
private final int code;
private LEDStatusMode(int code) {
this.code = code;
}
}
@Override
public void periodic() {
if(!disablePeriodicEval) {
// robot disabled
if (DriverStation.isDisabled()) {
// If disabled, gets the alliance color from the driver station and pulses that. Only pulses color if connected to station or FMS, else pulses default disabled color (Firefl status mode)
Auto selected = Dashboard.getInstance().getAuto();
if (selected == Auto.NO_AUTO || selected == null){
currentStatusMode = LEDStatusMode.NO_AUTO;
} else if (RobotState.getInstance().isRedAlliance()) {
currentStatusMode = LEDStatusMode.RED_AUTO;
} else if (!RobotState.getInstance().isRedAlliance()) {
currentStatusMode = LEDStatusMode.BLUE_AUTO;
} else {
currentStatusMode = LEDStatusMode.OFF; // Reaches here if DriverStation.getAlliance returns Invalid, which just means it can't determine our alliance and we do cool default effect
}
// autonomous LED status modes
} else if (DriverStation.isAutonomous()) {
if(RobotState.getInstance().getNoteHeldDetected()){
currentStatusMode = LEDStatusMode.HAS_NOTE;
} else if (RobotState.getInstance().getIsShamperAtGoalAngle()){
// currentStatusMode = LEDStatusMode.AIMING;
} else {
if (RobotState.getInstance().isRedAlliance()) {
currentStatusMode = LEDStatusMode.RED_AUTO;
} else if (!RobotState.getInstance().isRedAlliance()) {
currentStatusMode = LEDStatusMode.BLUE_AUTO;
}
}
}
// teleop LED status modes
if (DriverStation.isTeleopEnabled()) {
// shooting
if(RobotState.getInstance().getShooting()){
if(!RobotState.getInstance().getNoteHeldDetected()){
currentStatusMode = LEDStatusMode.DANGER;
} else if (RobotState.getInstance().getNoteHeldDetected() && RobotState.getInstance().getIsShamperAtGoalAngle() && RobotState.getInstance().getIsRotationOnTarget()){
currentStatusMode = LEDStatusMode.SHOOTING_ON_TARGET;
} else {
currentStatusMode = LEDStatusMode.SHOOTING;
}
}
// aimed
else if (RobotState.getInstance().getNoteHeldDetected() && RobotState.getInstance().getIsShamperAtGoalAngle() && RobotState.getInstance().getIsRotationOnTarget()){
currentStatusMode = LEDStatusMode.AIMING_ON_TARGET;
}
// aiming
else if (RobotState.getInstance().getIsVerticalAiming() || RobotState.getInstance().getIsHorizontalAiming())
{
currentStatusMode = LEDStatusMode.AIMING;
} else if (RobotState.getInstance().getAmpIdle()){
currentStatusMode = LEDStatusMode.AMP_IDLE;
}
else {
if(RobotState.getInstance().getNoteHeldDetected()){
currentStatusMode = LEDStatusMode.HAS_NOTE;
} else if (RobotState.getInstance().getIsIntaking()){
currentStatusMode = LEDStatusMode.INTAKE;
} else {
currentStatusMode = LEDStatusMode.OFF;
}
}
}
}
int code = currentStatusMode.code;
// Code for encoding the code to binary on the digitalOutput pins
Dashboard.getInstance().putData("Sending LED Code", code);
codeChannel1.set((code & 1) > 0); // 2^0
codeChannel2.set((code & 2) > 0); // 2^1
codeChannel3.set((code & 4) > 0); // 2^2
codeChannel4.set((code & 8) > 0); // 2^3
// codeChannel5.set((code & 16) > 0); // 2^4
}
public void setLEDStatusMode(LEDStatusMode statusMode) {
if (!disablePeriodicEval) {
currentStatusMode = statusMode;
}
}
public LEDStatusMode getLEDStatusMode(){
return currentStatusMode;
}
public void clearStatusMode() {
currentStatusMode = LEDStatusMode.OFF;
}
// Disables LEDs (turns them off)
public void disableLEDs() {
disablePeriodicEval = true;
}
// Enables LEDs (turns them on)
public void enableLEDs() {
disablePeriodicEval = false;
}
}
</pre>
</div>
</div>
</div>
</div>
<div class="row">
<div class="col-md-12">
<div class="card card-kk mr-5 mt-3">
<div class="card-heading">
Arduino Code
</div>
<div class="card-body">
<p>
The Ardiuno Code will be explained in greater detail in a future update to this page. Until then we recommend viewing Platform.IO and LED tutorials by <a href="https://www.youtube.com/watch?v=1hYmpztMQe0&list=PLF2KJ6Gy3cZ7ynsp8s4tnqEFmY15CKhmH" target="_blank"> Dave's Garage on YouTube </a>
</p>
<p>
You can also find our Arduino LED code on GitHub: <a href="https://github.com/frc2052/2024RobotLEDs" target="_blank">https://github.com/frc2052/2024RobotLEDs</a>
</p>
</div>
</div>
</div>
</div>
</div>