摘要
本发明公开了一种煤矿井下无人车轨迹跟踪方法及系统,包括:S1,建立无人车的轨迹预测模块和车辆横向动力学跟踪误差模型;S2,基于所述车辆横向动力学跟踪误差模型设计横向控制器,得到无人车的前轮转角控制指令;S3,设计纵向控制器,得到无人车期望加速度;S4,建立无人车纵向逆动力学模型,将无人车期望加速度输入计算得到油门开度大小或制动压力大小;S5,基于油门开度大小或制动压力大小得到无人车速度,基于无人车的前轮转角控制指令得到无人车前轮转角,通过横纵向联合控制完成无人车轨迹跟踪。本发明针对煤矿井下复杂环境对轨迹跟踪控制的实时性、鲁棒性需求,提出横向与纵向协同控制策略,实现车速的精准跟踪与抗干扰能力。
技术关键词
无人车
轨迹跟踪方法
反馈控制器
逆动力学模型
煤矿井下
前馈控制器
误差模型
状态空间方程
蚂蚁
加速度
前轮
稳态误差
PID控制器
BP神经网络
蚁群优化算法
车辆
矩阵
横摆角速度
系统为您推荐了相关专利信息
无人车导航方法
非线性模型预测控制
林区
车辆
无人车路径规划
培训系统
煤矿井下
智能评估系统
巷道环境
动态功率控制
抗环境光干扰
光源系统
调光方法
读取传感器
坐标
轨迹跟踪方法
卡尔曼滤波算法
状态空间模型
协方差矩阵
估计误差