基于多模态数据融合的菠萝田间收获机器人自动导航方法

本发明公开了一种基于多模态数据融合的菠萝田间收获机器人自动导航方法；首先将菠萝田间收获机器人中的多个传感器变换到同一坐标系内；接着采集菠萝田间图像且进行预处理，并从预处理后的菠萝田间图像中提取导航线信息；使用扩展卡尔曼滤波算法融合卫星导航传感器和惯性传感器的信息以及融合光电编码器和惯性传感器的信息，以获得菠萝田间收获机器人的位姿信息和里程信息：将导航线信息、位姿信息和里程信息输入到采用灰狼优化算法优化后的模型预测控制器中，得到最优控制信息并以此控制菠萝田间收获机器人自主实现路径追踪。本发明的菠萝田间收获机器人自动导航方法可以提高菠萝田间收获机器人在复杂环境中作业的适应性、稳定性和导航精度。