-
力传感器位于软体操作器末端来感知接触力,当操作器作用到人体组织时,力传感器应该具有包括横向力和轴向力的三维感知能力,微创手术创口疤痕根据手术的不同大多在20~30 mm之间,而受力极限则以视网膜手术为例,视网膜需要非常精细的运动,才能在小而受限的眼睛工作空间中对精细的组织进行精确的操作,Gupta等[17]人研究了猪尸体眼睛体外视网膜操作过程中施加的力。在所有测得的力中,约75%小于7.5 mN,只有19%的这种力量级的事件能被外科医生感觉到。为了满足测量需求,给出了集成力传感器的软体操作器的尺寸、量程以及精度要求,具体要求如表1所示。
表 1 三维力传感器设计要求
Table 1. Design requirements of 3D force sensor
Size Degree of freedom Range Precision Diameter not
exceeding 20 mmThe three dimensional force is
in the XYZ direction0-10 mN along
the XYZ directionAll were less than
5% full scale -
首先要制作软体机器人中单节操作臂的模具,将制作好的模具固定在试验台上,并将光纤通过植入模具和胶水依次固定在软体操作器模具中,当光纤光栅处于完全伸直的状态之后通过量筒和玻璃搅拌棒混合特定比例的Ecoflex00-50,搅拌至无明显气泡后将混合溶液缓慢倒入固定好的模具中,静止24 h后脱模然后缠绕凯夫拉线,得到实验所需的软体操作器,其制作流程图如图1所示。得到的软体操作器由3个正压充气腔道和1个负压抽气腔道组成,植入的光纤均匀布设在软体操作器周围,光栅部分位于操作器末端,其光纤光栅的植入分布示意图如图2所示。
-
当一定宽度频率的光入射FBG时,频率在λB附近的光波被反射出来,而波长不是λB的光波成功透射过FBG。λB被称为布拉格波长。而且,布拉格波长λB满足如下公式:
$$ {\lambda }_{B}{=2n}_{\rm{eff}} \cdot \varLambda $$ (1) 式中:λB为布拉格波长;neff是光纤的有效折射率;Λ为光栅周期。FBG的布拉格波长λB的大小与neff和Λ有关,当neff和Λ变化时,λB的大小也会随之改变,而neff和Λ主要受温度和应变的改变影响。所以neff和Λ可以分别改写为温度和应变的相关函数,并满足如下公式:
$$ {\lambda }_{B}{=2n}_{\rm{eff}} \cdot \varLambda =2{n}_{\rm{eff}}\left(\varepsilon ,T\right) \cdot \varLambda \left(\varepsilon ,T\right)$$ (2) 故在温度恒定的实验室或者人体温度下,FBG中心波长的改变仅受应变的影响。当FBG受到拉伸或者压缩,即仅收到轴向应变ε时,FBG的光栅周期Λ会发生变化,有效折射率neff受轴向应变影响较小,此时中心波长会产生漂移,偏移量为ΔλB。其公式如下所示:
$$ \Delta {\lambda }_{B}={\lambda }_{B} \cdot \left(1-{P}_{\varepsilon }\right) \cdot \varepsilon $$ (3) 式中:Pε为光纤的弹光系数。
-
根据分析,应变与施加在操作器末端的力成正比[18],如下所示:
$$\varepsilon = \frac{M}{{EI}}r = \frac{{{F_t}d}}{{EI}}r$$ (4) 式中:ε是FBG传感器的局部应变;M是由施加力Ft引起的弯矩;d是操作器末端与FBG之间的距离;E是杨氏模量;I是惯性矩;r是弯曲的中轴与FBG之间的径向距离。
FBG传感器的布拉格波长漂移线性依赖于局部应变和温度变化:
$$\Delta \lambda = {k_\varepsilon }\varepsilon + {k_{\Delta T}}\Delta T$$ (5) 式中:Δλ表示布拉格波长位移;ε表示局部应变;ΔT表示温度变换;kε、kΔT均为应变常系数。为了消除三个传感器因为温度变化和轴向力而引起的共模,利用减去布拉格平均值来解决,处理后的差模信号再通过线性公式来表示求得,其计算过程下所示:
$$\Delta {s_i} = \Delta {\lambda _i} - \Delta \overline \lambda $$ (6) $${F_{x,y}} = \left[ {{F_x},{F_y}} \right] = {K_{x,y}}\Delta {S_{x,y}}$$ (7) 式中:Δλ表示布拉格波长位移;
$\Delta {\rm{\bar \lambda }}$ 为三根光纤波长漂移量的平均值。 -
由于操作器末端的光纤光栅波长漂移量不仅仅受轴向力的影响,还有部分横向力会使得测量数据存在一定的线性偏差,文中通过采用非线性拟合的方法来对轴向力的计算进行补偿,其全局轴向力计算过程如下。
线性模型—轴向力与应变之间的线性关系为:
$${F_{{\textit{z}}}}{\rm{ = }}{K_{{\textit{z}}}}\Delta \varLambda $$ (8) 式中:Fz是操作器末端的轴向力;Kz是轴向应变系数;Δλ为光纤光栅的波长漂移量。因为末端受力轴向力感知分量大于横向力感知分量,在局部呈现线性关系,而在全局存在非线性偏差,所以采用伯恩斯坦多项式来对全局轴向力进行估计,进行非线性补偿:
$${F_{{\textit{z}}}}{\rm{ = }}\sum\limits_{{i = 0}}^{n} {\sum\limits_{{j = 0}}^{n} {\sum\limits_{{k = 0}}^{n} {{c_{{ijk}}}{b_{(i,n)}}(\Delta \lambda _{\rm{1}}^{\rm{*}})} } } {b_{(j,n)}}(\Delta \lambda _2^*){b_{(k,n)}}(\Delta \lambda _3^*)$$ (9) 式中:Fz为估计的轴向力;n为伯恩斯坦多项式得阶数;Cijk为常系数;Δλ1*、Δλ2*、Δλ3*为被缩放到[0,1]区间得光纤光栅波长漂移量。其求解公式如下:
$$\Delta \lambda _i^* = \frac{{\Delta {\lambda _i} - \Delta {\lambda _{i,\min }}}}{{\Delta {\lambda _{i,\max }} - \Delta {\lambda _{i,\min }}}}$$ (10) 而bv,n则是i为1,2,3时的伯恩斯坦多项式,其定义如下:
$${b_{v,n}}(\Delta \lambda _i^*) = \left( \begin{array}{l} n\\ v \end{array} \right)\Delta \lambda _u^{{\rm{*v}}}{(1 - \Delta \lambda _i^*)^{n - v}}$$ (11) 伯恩斯坦多项式在区间[0,1]上表现出良好的数值稳定性,并且使用二阶多项式来避免过拟合。标定时应用已知的各向力,利用多项式插值得到轴向力的估计。可以用最小二乘法计算出轴向力的系数,从而得到轴向力的全局估计值。
-
软体操作器末端力测量的工作技术方案主要包含两个部分:植入光纤光栅的软体操作器控制与测量以及六维力传感器标定。其中植入了光纤光栅传感器的软体机器人的驱动系统主要是由气路控制系统组成,通过压缩机、分离器以及汇流排形成气压,再通过控制器控制电磁阀比例阀来调节气压的大小,给软体操作器充入或抽取不同大小的气压,让软体操作器达到不同的姿态,然后在不同状态下通过六维力传感器感知施加到软体操作器末端的精准三维力数据,通过光谱仪的解调得到光纤光栅的波长漂移量变化,分析和标定软体操作器末端力与波长漂移量之间的关系,整体工作的流程图如图3所示。
测量及标定实验系统主要包含的气路控制部分:其充气气压控制范围在0~10 MPa,可以保证软体操作器达到实验所需的不同姿态;光纤光栅解调部分:包含光源,光纤光栅,耦合器以及光谱仪,可以通过测量实验过程中光纤光栅的波长漂移量来用于分析处理;六维力传感器部分:传感量程在0~50 N,传感精度为0.1 mN,可以精确的测量到软体操作器末端受力,用于标定;PC上位机部分:用于控制PLC系统改变气压值以及记录六维力传感器的测量数据,在实验过程中通过记录光纤光栅的波长变化情况,得到不同位置下三种光纤光栅传感器的波长漂移量、六维力传感器的精确数据用于分析处理及标定验证,其实验系统如图4所示。
-
软体操作器在充入气压时,角度与充入气压在0.3~0.4 MPa区间,充入气压的大小与软体操作器弯曲角度呈现良好的线性关系,选取0.3~0.4 MPa气压区间对软体操作器以0.01 MPa的变化充入气压,在不同的气压大小下利用六维力传感器和位移平台对软体操作器末端施加0~10 mN的力,施压间隔为1 mN,通过六维力传感器的值可以获得当前作用在传感器上的外力值,此时FBG的波长变化同时也可以从光线解调仪中读出,从上述的10组数据求取平均值,分别记录了不同受力下三根光纤中光栅的波长漂移与操作器末端受力,如表2所示,数据的拟合直线如图5所示,由此可以看出计算模型中光纤光栅波长漂移量的变化与末端受力呈线性关系。对于每个子集,计算了布拉格波长位移的平均值和剩余误差。然后结合所有子集的残差计算每个FBG传感器的标准偏差,作为重复性的衡量。其三根光纤的波长漂移量的剩余误差的概率分布如图6所示,传感器FBG1、FBG2、FBG3的标准差分别为1.68、1.39、1.40 pm,而光谱仪的波长可重复性为1 pm,波长稳定性通常为2 pm,最大不超过5 pm,三个光栅的波长漂移量误差都小于2 pm,说明力传感器具有可靠的重复性,与光谱仪的固有光学特性是一致的。
表 2 软体操作器末端受力与三根光栅波长漂移量部分取值
Table 2. Forces at the end of the software operator and the wavelength drift of the three gratings were partly determined
Force at the end
of the software operator
F/mNFBG1 wavelength
shift quantity
Δλ1/pmFBG2 wavelength
shift quantity
Δλ2/pmFBG3 wavelength
shift quantity
Δλ3/pm1 50 −61 19 2 97 −118 39 3 138 −168 57 4 187 −226 76 5 232 −287 96 6 292 −348 115 7 338 −401 132 8 382 −471 151 9 432 −526 166 10 478 −577 175 -
(1)横向力的线性标定与精度验证
利用六维力传感器的精确测量值来对软体操作器末端力进行线性标定。从解调仪获得的原始数据经过差分模式处理,可以利用最小二乘回归算法分别求解得到矩阵系数Kx,y:
$${K_{{x,y}}} = \left[ {\begin{array}{*{20}{c}} {82.324}&{ - 43.068}&{ - 37.625} \\ { - 1.52}&{ - 88.684}&{91.608} \end{array}} \right]$$ 利用求解得到的矩阵系数与测量的FBG波长漂移量可以预测横向力,其通过将测量横向力与实际力进行线性拟合比对,根据理想的拟合情况在拟合后会产生一个斜率k=1并且通过原点的一条直线,得到的结果如图7所示,横向力Fx与Fy实际值与测量值的拟合直线基本达到拟合要求。图8显示了实际力与拟合产生的残差的对比。Fx与Fy的均方根误差分别为0.069 mN与0.066 mN,均小于满量程的5%,图9给出了Fx与Fy拟合残差的概率分布图,可以看出拟合产生的误差大都分布在−0.1~0.1 mN之间,有极少部分误差超过0.15 mN的现象,验证了实验数据的可靠重复性。但通过残差分布图可发现在施加压力为5~7 mN区间以及大于9 mN区间,出现了部分线性数据不好的数据样本,原因是受制于软体材料部分非线性特征的影响,未来改进方向上,考虑设计光纤夹具来减少软体材料非线性特征对力传感器的影响。
图 7 计算的横向力Fx(a)与Fy(b)与实际值的拟合直线
Figure 7. Calculated transverse force along X-axis Fx (a) and Y-axis Fy (b) versus the actual value using linear fitting
(2)轴向力的非线性校准与精度验证
从解调仪获得的原始数据经过差分模式处理,可以利用最小二乘回归算法分别求解得到矩阵系数Kz:
$${K_{\textit{z}}} = \left[ {\begin{array}{*{20}{c}} {89.748}&{ - 102.438}&{ - 145.658} \end{array}} \right]$$ 由于操作器末端的光纤光栅波长漂移量不仅受轴向力的影响,还有部分横向力会使得测量数据存在一定的线性偏差,所以轴向力二阶伯恩斯坦多项式的非线性校准为所有校准数据提供了一个有用的全局拟合,使得处理后的数据更全面、分布更广,如图10所示。残差的大小在测量力大小范围内保持的相当稳定,如图11所示,均方根误差为0.067 mN,小于满量程的5%,残差概率分布图如图12所示,拟合产生的误差大都分布在−0.1~0.1 mN之间,有少部分误差超过0.15 mN的现象,说明了实验的重复性和可靠性。通过对比横向力线性拟合残差图可以发现,采用伯恩斯坦非线性补偿算法有效的弥补了数据样本中部分线性度数据不好的部分,使得测量的结果更加精准可靠。
-
文中所提出的末端力测量方法,通过测量计算得到Fx与Fy的均方根误差分别为0.069 mN与0.066 mN,轴向力Fz的均方根误差为0.067 mN,均小于满量程的5%,Fx、Fy和Fz拟合残差的概率分布图显示产生的误差大都分布在−0.1~0.1 mN之间,有极少部分误差超过0.15 mN的现象,验证了实验数据的重复性和一致性。通过对采集的光纤光栅波长漂移量进行了剩余误差的求解和概率分布计算,传感器FBG1、FBG2、FBG3的标准差分别为1.68、1.39、1.40 pm,而光谱仪的波长可重复性为1 pm,波长稳定性通常为2 pm,最大不超过5 pm,三个光栅的波长漂移量误差都小于2 pm,与光谱仪的固有光学特性是一致的,具有良好的可靠性。
Research on end force measurement method of soft robot based on fiber Bragg grating
-
摘要: 手术机器人的末端操作力测量是实现机器人精准控制的关键,对保证手术操作的安全性至关重要。文中针对微创手术软体机器人末端三维力测量的实际需求,提出一种基于光纤光栅的微创软体机器人末端三维力的测量方法。基于光纤光栅传感原理,分析光纤传感器植入在软体机器人中的传感特性,建立基于最小二乘法线性标定和基于伯恩斯坦多项式非线性补偿的软体机器人末端力解耦模型,研究光纤光栅中心波长漂移量和软体机器人末端三维力之间的关系。并通过实验测试和对比分析验证了基于线性标定和非线性解耦算法的光纤传感软体机器人末端力测量性能研究结果表明:光纤光栅传感的可重复性平均为1.5 pm,末端力在XYZ三个方向上的测量精度误差均低于满量程的5%,且残差分布大部分集中在可靠区间,具有良好的重复性。所提出的基于光纤光栅的软体机器人末端力解耦算法为微创手术软体机器人的末端力精确测量提供了有效的方法,在生物医学等软体机器人的末端力测量中具有应用前景。Abstract: The measurement of the terminal operating force of the surgical robot is the key to achieve the precise control of the robot, which is crucial to ensure the safety of the surgical operation. In this paper, a method of measuring the three-dimensional force of soft robot terminal end based on fiber Bragg grating was proposed to meet the requirement of minimally invasive surgery. Based on the principle of fiber grating sensing, the sensing characteristics of fiber sensor embedded in soft robot were analyzed and a soft robot terminal force decoupling model based on linear calibration with least square method and nonlinear compensation with Bernstein polynomial was established. Then the relationship between the central wavelength shift of the fiber Bragg grating and the three-dimensional force at the end of the soft robot was studied. The results show that the average repeatability of FBG sensor is 1.5 pm. The measurement accuracy error of the end force in the three directions of XYZ is lower than 5% of the full range, and the residual distribution is mostly concentrated in the reliable range, with good repeatability. The proposed FBG decoupling algorithm provides an effective method for the precise measurement of the terminal force of soft robot in minimally invasive surgery, and has a promising application prospect in the measurement of the terminal force of soft robot in biomedicine.
-
Key words:
- fiber Bragg grating /
- force sensor /
- soft robot
-
表 1 三维力传感器设计要求
Table 1. Design requirements of 3D force sensor
Size Degree of freedom Range Precision Diameter not
exceeding 20 mmThe three dimensional force is
in the XYZ direction0-10 mN along
the XYZ directionAll were less than
5% full scale表 2 软体操作器末端受力与三根光栅波长漂移量部分取值
Table 2. Forces at the end of the software operator and the wavelength drift of the three gratings were partly determined
Force at the end
of the software operator
F/mNFBG1 wavelength
shift quantity
Δλ1/pmFBG2 wavelength
shift quantity
Δλ2/pmFBG3 wavelength
shift quantity
Δλ3/pm1 50 −61 19 2 97 −118 39 3 138 −168 57 4 187 −226 76 5 232 −287 96 6 292 −348 115 7 338 −401 132 8 382 −471 151 9 432 −526 166 10 478 −577 175 -
[1] 高长青. 机器人外科学[M]. 北京: 人民卫生出版社, 2015: 279-301 [2] Fu Yili, Pan Bo. Research progress of surgical robot for minimally invasive surgery [J]. Journal of Harbin Institute of Technology, 2019, 51(1): 1-15. (in Chinese) doi: 10.11918/j.issn.0367-6234.201806178 [3] J Payne C, Wamala I, Bautista-Salinas D, et al. Soft robotic ventricular assist device with septal bracing for therapy of heart failure [J]. Science Robotics, 2017, 2(12): eaan6736. doi: 10.1126/scirobotics.aan6736 [4] Yan Jihong, Shi Peipei, Zhang Xinbin, et al. Review of biomimetic mechanism, actuation, modeling and control in soft manipulators [J]. Journal of Mechanical Engineering, 2018, 54(15): 1-14. (in Chinese) doi: 10.3901/JME.2018.15.001 [5] De Falco I, Cianchetti M, Menciassi A. A soft multi-module manipulator with variable stiffness for minimally invasive surgery [J]. Bioinspiration & Biomimetics, 2017, 12(5): 056008. doi: 10.1088/1748-3190/aa7ccd [6] Hu W, Lum G Z, Mastrangeli M, et al. Small-scale soft-bodied robot with multimodal locomotion [J]. Nature, 2018, 554: 81-85. doi: 10.1038/nature25443 [7] Laschi C, Mazzolai B, Cianchetti M. Soft robotics: Technologies and systems pushing the boundaries of robot abilities [J]. Science Robotics, 2016, 1(1): eaah3690. doi: 10.1126/scirobotics.aah3690 [8] Zhang X. Silicon microsurgery-force sensor based on diffractive optical MEMS encoders [J]. Sensor Review, 2004, 24(1): 37-41. doi: 10.1108/02602280410515806 [9] Peirs J, Clijnen J, Reynaerts D, et al. A micro optical force sensor for force feedback during minimally invasive robotic surgery [J]. Sensors and Actuators A: Physical, 2004, 115(2–3): 447-455. [10] Yokoyama K, Nakagawa H, Shah D C, et al. Novel contact force sensor incorporated in irrigated radiofrequency ablation catheter predicts lesion size and incidence of steam pop and thrombus [J]. Circ: Arrhythm & Electrophysiol, 2008, 1(5): 354-362. [11] Kesner S B, Howe R D. Force control of flexible catheter robots for beating heart surgery[C]//Proc IEEE Int Conf Robot Autom, 2011: 1589-1594. [12] He X, Gehlbach P, Handa J, et al. Development of a miniaturized 3-DOF force sensing instrument for robotically assisted retinal microsurgery and preliminary results[C]//5th IEEE RAS and EMBS International Conference on Biomedical Robotics and Biomechatronics, 2014: 252-258. [13] Bell B, Stankowski S, Moser B, et al. Integrating optical fiber force sensors into microforceps for ORL microsurgery[C]//2010 Annual International Conference of the IEEE Engineering in Medicine and Biology, 2010: 1848–1851. [14] Thuruthel T G, Shih B, Laschi C, et al. Soft robot perception using embedded soft sensors and recurrent neural networks [J]. Science Robotics, 2019, 4(26): eaav1488. doi: 10.1126/scirobotics.aav1488 [15] Rocha R P, Lopes P A, Almeida A T D, et al. Fabrication and characterization of bending and pressure sensors for a soft prosthetic hand [J]. Journal of Micromechanics and Microengineering, 2018, 28(3): 034001. [16] Lucarotti C, Totaro M, Sadeghi A, et al. Revealing bending and force in a soft body through a plant root inspired approach [J]. Scientific Reports, 2015, 5(1): 8788. [17] Gupta P, Jensen P, De Juan E. Surgical forces and tactile perception during retinal microsurgery [J]. MICCAI, 1999, 1679: 1218-1225. [18] Iordachita I, Sun Z, Balicki M, et al. A sub-millimetric, 0.25 mN resolution fully integrated fiber-optic force-sensing tool for retinal microsurgery [J]. International Journal of Computer Assisted Radiology and Surgery, 2009, 4(4): 383-390.