用L298N电机驱动来实现,P1_4 X轴 P1_5 Y轴
P1_0
P1_1
P1_2
P1_3
上面为驱动板的信号控制口,EN1 EN2为高电平就行。
你应该能明白吧!
#include
#include
#define RightSenser P1_4 //左信号
#define LeftSenser P1_5 //右信号
unsigned char a,b,k,j;de;
void delay10ms() //延时函数
{
for(a=100;a>0;a--)
for(b=225;b>0;b--);
}
//********************************************************
//********************************************************
main()
{
while(1)
{
P1_0 = 1 ;
P1_1 = 1 ;
P1_2 = 1 ;
P1_3 = 1;
if((!RightSenser) && LeftSenser) // 如果右边假,左边真
{
P1_0 = 0 ;
P1_1 = 1 ;
for (de=0; de<100; de++); // 延时
}
if(RightSenser && (!LeftSenser)) // 如果左边假,右边真
{
P1_2 = 0 ;
P1_3 = 1;
for (de=0; de<100; de++); // 延时
}
if((!RightSenser) && (!LeftSenser)) //左右都有信号,前进
{
P1_0 = 0 ;
P1_1 = 1 ;
P1_2 = 0 ;
P1_3 = 1;
for (de=0; de<100; de++); // 延时
}
if((RightSenser) && (LeftSenser)) //无信号 停止
{
P1_0 = 1 ;
P1_1 = 1 ;
P1_2 = 1 ;
P1_3 = 1;
for (de=0; de<100; de++); // 延时
}
}
}
没有原理图是没法写程序的
不如直接要别人的专利就行了
负责人的告诉你,你问的问题太宽泛,不知所云。不会有结果的