Ruschino Bluetooth

Da raspibo.
Jump to navigation Jump to search
The printable version is no longer supported and may have rendering errors. Please update your browser bookmarks and please use the default browser print function instead.

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.