STM32智能小车循迹模块程序

//LED + BEEP + 按键  实验测试


#include "key.h"
#include "led.h"
#include "delay.h"
#include "tracking.h"
#include "motor.h"
#include "sys.h"


int main(void)
{
u8 key=0;
delay_init(); // 延时函数初始化
LED_Init(); //初始化与LED连接的硬件接口
KEY_Init();
XUNJI_Init();
MOTOR_Init();


while(1)
{
if(XUNJI_IN1==0&XUNJI_IN2==1&XUNJI_IN3 ==1&XUNJI_IN4==0)
{
go();
}
else 
if( (XUNJI_IN1==1&XUNJI_IN2==1&XUNJI_IN3 ==1&XUNJI_IN4==0)|
(XUNJI_IN1==1&XUNJI_IN2==1&XUNJI_IN3 ==0&XUNJI_IN4==0)|
(XUNJI_IN1==1&XUNJI_IN2==0&XUNJI_IN3 ==0&XUNJI_IN4==0)|
(XUNJI_IN1==0&XUNJI_IN2==1&XUNJI_IN3 ==0&XUNJI_IN4==0) )
{
turn_left();
}
else 
if( (XUNJI_IN1==0&XUNJI_IN2==0&XUNJI_IN3 ==0&XUNJI_IN4==1)|
(XUNJI_IN1==0&XUNJI_IN2==0&XUNJI_IN3 ==1&XUNJI_IN4==1)|
(XUNJI_IN1==0&XUNJI_IN2==1&XUNJI_IN3 ==1&XUNJI_IN4==1)|
(XUNJI_IN1==0&XUNJI_IN2==0&XUNJI_IN3 ==1&XUNJI_IN4==0) )
{
turn_right();
}
else
{
go();
}
}
}

©️2020 CSDN 皮肤主题: 大白 设计师: CSDN官方博客 返回首页
实付0元
点击重新获取
扫码支付
钱包余额 0

抵扣说明:

1.余额是钱包充值的虚拟货币,按照1:1的比例进行支付金额的抵扣。
2.余额无法直接购买下载,可以购买VIP、C币套餐、付费专栏及课程。

余额充值