|
|
- #include "stm32f10x.h"
- #include "delay.h"
- #include "motor.h"
- #include "keysacn.h"
- #include "IRSEARCH.h"
- #include "IRAvoid.h"
- #include "usart.h"
- #include "UltrasonicWave.h"
- #include "timer.h"
- #include "Server.h"
- char ctrl_comm1 = COMM_STOP;//控制指令
- char ctrl_comm1_last = COMM_STOP;//上一次的指令
- int Q_temp,Q_temp_last,L_temp,R_temp;
- // 超聲波轉(zhuǎn)頭函數(shù)
- int front_detection()
- {
- // ZYSTM32_brake(0);
- SetJointAngle(90);
- delay_ms(100);
- return UltrasonicWave_StartMeasure();
- }
- int left_detection()
- {
- // ZYSTM32_brake(0);
- SetJointAngle(175);
- delay_ms(300);
- return UltrasonicWave_StartMeasure();
- }
- int right_detection()
- {
- // ZYSTM32_brake(0);
- SetJointAngle(5);
- delay_ms(300);
- return UltrasonicWave_StartMeasure();
- }
- void BarrierProc(void)
- {
- delay_ms(10);
- Q_temp_last = Q_temp;
- Q_temp = front_detection();
- printf("測(cè)到的距離值為：%d\n",Q_temp);
-
- if( Q_temp > 45)
- {
- ctrl_comm1 = COMM_STOP;//防震蕩
- return;
- }
-
- if((Q_temp_last > Q_temp)&&(Q_temp<=15)) ctrl_comm1 = COMM_DOWN;
- //if(Q_temp<=15) ctrl_comm1 = COMM_DOWN;
- if(Q_temp >=30) ctrl_comm1 = COMM_UP;
- }
- //extern int U_temp;
- /*
- void ZYSTM32_run(int speed,int time); //前進(jìn)函數(shù)
- void ZYSTM32_brake(int time); //剎車函數(shù)
- void ZYSTM32_Left(int speed,int time); //左轉(zhuǎn)函數(shù)
- void ZYSTM32_Spin_Left(int speed,int time); //左旋轉(zhuǎn)函數(shù)
- void ZYSTM32_Right(int speed,int time); //右轉(zhuǎn)函數(shù)
- void ZYSTM32_Spin_Right(int speed,int time);//右旋轉(zhuǎn)函數(shù)
- void ZYSTM32_back(int speed,int time); //后退函數(shù)
- */
- int main(void)
- {
- delay_init();
- KEY_Init();
- IRSearchInit();
- IRAvoidInit();
- Timerx_Init(5000,7199); //10Khz的計(jì)數(shù)頻率，計(jì)數(shù)到5000為500ms
- UltrasonicWave_Configuration(); //對(duì)超聲波模塊初始化
- uart_init(115200);
- TIM4_PWM_Init(7199,0); //初始化PWM
- TIM5_PWM_Init(9999,143); //不分頻，PWM頻率=72*10^6/(9999+1)/(143+1)=50Hz
- ZYSTM32_brake(500);
- keysacn();
- while(1)
- {
- BarrierProc();
-
- // Q_temp = front_detection();
- // printf("測(cè)到的距離值為：%d\n",Q_temp);
- //Q_temp_last = Q_temp;
- //Q_temp = front_detection();
- if(ctrl_comm1_last != ctrl_comm1)
- {
- ctrl_comm1_last = ctrl_comm1;
- switch(ctrl_comm1)
- {
- case COMM_UP: ZYSTM32_run(50,10);break;
- case COMM_DOWN: ZYSTM32_back(50,500); break;
- case COMM_LEFT: ZYSTM32_Left(50,700);break;
- case COMM_RIGHT:ZYSTM32_Right(50,700);break;
- case COMM_STOP: ZYSTM32_brake(500);break;
- default : break;
- }
- }
-
-
- }
- }
全部資料51hei下載地址：
ZYSTM32-A0 智能小車超聲波避障實(shí)驗(yàn)(有舵機(jī)).rar
(311.8 KB, 下載次數(shù): 89)
2018-7-16 17:13 上傳
點(diǎn)擊文件名下載附件
下載積分: 黑幣 -5
|
|
QQ好友和群
QQ空間
騰訊微博
騰訊朋友
收藏
淘帖
頂
踩
