摘要
本发明提供了一种重型水泥杆对接机器人控制方法,包括以下步骤:获取下段水泥杆的姿态信息,获取上段水泥杆的姿态信息;根据下段水泥杆的姿态信息和上段水泥杆的姿态信息设置水泥杆姿态调整指令;根据水泥杆姿态调整指令对上段水泥杆的姿态进行调整,根据水泥杆姿态调整指令对下段水泥杆的姿态进行调整;获取完成姿态调整的下段水泥杆的姿态信息和上段水泥杆的姿态信息;根据完成姿态调整的下段水泥杆的姿态信息和上段水泥杆的姿态信息对下段水泥杆和下段水泥杆进行姿态校验。本发明能够快速生成姿态调整指令,并执行调整操作,调整两段水泥杆的姿态,避免传统方法中因人工检查和调整缓慢而导致的时间浪费。