一种移动机器人轨迹修正控制算法
基本信息
申请号 | CN201710245462.3 | 申请日 | - |
公开(公告)号 | CN106863308B | 公开(公告)日 | 2019-08-30 |
申请公布号 | CN106863308B | 申请公布日 | 2019-08-30 |
分类号 | B25J9/16 | 分类 | 手动工具;轻便机动工具;手动器械的手柄;车间设备;机械手; |
发明人 | 刘召;宋立滨;于涛;陈恳;刘莉;陈洪安 | 申请(专利权)人 | 清研华翊(天津)教育科技有限公司 |
代理机构 | 天津滨海科纬知识产权代理有限公司 | 代理人 | 清研华翊(天津)教育科技有限公司 |
地址 | 300300 天津市东丽区华明街道弘顺道东段科创慧谷园区5号楼202室3号 | ||
法律状态 | - |
摘要
摘要 | 本发明公开了一种移动机器人轨迹修正控制算法,包括以下步骤:利用设于机器人上的IMU模块计算机器人的姿态角;将姿态角的变化转换为运动速度矢量;计算出合速度;计算出合速度作用下当前及剩余全部目标点修正位置;输出已修正的运动轨迹。本发明中所述的一种移动机器人轨迹修正控制算法,通过使用弹簧及惯性装置模块感知机器人上身的姿态变化,达到对外力大小和方向的判断,从而在主动运动基础上,根据人在机器人运动过程中施加的力实时调整运动轨迹。 |
