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

 找回密码
 立即注册

QQ登录

只需一步，快速开始

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

搜索
»论坛 › 电子技术分类讨论区 › 智能小车/机器人 › 智能小车循迹加避障电路图 源程序
返回列表 发新帖
查看: 8983|回复: 3
打印 上一主题 下一主题
收起左侧

智能小车循迹加避障电路图 源程序

[复制链接]
跳转到指定楼层
楼主
ID:153740 发表于 2016-12-10 17:56 | 只看该作者 |只看大图 回帖奖励 |正序浏览 |阅读模式
这个简单的避障小车使用超声波进行距离测量，根据测量距离决定小车行驶方向。对于避障做了简化处理，只要有障碍物就右转。为了节省成本，只用了一个超声波模块，因此只能对正前方物体进行避障。小车采用三轮结构，速度差进行方向控制。
超声波模块使用的成品模块，单片机使用一个最小系统板，底板上有L293D电机驱动模块。总体组装如下图：


避障小车原理图.rar (35.42 KB, 下载次数: 95)
避障小车源代码.rar (4.46 KB, 下载次数: 44)


部分源码预览：
  1. /*
  2. * motor.c
  3. *
  4. *  Created on: 2011-3-3
  5. *      Author: Jason Jiang
  6. *         Home Page: www.ruixuedz.com.cn
  7. *                  Email: ruixuedz@gmail.com
  8. */
  9. #include "motor.h"
  10. #include "uart.h"

  12. MOTOR_STATE g_motor_state = MOTOR_STOP;
  13. uchar g_count = 0;
  14. uchar g_left_pwm = 0;
  15. uchar g_right_pwm = 0;

  17. void motor_init()
  18. {
  19.         cli();
  20.         INPUT_DDR |= _BV(LEFT_INPUT1) | _BV(LEFT_INPUT2) | _BV(RIGHT_INPUT1) | _BV(
  21.                         RIGHT_INPUT2);
  22.         ENABLE_DDR |= _BV(LEFT_ENABLE) | _BV(RIGHT_ENABLE);
  23.         INPUT_PORT &= ~(_BV(LEFT_INPUT1) | _BV(LEFT_INPUT2) | _BV(RIGHT_INPUT1)
  24.                         | _BV(RIGHT_INPUT2));
  25.         ENABLE_PORT &= ~(_BV(LEFT_ENABLE) | _BV(RIGHT_ENABLE));

  27.         setSpeed(200, 200);

  29.         TCCR0 = 0x00;             //停止定时器
  30.         TCNT0 = 0x38;             //设置初始值
  31.         TIMSK |= 0x01;
  32.         TCCR0 = 0x02;             //开动定时器

  34.         sei();
  35. }

  37. void motor_rotate()
  38. {
  39.         if (MOTOR_ROTATE == g_motor_state)
  40.         {
  41.                 return;
  42.         }

  44.         steerMotor(ROTATE_RIGHT);

  46.         g_motor_state = MOTOR_ROTATE;
  47. }

  49. void motor_forward()
  50. {
  51.         if (MOTOR_FORWARD == g_motor_state)
  52.         {
  53.                 return;
  54.         }

  56.         steerMotor(MOVE_FORWARD);

  58.         g_motor_state = MOTOR_FORWARD;
  59. }

  61. void steerMotor(MOTOR_STEER_ENUM steer)
  62. {
  63.         switch (steer)
  64.         {
  65.         case MOVE_FORWARD:
  66.                 INPUT_PORT &= ~(1 << LEFT_INPUT1);
  67.                 INPUT_PORT |= (1 << LEFT_INPUT2); //Left Motor On Forward
  68.                 INPUT_PORT &= ~(1 << RIGHT_INPUT1);
  69.                 INPUT_PORT |= (1 << RIGHT_INPUT2); //Right Motor On Forward
  70.                 break;

  72.         case TURN_LEFT:
  73.                 INPUT_PORT &= ~(1 << LEFT_INPUT1);
  74.                 INPUT_PORT &= ~(1 << LEFT_INPUT2); //Left Motor off
  75.                 INPUT_PORT &= ~(1 << RIGHT_INPUT1);
  76.                 INPUT_PORT |= (1 << RIGHT_INPUT2); //Right Motor On Forward
  77.                 break;

  79.         case TURN_RIGHT:
  80.                 INPUT_PORT &= ~(1 << LEFT_INPUT1);
  81.                 INPUT_PORT |= (1 << LEFT_INPUT2); //Left Motor On Forward
  82.                 INPUT_PORT &= ~(1 << RIGHT_INPUT1);
  83.                 INPUT_PORT &= ~(1 << RIGHT_INPUT2); //Right Motor off
  84.                 break;

  86.         case ROTATE_LEFT:
  87.                 INPUT_PORT |= (1 << LEFT_INPUT1);
  88.                 INPUT_PORT &= ~(1 << LEFT_INPUT2); //Left Motor On Reverse
  89.                 INPUT_PORT &= ~(1 << RIGHT_INPUT1);
  90.                 INPUT_PORT |= (1 << RIGHT_INPUT2); //Right Motor On Forward
  91.                 break;

  93.         case ROTATE_RIGHT:
  94.                 INPUT_PORT &= ~(1 << LEFT_INPUT1);
  95.                 INPUT_PORT |= (1 << LEFT_INPUT2); //Left Motor On Forward
  96.                 INPUT_PORT |= (1 << RIGHT_INPUT1);
  97.                 INPUT_PORT &= ~(1 << RIGHT_INPUT2); //Right Motor On Reverse
  98.                 break;

  100.         case MOVE_BACKWARD:
  101.                 INPUT_PORT |= (1 << LEFT_INPUT1);
  102.                 INPUT_PORT &= ~(1 << LEFT_INPUT2); //Left Motor On Reverse
  103.                 INPUT_PORT |= (1 << RIGHT_INPUT1);
  104.                 INPUT_PORT &= ~(1 << RIGHT_INPUT2); //Right Motor On Reverse
  105.                 break;

  107.         case FULL_STOP:
  108.                 INPUT_PORT &= ~(1 << LEFT_INPUT1);
  109.                 INPUT_PORT &= ~(1 << LEFT_INPUT2); //Left Motor off
  110.                 INPUT_PORT &= ~(1 << RIGHT_INPUT1);
  111.                 INPUT_PORT &= ~(1 << RIGHT_INPUT2); //Right Motor off
  112.                 break;

  114.         default:
  115.                 break;
  116.         }
  117. }

  119. void setSpeed(uchar left_pwm, uchar right_pwm)
  120. {
  121.         g_left_pwm = left_pwm;
  122.         g_right_pwm = right_pwm;
  123. }

  125. ISR(TIMER0_OVF_vect) //定时器溢出中断程序
  126. {
  127.         TCNT0 = 0x38; //从新调入初始值
  128.         g_count++; //每中断一次加1
  129.         //printStr("int\n");
  130.         if (g_count < g_left_pwm) //判断pwm1是不是改输出高电平
  131.         {
  132.                 ENABLE_PORT |= (1 << LEFT_ENABLE);
  133.                 //printStr("l1\n");
  134.         }
  135.         else
  136.         { //不是则输出0
  137.                 ENABLE_PORT &= ~(1 << LEFT_ENABLE);
  138.                 //printStr("l0\n");
  139.         }

  141.         if (g_count < g_right_pwm)
  142.         {
  143.                 ENABLE_PORT |= (1 << RIGHT_ENABLE);
  144.                 //printStr("r1\n");
  145.         }
  146.         else
  147.         {
  148.                 ENABLE_PORT &= ~(1 << RIGHT_ENABLE);
  149.                 //printStr("r0\n");
  150.         }
  151. }


复制代码


电路图, 智能
分享到:  QQ好友和群QQ好友和群 QQ空间QQ空间 腾讯微博腾讯微博 腾讯朋友腾讯朋友
收藏收藏3 分享淘帖 顶顶1 踩踩

相关帖子
回复

使用道具 举报

地板
ID:382244 发表于 2018-8-2 17:23 | 只看该作者
这用的是51单片机吗
回复

使用道具 举报

板凳
ID:375149 发表于 2018-7-24 14:08 | 只看该作者
群主你好!在51黑内在示教控制器方面资料吗?谢谢!若有那个髙手知道,加我QQ:550220127聊!谢谢!!
回复

使用道具 举报

沙发
ID:280166 发表于 2018-4-9 18:31 | 只看该作者
很好，对我很有帮助
回复

使用道具 举报

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

本版积分规则

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

Powered by 单片机教程网

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