一种基于多传感器融合的自动转载机械臂控制方法

摘要

本发明公开了一种基于多传感器融合的自动转载机械臂控制方法，包括：根据目标车辆位置粗信息控制机械臂移动向目标车辆位置所在区域；使用设置在机械臂上的视觉传感器和激光距离传感器采集目标车辆的导弹装设对准位置信息；根据导弹贮存位置粗信息控制机械臂移动向导弹贮存位置所在区域；使用视觉传感器和激光距离传感器采集导弹对准位置信息；控制机械臂抓取导弹上导弹对准位置的动作；根据导弹装设对准位置信息控制机械臂对导弹的姿态粗调整并移动向导弹装设对准位置；根据导弹对准位置信息和导弹装设对准位置信息控制机械臂精调整导弹的姿态至放置导弹对准接插件于目标车辆的导弹装设对准位置。本发明实现了转载目标自动化和目标位置高识别的功能。