通過光電編碼器HJ-IR6獲取小車等移動物體運動速度并計算出運動軌跡路程。
單片機源程序如下:
- //連接方式 :請參考interface.h文件
- //部份源碼來源網絡--請試用24小時后刪除
- #include "stm32f10x.h"
- #include "interface.h"
- #include "LCD1602.h"
- #include "IRCtrol.h"
- #include "motor.h"
- #include "SpeedCtrol.h"
- //全局變量定義
- unsigned int speed_count=0;//占空比計數器 50次一周期
- char front_left_speed_duty=SPEED_DUTY;
- char front_right_speed_duty=SPEED_DUTY;
- char behind_left_speed_duty=SPEED_DUTY;
- char behind_right_speed_duty=SPEED_DUTY;
- unsigned char tick_5ms = 0;//5ms計數器,作為主函數的基本周期
- unsigned char tick_1ms = 0;//1ms計數器,作為電機的基本計數器
- unsigned char tick_200ms = 0;//刷新顯示
- char ctrl_comm = COMM_STOP;//控制指令
- unsigned char continue_time=0;
- int main(void)
- {
- delay_init();
- GPIOCLKInit();
- UserLEDInit();
- LCD1602Init();
- IRCtrolInit();
- TIM2_Init();
- MotorInit();
- ServoInit();
- MeasureInit();
- while(1)
- {
- if(tick_5ms >= 5)
- {
- tick_5ms = 0;
- tick_200ms++;
- if(tick_200ms >= 40)
- {
- tick_200ms = 0;
- LEDToggle(LED_PIN);
- LCD1602WriteSpeed(front_left_speed,front_right_speed);
- }
- continue_time--;//200ms 無接收指令就停車
- if(continue_time == 0)
- {
- continue_time = 1;
- CarStop();
- }
- //do something
- MeasureSpeed();
- if(ir_rec_flag == 1)//接收到紅外信號
- {
- ir_rec_flag = 0;
- switch(ctrl_comm)
- {
- case COMM_UP: CarGo();break;
- case COMM_DOWN: CarBack();break;
- case COMM_LEFT: CarLeft();break;
- case COMM_RIGHT: CarRight();break;
- case COMM_STOP: CarStop();break;
- default : break;
- }
- LCD1602WriteCommand(ctrl_comm);
- }
- }
-
- }
- }
復制代碼
所有資料51hei提供下載:
光電編碼器HJ-IR6相關代碼測速測路程.7z
(183.81 KB, 下載次數: 54)
2018-12-29 16:31 上傳
點擊文件名下載附件
|