黄色视频免费直接看,亚洲狠狠丁香婷婷综合久久久,91亚洲精品一区二区

/*************************** XB-4WD-STM32智能小車參考程序 *******************************
* 實驗名：XB-4WD-STM32智能小車超聲波避障實驗
* 連接方式：請參考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;//占空比計數器 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;//控制指令
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時鐘
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燈相關的GPIO初始化
GPIO_SetBits(GPIOE , GPIO_Pin_7 | GPIO_Pin_8 | GPIO_Pin_9 | GPIO_Pin_10);//關閉所有的ＬＥＤ指示燈
}
void DuojiMid()
{
zhuanjiao = 11;
Delayms(150);//延時1s
}
void DuojiRight()
{
zhuanjiao = 5;
Delayms(150);//延時1s
}
void DuojiLeft()
{
zhuanjiao = 18;
Delayms(150);//延時1s
}
///獲取三個方向的距離,進來前舵機方向為向前
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)//前方距離最遠
{
CarGo();
Delayms(600);
return;
}
else if(dis_left <= dis_right)//右轉
{
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();//計算距離
BarrierProc();
}
}
}

復制代碼

欧美极品高清xxxxhd,国产日产欧美最新,无码AV国产东京热AV无码,国产精品人与动性XXX,国产传媒亚洲综合一区二区,四库影院永久国产精品,毛片免费免费高清视频,福利所导航夜趣136