一种基于磁场发射器的机械臂运动标定方法技术

本发明专利技术提出一种基于磁场发射器的机械臂运动标定方法，包括将磁场发射器与电磁导航系统相连接，将磁片固定于机械臂末端；在机械臂基座、机械臂末端、磁片和磁场发射器上分别建立坐标系；由机械臂带动磁片共同运动，通过电磁导航系统获取磁片的运动数据，通过机械臂获取机械臂末端的运动数据，当机械臂移动一次时，分别记录机械臂末端坐标值和磁片坐标值；构建机械臂的运动标定方程；通过使机械臂移动多个位置，记录机械臂末端坐标值，并记录每个位置对应的磁片坐标值，应用最小二乘法得到所求参数的最佳值；即可得到磁片坐标系和机械臂末端坐标系间的转换关系，完成机械臂的运动标定。上述方法标定结果的精度较高，适用范围广泛。

【技术实现步骤摘要】
一种基于磁场发射器的机械臂运动标定方法
本专利技术涉及标定
，尤其涉及一种基于磁场发射器的机械臂运动标定方法。
技术介绍
利用机械臂对物体进行定位已广泛应用于医疗领域，但随着控制要求的不断提高，机械结构越加复杂，机械臂控制模型的建立以及计算的难度也逐渐增加。目前广泛应用的机器人由于受零件制造误差、装配误差、负载变化等因素的影响，限制了机械臂在定位任务中的应用。
技术实现思路
为了解决现有技术中存在的问题，本申请提出了一种基于磁场发射器的机械臂运动标定方法，该方法操作简单，标定结果的精度较高，适用范围广泛。为了实现上述目的，本申请提出了一种基于磁场发射器的机械臂运动标定方法，包括以下步骤：步骤1、将磁场发射器与电磁导航系统相连接，将磁片固定于机械臂末端并且保持固定不动；步骤2、在机械臂基座、机械臂末端、磁片和磁场发射器上分别建立坐标系，分别为机械臂基座坐标系，记做Base；机械臂末端坐标系，记做End；磁片坐标系，记做magnet；磁场发射器坐标系，记做NDI；步骤3、由机械臂带动磁片共同运动，通过电磁导航系统获取磁片的运动数据，通过机械臂获取机械臂末端的运动数据，当机械臂移动一次时，即从第一位置移动到第二位置时，分别记录机械臂末端坐标值和磁片坐标值；步骤4、构建机械臂的运动标定方程：当机械臂移动一次时，即从第一位置移动到第二位置时，机械臂移动前后，机械臂基座坐标系和磁场发射器坐标系之间的相对位置不改变，磁片坐标系和机械臂末端坐标系之间的相对位置不改变，有以下公式成立：其中均表示机械臂末端坐标系到机械臂基座坐标系的转换关系；均表示磁场发射器坐标系到磁片坐标系的转换关系；均表示磁片坐标系到机械臂末端坐标系的转换关系，它们在机械臂移动过程中是不变的；公式(1)经过转换得到：令即A*X＝X*B；其中A和B是已知的，X是需要求解的参数；步骤5、通过使机械臂移动多个位置，记录机械臂末端坐标值，并记录每个位置对应的磁片坐标值，应用最小二乘法得到所求参数X的最佳值；即可得到磁片坐标系和机械臂末端坐标系间的转换关系，完成机械臂的运动标定。本申请的该方案的有益效果在于上述基于磁场发射器的机械臂运动标定方法借助磁场发射器，由机械臂带动磁片共同运动，通过电磁导航系统获取磁片的运动数据，通过机械臂获取机械臂末端的运动数据，结合两者运动的约束关系构建机械臂的运动标定方程，求解该方程即可得到磁片坐标系和机械臂末端坐标系间的转换关系，完成机械臂的运动标定；该方法中磁片方便携带，且标定的操作简单，标定结果的精度较高，适用范围广泛。附图说明图1示出了实施例中基于磁场发射器的机械臂运动标定的示意图。附图标记：1-机械臂，2-机械臂基座，3-机械臂末端，4-磁片，5-磁场发射器。具体实施方式下面结合附图对本申请的具体实施方式作进一步的说明。如图1所示，本申请所涉及的基于磁场发射器的机械臂运动标定方法包括以下步骤：步骤1、将磁场发射器与电磁导航系统相连接，将磁片固定于机械臂末端并且保持固定不动。步骤2、在机械臂基座、机械臂末端、磁片和磁场发射器上分别建立坐标系，分别为机械臂基座坐标系，记做Base；机械臂末端坐标系，记做End；磁片坐标系，记做magnet；磁场发射器坐标系，记做NDI。步骤3、由机械臂带动磁片共同运动，通过电磁导航系统获取磁片的运动数据，通过机械臂获取机械臂末端的运动数据，当机械臂移动一次时，即从第一位置移动到第二位置时，分别记录机械臂末端坐标值和磁片坐标值。步骤4、构建机械臂的运动标定方程：当机械臂移动一次时，即从第一位置移动到第二位置时，机械臂移动前后，机械臂基座坐标系和磁场发射器坐标系之间的相对位置不改变，磁片坐标系和机械臂末端坐标系之间的相对位置不改变，有以下公式成立：其中均表示机械臂末端坐标系到机械臂基座坐标系的转换关系；均表示磁场发射器坐标系到磁片坐标系的转换关系；均表示磁片坐标系到机械臂末端坐标系的转换关系，它们在机械臂移动过程中是不变的，也是我们要求解的。公式(1)经过转换得到：令即A*X＝X*B；其中A和B是已知的，X是需要求解的参数。步骤5、通过使机械臂移动多个位置，记录机械臂末端坐标值，并记录每个位置对应的磁片坐标值，应用最小二乘法得到所求参数X的最佳值；即可得到磁片坐标系和机械臂末端坐标系间的转换关系，也就确定了磁片和机械臂末端间的转换关系，完成了机械臂的运动标定。本申请所涉及的基于磁场发射器的机械臂运动标定方法借助磁场发射器，由机械臂带动磁片共同运动，通过电磁导航系统获取磁片的运动数据，通过机械臂获取机械臂末端的运动数据，结合两者运动的约束关系构建机械臂的运动标定方程，求解该方程即可得到磁片坐标系和机械臂末端坐标系间的转换关系，完成机械臂的运动标定；该方法中磁片方便携带，且标定的操作简单，建立了具有连续性和完备性的运动学模型，标定结果的精度较高，适用范围广泛。本文档来自技高网...

