发明公开
- 专利标题: 一种基于切换策略的铰接式自动驾驶农业机械路径跟踪控制方法
-
申请号: CN202310437962.2申请日: 2023-04-21
-
公开(公告)号: CN116661441A公开(公告)日: 2023-08-29
- 发明人: 陈建锋 , 葛新元 , 汤传业 , 吴强 , 叶贻财 , 赵景波 , 周卫琪
- 申请人: 常州工学院
- 申请人地址: 江苏省常州市新北区辽河路666号
- 专利权人: 常州工学院
- 当前专利权人: 常州工学院
- 当前专利权人地址: 江苏省常州市新北区辽河路666号
- 代理机构: 南京智造力知识产权代理有限公司
- 代理商 张明明
- 主分类号: G05D1/02
- IPC分类号: G05D1/02
摘要:
本发明公开了一种基于切换策略的铰接式自动驾驶农业机械路径跟踪控制方法,根据铰接机具的运动学模型构建线性和非线性离散状态空间方程,并设计农业机械控制系统的目标函数和系统约束;由农业机械当前路径曲率确定车辆转弯工况并选择路径跟踪切换策略:当农业机械处于小曲率转弯工况采用模型预测控制进行路径跟踪控制,当农业机械处于大曲率转弯工况采用非线性模型预测控制进行路径跟踪控制;在车辆路径跟踪控制中,动态调整目标函数中的预测时域并设定参考车速。本发明能够高效、高精度、稳定地实现铰接式自动驾驶农业机械的路径跟踪。