完善资料让更多小伙伴认识你,还能领取20积分哦, 立即完善>
扫一扫,分享给好友
小车壁障加循迹程序,输到单片机为什么小车工作不正常,壁障也不准确,压根就没循迹迹象,以下附程序,望大神指点
#include #include #define Left_1_led P3_7 #define Left_2_led P3_6 #define Right_1_led P3_5 #define Right_2_led P3_4 #define waibu P2_0 #define Left_moto_go {P1_0=1,P1_1=0,P1_2=1,P1_3=0;} //左边两个电机向前走 #define Left_moto_back {P1_0=0,P1_1=1,P1_2=0,P1_3=1;} //左边两个电机向后转 #define Left_moto_Stop {P1_0=0,P1_1=0,P1_2=0,P1_3=0;} //左边两个电机停转 #define Right_moto_go {P1_4=1,P1_5=0,P1_6=1,P1_7=0;} //右边两个电机向前走 #define Right_moto_back {P1_4=0,P1_5=1,P1_6=0,P1_7=1;} //右边两个电机向前走 #define Right_moto_Stop {P1_4=0,P1_5=0,P1_6=0,P1_7=0;} //右边两个电机停转 /************************************************************************/ //延时函数 void delay(unsigned int k) { unsigned int x,y; for(x=0;x } /************************************************************************/ //前速前进 void run(void) { Left_moto_go ; Right_moto_go ; } /************************************************************************/ //后退 void backrun(void) { Left_moto_back ; //左电机往前走 Right_moto_back ; //右电机往前走 } /************************************************************************/ //停止 void stoprun(void) { Left_moto_Stop ; //左电机往前走 Right_moto_Stop ; //右电机往前走 } /************************************************************************/ //左转 void leftrun(void) { Left_moto_back ; //左电机往前走 Right_moto_go ; //右电机往前走 } /************************************************************************/ //右转 void rightrun(void) { Left_moto_go ; //左电机往前走 Right_moto_back ; //右电机往前走 } void xunji() { if(Left_2_led==1&&Right_1_led==1) backrun(); if(Left_2_led==0&&Right_1_led==1) rightrun(); if(Left_2_led==1&&Right_1_led==0) leftrun(); if(Left_2_led==0&&Right_1_led==0) run(); } void bizhang() { if(Left_2_led==1&&Right_1_led==1) { if((Left_1_led==1&&Right_2_led==1)||(Left_1_led==0&&Right_2_led==0)) backrun(); if((Left_1_led==0&&Right_2_led==1)||(Left_1_led==0&&Right_2_led==0)||(Left_1_led==1&&Right_2_led==0)) rightrun(); if((Left_1_led==0&&Right_2_led==1)||(Left_1_led==1&&Right_2_led==1)) leftrun(); if((Left_1_led==0&&Right_2_led==0)) { while((!Right_2_led)) { run(); } } } } void main() { while(1) { xunji(); bizhang(); } } 头文件为 #include #ifndef _XUNJI_ #define _XUNJI_ #define uint unsigned int #define uchar unsigned char void fun1(); void fun3(); void fun4(); void fun5(); void bz1(); void bz2(); void bz3(); void xunji(); void bizhang(); void xunji(); void bizhang(); #endif |
|
相关推荐 |
|
只有小组成员才能发言,加入小组>>
1936个成员聚集在这个小组
加入小组我的项目我做主,使用GN+Ninja来完成构建系统(VSCode开发RT106X)
36433 浏览 0 评论
NXP IMX8应用处理器快速入门必备:技巧、使用、设计指南
5051 浏览 1 评论
6118 浏览 1 评论
6822 浏览 0 评论
NXP i.MX6UL开发板(linux系统烧录+规格+硬件+模块移植)使用手册
4255 浏览 0 评论
655浏览 2评论
求助,S32G上Core M启动后如何让Core A在Flash指定位置加载uboot?
646浏览 2评论
ESP32-WROVER-IE + LAN8720以太网,GPIO0电压只有1.6v,无法正常进入spi flash boot模式如何解决?
647浏览 2评论
求分享适用于PN7160 Android的NFC工厂测试应用程序
738浏览 2评论
853浏览 2评论
小黑屋| 手机版| Archiver| 电子发烧友 ( 湘ICP备2023018690号 )
GMT+8, 2024-12-30 01:53 , Processed in 0.951959 second(s), Total 46, Slave 39 queries .
Powered by 电子发烧友网
© 2015 bbs.elecfans.com
关注我们的微信
下载发烧友APP
电子发烧友观察
版权所有 © 湖南华秋数字科技有限公司
电子发烧友 (电路图) 湘公网安备 43011202000918 号 电信与信息服务业务经营许可证:合字B2-20210191 工商网监 湘ICP备2023018690号