Johannes
/
HC05AC-CTRL
1
0
Fork 0
Code Issues Pull Requests Projects Releases Wiki Activity

Left shift

This commit is contained in:
Johannes Frohnmeyer 2023-02-01 13:25:12 +01:00
parent d278d5decc
commit 6ae6a653c7
Signed by: Johannes
GPG Key ID: E76429612C2929F4
1 changed files with 4 additions and 6 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

10
gradual_input.ino
View File

@ -39,19 +39,17 @@ void loop() {
}
void writeMotor(char left, char right) {
byte prec = 1;
if (right == 0) {
digitalWrite(2, LOW);
digitalWrite(4, LOW);
} else if (right > 0) {
digitalWrite(2, LOW);
digitalWrite(4, HIGH);
digitalWrite(3, byte(right) / prec);
digitalWrite(3, byte(right) << 1);
} else {
digitalWrite(2, HIGH);
digitalWrite(4, LOW);
digitalWrite(3, byte(-right) / prec);
digitalWrite(3, byte(-(right + 1)) << 1);
}
if (left == 0) {
@ -60,10 +58,10 @@ void writeMotor(char left, char right) {
} else if (left > 0) {
digitalWrite(5, LOW);
digitalWrite(7, HIGH);
digitalWrite(6, byte(left) / prec);
digitalWrite(6, byte(left) << 1);
} else {
digitalWrite(5, HIGH);
digitalWrite(7, LOW);
digitalWrite(6, byte(-left) / prec);
digitalWrite(6, byte(-(left + 1)) << 1);
}
}