正在播放国产厕所尿视频,琪琪电影网午夜理论片在线观看,精品亚洲Aⅴ无码一区二区

/*************************** XB-4WD-STM32智能小車參考程序 *******************************
* 實(shí) 驗(yàn) 名：XB-4WD-STM32智能小車超聲波避障實(shí)驗(yàn)
* 連接方式：請(qǐng)參考interface.h文件
****************************************************************************************/
#include "stm32f10x.h"
#include "interface.h"
#include "LCD1602.h"
#include "IRCtrol.h"
#include "motor.h"
#include "UltrasonicCtrol.h"
/**********************************************************************************************
** 全局變量定義
**********************************************************************************************/
unsigned int speed_count=0;//占空比計(jì)數(shù)器 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計(jì)數(shù)器，作為主函數(shù)的基本周期
unsigned char tick_1ms = 0;//1ms計(jì)數(shù)器，作為電機(jī)的基本計(jì)數(shù)器
unsigned char tick_200ms = 0;//刷新顯示
char ctrl_comm = COMM_STOP;//控制指令
char ctrl_comm_last = COMM_STOP;//上一次的指令
unsigned char continue_time=0;
unsigned char duoji_count=0;
unsigned char zhuanjiao = 11;
void InitIO()
{
GPIO_InitTypeDef GPIO_InitStructure;
RCC_APB2PeriphClockCmd(RCC_APB2Periph_GPIOE , ENABLE);//使能LED使用的GPIO時(shí)鐘
GPIO_InitStructure.GPIO_Pin = GPIO_Pin_7 | GPIO_Pin_8 | GPIO_Pin_9 | GPIO_Pin_10;
GPIO_InitStructure.GPIO_Mode = GPIO_Mode_Out_PP;
GPIO_InitStructure.GPIO_Speed = GPIO_Speed_50MHz;
GPIO_Init(GPIOE , &GPIO_InitStructure);//將使用LED燈相關(guān)的GPIO初始化
GPIO_SetBits(GPIOE , GPIO_Pin_7 | GPIO_Pin_8 | GPIO_Pin_9 | GPIO_Pin_10);//關(guān)閉所有的ＬＥＤ指示燈
}
void DuojiMid()
{
zhuanjiao = 11;
Delayms(150);//延時(shí)1s
}
void DuojiRight()
{
zhuanjiao = 5;
Delayms(150);//延時(shí)1s
}
void DuojiLeft()
{
zhuanjiao = 18;
Delayms(150);//延時(shí)1s
}
///獲取三個(gè)方向的距離,進(jìn)來前舵機(jī)方向?yàn)橄蚯?br />
void GetAllDistance(unsigned int *dis_left,unsigned int *dis_right,unsigned int *dis_direct)
{
CarStop();
GetDistanceDelay();
*dis_direct = distance_cm;
DuojiRight();
Delayms(100);
GetDistanceDelay();//獲取右邊距離
*dis_right = distance_cm;
DuojiMid();
DuojiLeft();
Delayms(100);
GetDistanceDelay();//獲取左邊距離
*dis_left = distance_cm;
DuojiMid();//歸位
}
void BarrierProc()
{
if(distance_cm < 30)//前方有障礙物
{
unsigned int dis_left;//左邊距離
unsigned int dis_right;//右邊距離
unsigned int dis_direct;//右邊距離
if(distance_cm < 15)
{
CarBack();
Delayms(400);
}
while(1)
{
GetAllDistance(&dis_left,&dis_right,&dis_direct);
if(dis_direct < 10)
{
CarBack();
Delayms(300);
continue;
}
else if((dis_left < 10) || (dis_right < 10))
{
CarBack();
Delayms(300);
continue;
}
else if(dis_direct >= dis_left && dis_direct >= dis_right)//前方距離最遠(yuǎn)
{
CarGo();
Delayms(600);
return;
}
else if(dis_left <= dis_right)//右轉(zhuǎn)
{
CarRight();
Delayms(500);
}
else if(dis_right < dis_left)
{
CarLeft();
Delayms(500);
}
}
}
else
{
CarGo();
}
}
int main(void)
{
delay_init();
LCD1602Init();
//IRCtrolInit();
TIM2_Init();
MotorInit();
UltraSoundInit();
InitIO();
//RedRayInit();
ServoInit();
while(1)
{
if(tick_5ms >= 5)
{
tick_5ms = 0;
tick_200ms++;
if(tick_200ms >= 40)
{
tick_200ms = 0;
LEDToggle(GPIO_Pin_8);
LCD1602WriteDistance(distance_cm);//更新距離
}
Distance();//計(jì)算距離
BarrierProc();
}
}
}

復(fù)制代碼