设为首页收藏本站
开启辅助访问 切换到宽版

 找回密码
 立即注册

QQ登录

只需一步，快速开始

热门： 51单片机 | 24小时必答区 | 单片机教程 | 单片机DIY制作 | STM32 | Cortex M3 | 模数电子 | 电子DIY制作 | 音响/功放 | 拆机乐园 | Arduino | 嵌入式OS | 程序设计

搜索
»论坛 › 电子技术分类讨论区 › 资料共享 › arduino小车控制程序，包含与树莓派通信程序
返回列表 发新帖
查看: 2714|回复: 0
打印 上一主题 下一主题
收起左侧

arduino小车控制程序，包含与树莓派通信程序

[复制链接]
跳转到指定楼层
楼主
ID:404916 发表于 2018-10-2 19:31 | 只看该作者 |只看大图 回帖奖励 |倒序浏览 |阅读模式
小车控制程序，包含与树莓派通信程序


单片机源程序如下:

  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)


分享到:  QQ好友和群QQ好友和群 QQ空间QQ空间 腾讯微博腾讯微博 腾讯朋友腾讯朋友
收藏收藏 分享淘帖 顶顶 踩踩
回复

使用道具 举报

返回列表 发新帖
高级模式
B Color Image Link Quote Code Smilies
您需要登录后才可以回帖 登录 | 立即注册

本版积分规则

手机版|小黑屋|51黑电子论坛 |51黑电子论坛6群 QQ 管理员QQ:125739409;技术交流QQ群281945664

Powered by 单片机教程网

快速回复 返回顶部 返回列表