EmaMaker
/
SPQR-Team1-2020
1
1
Fork 0
Code Issues Pull Requests Packages Projects Releases Wiki Activity

ball_read: add option to receive bytes from teensy 

Those will turn LED2, LED3, LED4 on or off depending on the byte received
They can be used as status LEDs to report Teensy activity
docs
EmaMaker 2020-12-17 13:04:32 +01:00
parent 00e787b62e
commit f99d467c36
1 changed files with 18 additions and 5 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

23
utility/32u4/ball_read/ball_read.ino
View File

@ -92,11 +92,11 @@ void setup() {
//Set the LEDs as outputs, keep the rest as input by default
//LED3(PB7) and LED4 (PB0)
//DDRB |= 0b10000001;
DDRB |= 0b10000001;
//LED2 (PF0)
//DDRF |= 0b00000001;
DDRF |= 0b00000001;
//LED1 (PD5)
//DDRD |= 0b00100000;
DDRD |= 0b00100000;
/*pinMode(26, INPUT); //S1
pinMode(25, INPUT); //S2
@ -125,6 +125,7 @@ void loop() {
readBallInterpolation();
//printCounter();
sendDataInterpolation();
readFromTeensy();
//test();
//delay(100);
}
@ -182,11 +183,11 @@ void readBallInterpolation() {
distance = nmax;
//turn led on
/*if (distance == 0) {
if (distance == 0) {
LED1OFF;
} else {
LED1ON;
}*/
}
}
void sendDataInterpolation() {
@ -257,3 +258,15 @@ void printCounter() {
Serial1.println();
delay(100);
}
void readFromTeensy(){
while(Serial1.available()){
byte b = Serial1.read();
if(b & 0b00000001 == 1) LED2ON;
else LED2OFF;
if((b & 0b00000010) >> 1 == 1) LED3ON;
else LED3OFF;
if((b & 0b00000100) >> 2 == 1) LED4ON;
else LED4OFF;
}
}