一种基于磁场发射器的机械臂运动标定方法
基本信息
申请号 | CN202011471304.8 | 申请日 | - |
公开(公告)号 | CN112605995B | 公开(公告)日 | 2022-04-22 |
申请公布号 | CN112605995B | 申请公布日 | 2022-04-22 |
分类号 | B25J9/16(2006.01)I | 分类 | 手动工具;轻便机动工具;手动器械的手柄;车间设备;机械手; |
发明人 | 王炳强;谷鹏;孙之建 | 申请(专利权)人 | 山东威高医疗科技有限公司 |
代理机构 | 威海科星专利事务所 | 代理人 | 于涛 |
地址 | 264200山东省威海市高区初村镇山海路288-11号医疗器械产业园C区7号楼3层 | ||
法律状态 | - |
摘要
摘要 | 本发明提出一种基于磁场发射器的机械臂运动标定方法,包括将磁场发射器与电磁导航系统相连接,将磁片固定于机械臂末端;在机械臂基座、机械臂末端、磁片和磁场发射器上分别建立坐标系;由机械臂带动磁片共同运动,通过电磁导航系统获取磁片的运动数据,通过机械臂获取机械臂末端的运动数据,当机械臂移动一次时,分别记录机械臂末端坐标值和磁片坐标值;构建机械臂的运动标定方程;通过使机械臂移动多个位置,记录机械臂末端坐标值,并记录每个位置对应的磁片坐标值,应用最小二乘法得到所求参数的最佳值;即可得到磁片坐标系和机械臂末端坐标系间的转换关系,完成机械臂的运动标定。上述方法标定结果的精度较高,适用范围广泛。 |
