一种基于双反馈的位置同步方法、运动监测方法及其系统技术方案

本发明专利技术公开了一种基于双反馈的位置同步方法、运动监测方法及其系统，其中位置同步方法包括步骤：(1)标定出运动过程中由于负载位置的变化产生的安装于电机端的第一编码器和安装于负载端的第二编码器之间的位置误差；(2)获取第一编码器和第二编码器的读数，计算第一编码器和第二编码器之间的位置偏移；(3)根据步骤(2)得到的第一编码器和第二编码器之间的位置偏移以及步骤(1)标定的当前负载位置对应的第一编码器和第二编码器之间的位置误差，对所述第一编码器和第二编码器的位置进行同步修正。本发明专利技术无需单独在外部安装传感器、光电开关等辅助设备及配件来辅助电机实现复位功能，且在复位过程中无需电机运动。且在复位过程中无需电机运动。且在复位过程中无需电机运动。

【技术实现步骤摘要】
一种基于双反馈的位置同步方法、运动监测方法及其系统


[0001]本专利技术涉及伺服控制领域，尤其涉及一种基于双反馈的位置同步方法、运动 监测方法及其系统。

技术介绍

[0002]目前微创手术已基本取代开放手术成为外科医学领域发展的主要方向，相比 于传统的开放式手术，微创手术具有创伤小、病痛轻、恢复快等优势。随着机器 人技术的发展，以达芬奇手术机器人为代表的基于机器人辅助系统的微创手术逐 渐成熟，并被广泛应用。对于以手术机器人为代表的智能医疗领域以及以工业机 器人为代表的精密加工领域，对伺服系统的精度以及安全性要求极为严苛。
[0003]为保证设备运行过程中伺服系统的精准性，在使用前需要对伺服电机进行复 位，以保证伺服系统在工作过程中更为精准、稳定以及高效。传统的复位方法无 法通过单纯的程序控制，需要在外部安装传感器、光电开关等辅助设备及配件来 帮助实现复位功能，这些设备及配件安装过程繁琐、功能复杂、成本高、稳定性 差，并且提高了设备维护的难度。基于以上所述的传统复位方法，显然复位过程 中电机需要带动负载在一定范围内运动。
[0004]手术机器人在初始复位过程中，对于产生较大运动幅度的伺服关节应尽量避 免这种复位方式，以防对医生、患者等产生不必要的伤害。再者，若手术机器人 在运行过程中发生异常掉电，需要重启设备，设备重启必然要重新复位，而这种 复位运动在重启设备过程中是绝对不被允许的。另外，伺服系统在运行过程中往 往缺少监测手段，导致伺服系统故障后设备无法及时感知，会产生意想不到的危 害。
专利
技术实现思路

