标题: 智能小车循迹加避障电路图 源程序 [打印本页]
作者: 780102636    时间: 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. }


复制代码


作者: 疯和尚    时间: 2018-4-9 18:31
很好，对我很有帮助
作者: WKG_123456    时间: 2018-7-24 14:08
群主你好!在51黑内在示教控制器方面资料吗?谢谢!若有那个髙手知道,加我QQ:550220127聊!谢谢!!
作者: 飞飞....    时间: 2018-8-2 17:23
这用的是51单片机吗



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