找回密码
 立即注册

QQ登录

只需一步,快速开始

搜索
查看: 4167|回复: 0
收起左侧

HJ-IR6光电编码器测速,测路程相关STM32单片机代码

[复制链接]
ID:451633 发表于 2018-12-29 14:28 | 显示全部楼层 |阅读模式
通过光电编码器HJ-IR6获取小车等移动物体运动速度并计算出运动轨迹路程。

单片机源程序如下:
  1. //连接方式 :请参考interface.h文件
  2. //部份源码来源网络--请试用24小时后删除
  3. #include "stm32f10x.h"
  4. #include "interface.h"
  5. #include "LCD1602.h"
  6. #include "IRCtrol.h"
  7. #include "motor.h"
  8. #include "SpeedCtrol.h"

  9. //全局变量定义
  10. unsigned int speed_count=0;//占空比计数器 50次一周期
  11. char front_left_speed_duty=SPEED_DUTY;
  12. char front_right_speed_duty=SPEED_DUTY;
  13. char behind_left_speed_duty=SPEED_DUTY;
  14. char behind_right_speed_duty=SPEED_DUTY;

  15. unsigned char tick_5ms = 0;//5ms计数器,作为主函数的基本周期
  16. unsigned char tick_1ms = 0;//1ms计数器,作为电机的基本计数器
  17. unsigned char tick_200ms = 0;//刷新显示

  18. char ctrl_comm = COMM_STOP;//控制指令
  19. unsigned char continue_time=0;


  20. int main(void)
  21. {
  22.         delay_init();
  23.         GPIOCLKInit();
  24.         UserLEDInit();
  25.         LCD1602Init();
  26.         IRCtrolInit();
  27.         TIM2_Init();
  28.         MotorInit();
  29.         ServoInit();
  30.         MeasureInit();

  31. while(1)
  32. {         
  33.                          if(tick_5ms >= 5)
  34.                 {
  35.                         tick_5ms = 0;
  36.                         tick_200ms++;
  37.                         if(tick_200ms >= 40)
  38.                         {
  39.                                 tick_200ms = 0;
  40.                                 LEDToggle(LED_PIN);
  41.                                 LCD1602WriteSpeed(front_left_speed,front_right_speed);
  42.                         }
  43.                         continue_time--;//200ms 无接收指令就停车
  44.                         if(continue_time == 0)
  45.                         {
  46.                                 continue_time = 1;
  47.                                 CarStop();
  48.                         }
  49.                         //do something
  50.                         MeasureSpeed();
  51.                         if(ir_rec_flag == 1)//接收到红外信号
  52.                         {
  53.                                 ir_rec_flag = 0;
  54.                                 switch(ctrl_comm)
  55.                                 {
  56.                                         case COMM_UP:    CarGo();break;
  57.                                         case COMM_DOWN:  CarBack();break;
  58.                                         case COMM_LEFT:  CarLeft();break;
  59.                                         case COMM_RIGHT: CarRight();break;
  60.                                         case COMM_STOP:  CarStop();break;
  61.                                         default : break;
  62.                                 }
  63.                                 LCD1602WriteCommand(ctrl_comm);
  64.                         }
  65.                 }
  66.                
  67. }
  68. }
复制代码

所有资料51hei提供下载:
光电编码器HJ-IR6相关代码测速测路程.7z (183.81 KB, 下载次数: 54)

评分

参与人数 1黑币 +50 收起 理由
admin + 50 共享资料的黑币奖励!

查看全部评分

回复

使用道具 举报

您需要登录后才可以回帖 登录 | 立即注册

本版积分规则

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

Powered by 单片机教程网

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