#include<reg51.h>
#include"Config.h"
#include"IOCfg.c"
#include"TimeDLY.h"
#include"StepMot.h"
#include"Follow.h"
#include"LightDTC.h"
#include"MetalDTC.h"
#include"SegDisp.h"
#include"UltraDTC.h"
INT32U RunTime=0; //运行时间
INT8U MetalNum=0; //直道的金属块数目
void InitIO()
{
LMot_AP=0;LMot_AN=0;LMot_BP=0;LMot_BN=0;
RMot_AP=0;RMot_AN=0;RMot_BP=0;RMot_BN=0;
Follow_L=1;Follow_M=1;Follow_R=1;
Metal_DTC=1;
UltraDTC_TR=0;UltraDTC_RE=1;
LightDTC_L=1;LightDTC_M=1;LightDTC_R=1;
Guide=0;
DS1CS=0;DS0CS=0;P2=0x00;
}
void main()
{
INT8U i;
InitIO();
LMotRun(LSPEED);
RMotRun(LSPEED);
TMOD = TMOD | 0x20 ; //T1 工作在方式2(8位计数器,自动重载)
TH1 = 0x00;
TL1 = 0x9B;
EA = 1;
ET1 = 1;
TR1 = 1;
while(1)
{
do //直道运行时间小于20秒,实际约为15秒
{
Follow();
if(Metal_Detec()) MetalNum++;
Seg_Disp((INT8U)(RunTime/10000));
}
while(RunTime<200000);
do
{
Follow();
Seg_Disp((INT8U)(RunTime/10000));
}
while(Metal_DTC != 1);
//达到C点,停留5s,断续声光指示
LMotStop();
RMotStop();
for(i=0;i<5;i++)
{
Guide = 1;
T0_Delay(5000);
Guide = 0;
T0_Delay(5000);
}
do //进入障碍区
{
Ultra_DTC();
Seg_Disp((INT8U)(RunTime/10000));
}
while(RunTime<500000);
do //进入停车区
{
Light_DTC();
Seg_Disp((INT8U)(RunTime/10000));
}
while(RunTime<800000);
//停车
LMotRun(HSPEED);
RMotRun(HSPEED);
LDelay(20000);
LMotStop();
RMotStop();
for(i=0;i<100;i++)
Seg_Disp((INT8U)(RunTime/10000));
}
}
void Time1_IT(void) interrupt 3
{
RunTime ++;
}
CrMylive.
- 粉丝: 1w+
- 资源: 4万+
最新资源
- 新能源电池包气密性检测stp全套技术资料100%好用.zip
- MIPI-DPU platform TCL
- MATLAB 实现基于核密度估计(KDE)进行时间序列预测模型的项目详细实例(含完整的程序,GUI设计和代码详解)
- MATLAB 实现基于贝叶斯网络(Bayesian Network)进行时间序列预测模型的项目详细实例(含完整的程序,GUI设计和代码详解)
- 模型预测控制(MPC)+路径跟踪(PTC)+侧偏角软约束+主动前轮转向(AFS),目前的范例是72km h,附着系数0.3的单移线,附着系数0.85双移线 仿真使用的是MATLAB2020b版本和c
- 线缆装铠机sw18全套技术资料100%好用.zip
- MATLAB 实现基于ABKDE(自适应带宽核密度估计)进行时间序列预测模型的项目详细实例(含完整的程序,GUI设计和代码详解)
- comsol sofc固体氧化物燃料电池 单通道非绝热逆流固体氧化物燃料电池模型,包括阴阳极气体扩散层,电极扩散层尺寸来源于实际电池(极化曲线,性能曲线,气体分布,温度分布)
- MATLAB 实现基于自适应滤波(Adaptive Filtering)进行时间序列预测模型的项目详细实例(含完整的程序,GUI设计和代码详解)
- nltk的punkt与stopwords
- MATLAB 实现基于K近邻回归(KNN)进行时间序列预测模型的项目详细实例(含完整的程序,GUI设计和代码详解)
- Steam++ -v3.0.0-rc.11-win-x64
- 星巴克杯子圆弧涂胶x_t全套技术资料100%好用.zip
- MATLAB实现COA-CNN-BiLSTM-Attention-RF浣熊优化卷积双向长短期记忆神经网络注意力机制组合随机森林多输入单输出回归预测(含完整的程序,GUI设计和代码详解)
- 永磁同步电机电流环模型预测控制(MPC)simulink仿真模型,速度环PI控制,电流环为MPC控制,不是FOC控制
- 药瓶侧身扫码抓取称重设备X_T全套技术资料100%好用.zip
资源上传下载、课程学习等过程中有任何疑问或建议,欢迎提出宝贵意见哦~我们会及时处理!
点击此处反馈