完善资料让更多小伙伴认识你,还能领取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 |
|
相关推荐 |
|
只有小组成员才能发言,加入小组>>
2135个成员聚集在这个小组
加入小组我的项目我做主,使用GN+Ninja来完成构建系统(VSCode开发RT106X)
37376 浏览 0 评论
NXP IMX8应用处理器快速入门必备:技巧、使用、设计指南
6775 浏览 1 评论
7793 浏览 1 评论
7642 浏览 0 评论
NXP i.MX6UL开发板(linux系统烧录+规格+硬件+模块移植)使用手册
5071 浏览 0 评论
1556浏览 2评论
关于NINA-W132 Wi-Fi模块SPI通信遇到的疑问求解
1208浏览 2评论
如何在MPC PowerPC MCU上首次刷写后禁用BDM?
749浏览 1评论
将HFREFR和LFREFR寄存器值设置为错误的值来将故障注入CMU,但CMU_ISR值始终为零,为什么?
735浏览 1评论
将SPSDK for FRDM-MCX-W71 SDK与VS一起安装时出现hidapi构建错误怎么解决?
678浏览 1评论
/9
小黑屋| 手机版| Archiver| 电子发烧友 ( 湘ICP备2023018690号 )
GMT+8, 2025-12-2 00:17 , Processed in 5.033701 second(s), Total 73, Slave 56 queries .
Powered by 电子发烧友网
© 2015 bbs.elecfans.com
关注我们的微信
下载发烧友APP
电子发烧友观察
版权所有 © 湖南华秋数字科技有限公司
电子发烧友 (电路图) 湘公网安备 43011202000918 号 电信与信息服务业务经营许可证:合字B2-20210191

淘帖
3845