Ruschino Bluetooth
Jump to navigation
Jump to search
Versione Bluetooth di Ruschino WiFi.
Lo sketch:
int en12=9;
int en34=10;
int dir12=4;
int dir34=5;
int board=1;
int out_bridge_n=0;
int s_speed_sx=0;
int s_speed_dx=0;
boolean direction_sx=0;
boolean direction_dx=0;
void motor_drive(int out_bridge, boolean dir, int speed) {
if (speed < 30) {
speed = 0;
}
if (out_bridge == 34) {
digitalWrite(dir34, dir);
analogWrite(en34, speed);
}
else if (out_bridge == 12) {
digitalWrite(dir12, dir);
analogWrite(en12, speed);
}
}
void setup() {
Serial.begin(9600);
pinMode(en12, OUTPUT);
pinMode(dir12, OUTPUT);
pinMode(en34, OUTPUT);
pinMode(dir34, OUTPUT);
Serial.println("READY");
}
void loop() {
while (Serial.available() > 0) {
s_speed_sx = Serial.parseInt();
s_speed_dx = Serial.parseInt();
if (Serial.read() == '*') {
if (s_speed_sx<0) {
direction_sx = 0;
} else {
direction_sx = 1;
}
if (s_speed_dx<0) {
direction_dx = 1;
} else {
direction_dx = 0;
}
motor_drive(34,direction_sx,abs(s_speed_sx));
motor_drive(12,direction_dx,abs(s_speed_dx));
}
}
}
Qui invece l'app su AppInventor.