Advertisement
Guest User

arduino BT+L9110

a guest
Nov 22nd, 2014
191
0
Never
Not a member of Pastebin yet? Sign Up, it unlocks many cool features!
Java 2.28 KB | None | 0 0
  1. #include <SoftwareSerial.h>
  2.  
  3. SoftwareSerial mySerial(10, 9); // RX, TX
  4. const int AIA = 4;  // (pwm) pin 9 connected to pin A-IA
  5. const int AIB = 5;  // (pwm) pin 5 connected to pin A-IB
  6. const int BIA = 6; // (pwm) pin 10 connected to pin B-IA  
  7. const int BIB = 7;  // (pwm) pin 6 connected to pin B
  8. byte speed=255;
  9. void setup()
  10. {
  11.  
  12.   pinMode(AIA, OUTPUT); // set pins to output
  13.   pinMode(AIB, OUTPUT);
  14.   pinMode(BIA, OUTPUT);
  15.   pinMode(BIB, OUTPUT);
  16.     pinMode(11,OUTPUT);
  17.     pinMode(12,OUTPUT);
  18.     digitalWrite(11,LOW);
  19.     digitalWrite(12,HIGH);
  20.    // Open serial communications and wait for port to open:
  21.    Serial.begin(9600);
  22.    Serial.println("TEST ARDUINO");
  23.    // SoftwareSerial "com port" data rate. JY-MCU v1.03 defaults to 9600.
  24.    mySerial.begin(9600);
  25.    mySerial.println("Write something :");
  26.    
  27. }
  28.  
  29. String msg="",ordre="";
  30. char c,cmd,cmdAct;
  31. void loop()
  32. {
  33.    if(mySerial.available())
  34.    {
  35.     while(mySerial.available())
  36.     {
  37.       msg+=(char)mySerial.read();
  38.       ordre=msg;
  39.      
  40.          
  41.     }
  42.      cmd = msg[11];   //direction
  43.      cmdAct = msg[22];//command
  44.  
  45.    
  46.    }
  47.    if(ordre[22]=='1')
  48.    {
  49.       Serial.println("en cours");
  50.     switch(cmd)
  51.     {
  52.       case 'a':
  53.         Serial.println("forward");
  54.         forward();
  55.        
  56.       break;
  57.       case 'q':
  58.         Serial.println("backward");
  59.         backward();
  60.       break;
  61.       case 's':
  62.         Serial.println("left");
  63.         left();
  64.       break;
  65.       case 'r':
  66.         Serial.println("right");
  67.         right();
  68.       break;
  69.     }
  70.    }  
  71.    else if(ordre[22]=='2')
  72.    {
  73.        Serial.println("stop");
  74.        halt();
  75.    }
  76.    msg="";
  77. }// END loop()
  78.  
  79. void halt()
  80. {
  81.   analogWrite(AIA, 0);
  82.   analogWrite(AIB, 0);
  83.   analogWrite(BIA, 0);
  84.   analogWrite(BIB, 0);
  85. }
  86. void backward()
  87. {
  88.   analogWrite(AIA, 0);
  89.   analogWrite(AIB, speed);
  90.   analogWrite(BIA, 0);
  91.   analogWrite(BIB, speed);
  92. }
  93.  
  94. void forward()
  95. {
  96.   analogWrite(AIA, speed);
  97.   analogWrite(AIB, 0);
  98.   analogWrite(BIA, speed);
  99.   analogWrite(BIB, 0);
  100. }
  101.  
  102. void left()
  103. {
  104.   analogWrite(AIA, speed);
  105.   analogWrite(AIB, 0);
  106.   analogWrite(BIA, 0);
  107.   analogWrite(BIB, speed);
  108. }
  109.  
  110. void right()
  111. {
  112.   analogWrite(AIA, 0);
  113.   analogWrite(AIB, speed);
  114.   analogWrite(BIA, speed);
  115.   analogWrite(BIB, 0);
  116. }
Advertisement
Add Comment
Please, Sign In to add comment
Advertisement