标题: arduino小车控制程序，包含与树莓派通信程序 [打印本页]
作者: 16271271    时间: 2018-10-2 19:31
标题: arduino小车控制程序，包含与树莓派通信程序
小车控制程序，包含与树莓派通信程序


单片机源程序如下:

  2. int PWMA=10;
  3. int IN1 = 10;
  4. int IN2 = 9;
  5. int PWMB = 6;
  6. int IN3 = 6;
  7. int IN4 = 5;
  8. const int TrigPin = 2;
  9. const int EchoPin = 3;
  10. float distance;
  11. #include <Servo.h>    // 声明调用Servo.h库
  12. Servo myservo;        // 创建一个舵机对象
  13. int pos = 0;          // 变量pos用来存储舵机位置
  14. String comdata = "";
  15. int i;

  17. void setup()
  18. {
  19.   pinMode(PWMA, OUTPUT); //PWM
  20.   pinMode(IN1, OUTPUT);
  21.   pinMode(IN2, OUTPUT);
  22.   pinMode(PWMB, OUTPUT); //PWM
  23.   pinMode(IN3, OUTPUT);
  24.   pinMode(IN4, OUTPUT);
  25.   // 初始化串口通信及连接SR04的引脚
  26.         Serial.begin(9600);
  27.         pinMode(TrigPin, OUTPUT);
  28.     // 要检测引脚上输入的脉冲宽度，需要先设置为输入状态
  29.         pinMode(EchoPin, INPUT);
  30.     Serial.println("Ultrasonic sensor:");
  31.   myservo.attach(5);  // 将引脚9上的舵机与声明的舵机对象连接起来
  32.   Serial.begin(9600);
  33. }

  35. void up()
  36. {
  37.   digitalWrite(IN1, LOW);
  38.   digitalWrite(IN2, HIGH);
  39.   digitalWrite(IN3, LOW);
  40.   digitalWrite(IN4, HIGH);
  41.   analogWrite(PWMA, 10);
  42.   analogWrite(PWMB, 10);
  43.   delay(5000);
  44. }

  46. void down()
  47. {
  48.   digitalWrite(IN1, HIGH);
  49.   digitalWrite(IN2, LOW);
  50.   digitalWrite(IN3, HIGH);
  51.   digitalWrite(IN4, LOW);
  52.   analogWrite(PWMA, 10);
  53.   analogWrite(PWMB, 10);
  54.   delay(5000);
  55. }

  57. void sto()
  58. {
  59.   digitalWrite(IN1, LOW);
  60.   digitalWrite(IN2, LOW);
  61.   digitalWrite(IN3, LOW);
  62.   digitalWrite(IN4, LOW);
  63.   analogWrite(PWMA, 0);
  64.   analogWrite(PWMB, 0);
  65.   delay(5000);
  66. }

  68. void left()
  69. {
  70.   digitalWrite(IN1, LOW);
  71.   digitalWrite(IN2, HIGH);
  72.   digitalWrite(IN3, HIGH);
  73.   digitalWrite(IN4, LOW);
  74.   analogWrite(PWMA, 10);
  75.   analogWrite(PWMB, 10);
  76.   delay(5000);
  77. }

  79. void right()
  80. {
  81.   digitalWrite(IN1, HIGH);
  82.   digitalWrite(IN2, LOW);
  83.   digitalWrite(IN3, LOW);
  84.   digitalWrite(IN4, HIGH);
  85.   analogWrite(PWMA, 10);
  86.   analogWrite(PWMB, 10);
  87.   delay(5000);
  88. }

  90. void d()
  91. {
  92.     // 产生一个10us的高脉冲去触发TrigPin
  93.         digitalWrite(TrigPin, LOW);
  94.         delayMicroseconds(2);
  95.         digitalWrite(TrigPin, HIGH);
  96.         delayMicroseconds(10);
  97.         digitalWrite(TrigPin, LOW);
  98.     // 检测脉冲宽度，并计算出距离
  99.         distance = pulseIn(EchoPin, HIGH) / 58.00;
  100.         
  101. }

  103. void roun()
  104. {
  105.    for(pos = 0; pos < 180; pos += 1){    // 舵机从0°转到180°，每次增加1°         
  106.       myservo.write(pos);           // 给舵机写入角度   
  107.       delay(15);                    // 延时15ms让舵机转到指定位置
  108.    }
  109.     for(pos = 180; pos>=1; pos-=1) {    // 舵机从180°转回到0°，每次减小1°                              
  110.        myservo.write(pos);        // 写角度到舵机     
  111.        delay(15);                 // 延时15ms让舵机转到指定位置
  112.     }
  113. }

  115. void loop()
  116. {
  117. d();
  118.   while (Serial.available() > 0){
  119.         comdata += char(Serial.read());
  120.         i=comdata.toInt();//每次读一个char字符，并相加
  121.         delay(2);
  122.     }
  123.     if (comdata.length() > 0){
  124.         if (i<140){
  125.           Serial.println("left");
  126.            left();
  127.         }
  128.         if(i>140&i<180){
  129.           Serial.println("up");
  130.           if(distance<30)
  131.           sto();
  132.           else
  133.           up();
  134.          
  135.         }
  136.         if (i>=180){
  137.           Serial.println("right");
  138.            right();
  139.         }
  140.        // Serial.println(i); //打印接收到的字符
  141.         comdata = "";
  142.     }
  143.    
  144. }

复制代码

所有资料51hei提供下载:
arduino.rar (13.71 KB, 下载次数: 18)






欢迎光临 (http://www.51hei.com/bbs/) Powered by Discuz! X3.1