【技术保护点】
1.一种基于磁场发射器的机械臂运动标定方法，其特征在于：包括以下步骤：/n步骤1、将磁场发射器与电磁导航系统相连接，将磁片固定于机械臂末端并且保持固定不动；/n步骤2、在机械臂基座、机械臂末端、磁片和磁场发射器上分别建立坐标系，分别为机械臂基座坐标系，记做Base；机械臂末端坐标系，记做End；磁片坐标系，记做magnet；磁场发射器坐标系，记做NDI；/n步骤3、由机械臂带动磁片共同运动，通过电磁导航系统获取磁片的运动数据，通过机械臂获取机械臂末端的运动数据，当机械臂移动一次时，即从第一位置移动到第二位置时，分别记录机械臂末端坐标值和磁片坐标值；/n步骤4、构建机械臂的运动标定方程：当机械臂移动一次时，即从第一位置移动到第二位置时，机械臂移动前后，机械臂基座坐标系和磁场发射器坐标系之间的相对位置不改变，磁片坐标系和机械臂末端坐标系之间的相对位置不改变，有以下公式成立：/n

【技术特征摘要】
1.一种基于磁场发射器的机械臂运动标定方法，其特征在于：包括以下步骤：
步骤1、将磁场发射器与电磁导航系统相连接，将磁片固定于机械臂末端并且保持固定不动；
步骤2、在机械臂基座、机械臂末端、磁片和磁场发射器上分别建立坐标系，分别为机械臂基座坐标系，记做Base；机械臂末端坐标系，记做End；磁片坐标系，记做magnet；磁场发射器坐标系，记做NDI；
步骤3、由机械臂带动磁片共同运动，通过电磁导航系统获取磁片的运动数据，通过机械臂获取机械臂末端的运动数据，当机械臂移动一次时，即从第一位置移动到第二位置时，分别记录机械臂末端坐标值和磁片坐标值；
步骤4、构建机械臂的运动标定方程：当机械臂移动一次时，即从第一位置移动到第二位置时，机械臂移动前后，机械臂基座坐标...

【专利技术属性】
技术研发人员：王炳强，谷鹏，孙之建，
申请(专利权)人：山东威高医疗科技有限公司，
类型：发明
国别省市：山东;37