[0005]专利技术目的：本专利技术针对上述不足，提供了一种基于双反馈的位置同步方法、 运动监测方法及其系统，在运行过程中可实时对伺服系统进行监测。
[0006]技术方案：
[0007]一种基于双反馈的位置同步方法，包括步骤：
[0008](1)标定出运动过程中由于负载位置的变化产生的安装于电机端的第一编 码器和安装于负载端的第二编码器之间的位置误差；
[0009](2)获取第一编码器和第二编码器的读数，计算第一编码器和第二编码器 之间的位置偏移；
[0010](3)根据步骤(2)得到的第一编码器和第二编码器之间的位置偏移以及步 骤(1)标定的当前负载位置对应的第一编码器和第二编码器之间的位置误差， 对所述第一编码器和第二编码器的位置进行同步修正。
[0011]所述步骤(1)具体为：
[0012]在关节的有效行程内带动负载运动，通过所述第二编码器的读数实时计算负 载质心和关节轴线构成的平面与关节零位平面之间的夹角，根据所述第一编码器 的读数标
定出所述第一编码器和所述第二编码器之间的位置误差随负载质心和 关节轴线构成的平面与关节零位平面之间的夹角的变化曲线；其中，所述关节零 位平面定义为所述关节的轴线所在的竖直平面。
[0013]所述步骤(2)中，计算第一编码器和第二编码器的位置偏移具体为：
[0014](21)根据获取得到的所述第一编码器的当前读数E1计算得到电机端的实 际位置为A1＝E1/R1，根据获取得到的第二编码器的当前读数E2计算得到负载端 的实际位置为A2＝(E2‑
E
2Home
)/R2，其中，R1、R2分别表示第一编码器和第二编码 器的分辨率；E
2Home
表示关节在零位处时第二编码器的读数；
[0015]当A2＞最大关节限位P
max
时，则将A2‑
2π作为新的A2，重复该过程直至得 到的A2＜P
max
；
[0016]当A2＜最小关节限位P
min
时，则将A2+2π作为新的A2，重复该过程直至得 到的A2＞P
min
；
[0017]其中，P
max
＝(E
2max
‑
E
2Home
)/R2，P
min
＝(E
2min
‑
E
2Home
)/R2；E
2max
、E
2min
分别为关 节在最大机械限位和最小机械限位处时第二编码器的读数；
[0018](22)根据步骤(21)得到的电机端和负载端的实际位置A1和A2，计算得 到位置偏移offset＝A1‑
A2。
[0019]在所述电机端与所述负载端之间还设有传动比为R
a
的谐波减速机，则所述 负载端的理论位置为A1＝E1/(R1*R
a
)。
[0020]所述第一编码器为增量编码器，所述第二编码器为单圈绝对值编码器或多圈 绝对值编码器。
[0021]一种采用前述基于双反馈的位置同步方法的运动监测方法，在所述负载端运 动过程中，控制器周期性地计算负载端的目标位置及两个编码器的反馈位置，并 据此判断是否出现故障；判断依据为：
[0022]根据两个编码器的反馈位置判断二者之间的经过同步修正后的位置误差是 否处于设定的第一阈值范围内，同时判断负载端的目标位置与第一编码器经过修 正后的位置之间的位置误差是否在第二阈值范围内；
[0023]若两者都在阈值范围内，则认为检测结果正常；否则存在故障，判断伺服失 能，控制控制器对其进行制动。
[0024]所述故障判断具体为：
[0025]定义两个编码器经过同步修正后的位置误差为M，负载端的目标位置与第 一编码器经过修正后的位置之间的位置误差为N；
[0026]若M处于第一阈值范围内，而N处于第二阈值范围外，则认为存在外部干 涉导致电机堵转；
[0027]若M处于第一阈值范围外，而N处于第二阈值范围内，则认为传动出现故 障；
[0028]若M处于第一阈值范围外，而N处于第二阈值范围外，则认为出现多故障 耦合。
[0029]所述第一阈值和所述第二阈值均设置为0.1rad。
[0030]一种采用前述基于双反馈的位置同步方法的系统，包括：
[0031]位置标定模块，在关节在其运动行程内运动时，根据前述同步方法计算得到 第一编码器和第二编码器之间的位置误差；
[0032]位置同步模块，根据前述同步方法计算得到第一编码器与第二编码器之间的 位置偏移，并结合所述位置标定模块计算得到的第一编码器和第二编码器之间的 位置误差对双编码器的位置进行同步修正。
[0033]还包括运动监测模块，其周期性地获取所述负载端的目标位置及两个编码器 的反馈位置，并判断是否出现故障及对应故障类型。
[0034]有益效果：本专利技术无需单独在外部安装传感器、光电开关等辅助设备及配件 来辅助电机实现复位功能，且在复位过程中无需电机运动。而且本专利技术采用双反 馈方式可对伺服系统在运行过程中进行实时监测，避免伺服系统故障后设备无法 及时感知从而产生意想不到的危害的风险。
附图说明
[0035]图1为关节模组剖面图；本文档来自技高网...

【技术保护点】

【技术特征摘要】
1.一种基于双反馈的位置同步方法，其特征在于：包括步骤：(1)标定出运动过程中由于负载位置的变化产生的安装于电机端的第一编码器和安装于负载端的第二编码器之间的位置误差；(2)获取第一编码器和第二编码器的读数，计算第一编码器和第二编码器之间的位置偏移；(3)根据步骤(2)得到的第一编码器和第二编码器之间的位置偏移以及步骤(1)标定的当前负载位置对应的第一编码器和第二编码器之间的位置误差，对所述第一编码器和第二编码器的位置进行同步修正。2.根据权利要求1所述的基于双反馈的位置同步方法，其特征在于：所述步骤(1)具体为：在关节的有效行程内带动负载运动，通过所述第二编码器的读数实时计算负载质心和关节轴线构成的平面与关节零位平面之间的夹角，根据所述第一编码器的读数标定出所述第一编码器和所述第二编码器之间的位置误差随负载质心和关节轴线构成的平面与关节零位平面之间的夹角的变化曲线；其中，所述关节零位平面定义为所述关节轴线所在的竖直平面。3.根据权利要求1所述的基于双反馈的位置同步方法，其特征在于：所述步骤(2)中，计算第一编码器和第二编码器的位置偏移具体为：(21)根据获取得到的所述第一编码器的当前读数E1计算得到电机端的实际位置为A1＝E1/R1，根据获取得到的第二编码器的当前读数E2计算得到负载端的实际位置为A2＝(E2‑
E
2Home
)/R2，其中，R1、R2分别表示第一编码器和第二编码器的分辨率；E
2Home
表示关节在零位处时第二编码器的读数；当A2＞最大关节限位P
max
时，则将A2‑
2π作为新的A2，重复该过程直至得到的A2＜P
max
；当A2＜最小关节限位P
min
时，则将A2+2π作为新的A2，重复该过程直至得到的A2＞P
min
；其中，P
max
＝(E
2max
‑
E
2Home
)/R2，P
min
＝(E
2min
‑
E
2Home
)/R2；E
2max
、E
2min
分别为关节在最大机械限位和最小机械限位处时第二编码...

【专利技术属性】
技术研发人员：程敏，杨辉，陈云川，袁文，申登伟，
申请(专利权)人：南京佗道医疗科技有限公司，
类型：发明
国别省市：