基于多项式拟合的六维力传感器解耦算法研究

doi:10.3785/j.issn.1006-754X.2023.00.063

工程设计学报

2023, Vol. 30

Issue (5): 571-578 DOI: 10.3785/j.issn.1006-754X.2023.00.063

机械设计理论与方法

基于多项式拟合的六维力传感器解耦算法研究

王志军(

),张小涛,李梦祥

华北理工大学机械工程学院，河北唐山 063210

Research on decoupling algorithm of six-dimensional force sensor based on polynomial fitting

Zhijun WANG(

),Xiaotao ZHANG,Mengxiang LI

College of Mechanical Engineering, North China University of Science and Technology, Tangshan 063210, China

全文: PDF(1578 KB) HTML

摘要：

六维力传感器作为重要的空间力感知元件，被广泛应用于机器人的力/位置控制、抓取装配、轮廓检测、自主避障和人机交互等。目前，提高精度是六维力传感器的主要研究方向之一。但由于受到自身结构和加工误差等因素的影响，六维力传感器会产生维间耦合现象，而维间耦合是影响其精度的重要因素。为减少耦合误差的影响，采用误差分析、理论推导及实验验证相结合的方法对六维力传感器的解耦算法进行研究。首先，对六维力传感器进行了耦合分析，得到其耦合模型。然后，对六维力传感器的线性解耦算法进行研究，并在此基础上提出了基于多项式拟合的解耦算法，以在不改变六维力传感器结构的前提下减小耦合误差，从而提高其精度。最后，选用正交并联六维力传感器开展标定实验，并分别采用2种算法进行解耦求解。结果表明，基于多项式拟合的解耦算法能减小维间耦合对六维力传感器精度的影响；所提出的解耦算法有效地提高了六维力传感器的精度，与线性解耦算法相比，最大耦合误差减小了8.914个百分点且线性度误差减小了0.111个百分点。研究结果可为六维力传感器维间耦合误差的减小和精度的提高提供参考。

关键词： 六维力传感器; 耦合模型; 解耦算法; 多项式拟合; 标定实验; 解耦求解

Abstract:

As an important spatial force sensing element, the six-dimensional force sensor is widely used in robot force/position control, grasping assembly, contour detection, autonomous obstacle avoidance and human-computer interaction. At present, improving the accuracy is one of the main research directions of six-dimensional force sensors. However, due to the influence of own structure and processing error and other factors, the six-dimensional force sensor will produce the interdimensional coupling phenomenon, and the interdimensional coupling is an important factor affecting its accuracy. In order to reduce the influence of coupling error, the decoupling algorithm of six-dimensional force sensor is studied by combining error analysis, theoretical derivation and experimental verification. Firstly, the coupling analysis of the six-dimensional force sensor was carried out, and its coupling model was obtained. Then, the linear decoupling algorithm of the six-dimensional force sensor was studied, and on this basis, the decoupling algorithm based on polynomial fitting was proposed to reduce the coupling error without changing the structure of the six-dimensional force sensor, so as to improve its accuracy. Finally, the orthogonal parallel six-dimensional force sensor was selected to carry out calibration experiments, and two algorithms were used for decoupling solution. The results showed that the decoupling algorithm based on polynomial fitting could reduce the influence of interdimensional coupling on the accuracy of six-dimensional force sensors. The proposed decoupling algorithm effectively improved the accuracy of the six-dimensional force sensor. Compared with the linear decoupling algorithm, the maximum coupling error was reduced by 8.914 percentage points and the linearity error was reduced by 0.111 percentage points. The research results can provide reference for reducing the coupling error and improving the accuracy of six-dimensional force sensors.

Key words: six-dimensional force sensor coupling model decoupling algorithm polynomial fitting calibration experiment decoupling solution

收稿日期: 2023-02-27 出版日期: 2023-11-03

CLC:

TP 212

基金资助: 河北省高等学校科学技术研究项目(ZD2020151);唐山市科技创新团队培养计划资助项目(21130208D)

作者简介: 王志军（1983—），男，河北唐山人，教授，博士，从事并联机器人及六维力传感器技术研究，E-mail: zjwang@ncst.edu.cn，https://orcid.org/0000-0003-3316-4821

	服务
	把本文推荐给朋友
	加入引用管理器
	E-mail Alert
	RSS
	作者相关文章
	王志军
	张小涛
	李梦祥

引用本文:

王志军,张小涛,李梦祥. 基于多项式拟合的六维力传感器解耦算法研究[J]. 工程设计学报, 2023, 30(5): 571-578.

Zhijun WANG,Xiaotao ZHANG,Mengxiang LI. Research on decoupling algorithm of six-dimensional force sensor based on polynomial fitting[J]. Chinese Journal of Engineering Design, 2023, 30(5): 571-578.

链接本文:

https://www.zjujournals.com/gcsjxb/CN/10.3785/j.issn.1006-754X.2023.00.063 或 https://www.zjujournals.com/gcsjxb/CN/Y2023/V30/I5/571

图1 十字梁结构六维力传感器

图2 Stewart并联结构六维力传感器

图3 六维力传感器的输入-输出耦合模型

图4 正交并联六维力传感器

序号	$F s x / N$	$F c x / N$	$F c y / N$	$F c z / N$	$M c x / (N · m)$	$M c y / (N · m)$	$M c z / (N · m)$
1	10	9.958 4	-0.039 4	0.121 5	-0.005 5	0.014 9	0.014 6
2	20	19.820 2	-0.052 3	0.011 8	-0.012 5	0.031 2	0.030 8
3	30	29.823 4	-0.068 0	-0.106 4	-0.018 9	0.044 6	0.046 7
4	40	39.645 4	-0.121 6	-0.158 9	-0.027 7	0.0553	0.060 1
5	50	49.706 9	-0.159 7	-0.219 7	-0.030 5	0.051 7	0.067 4
6	60	59.837 8	-0.169 5	-0.251 1	-0.032 0	0.055 0	0.068 1
7	70	69.804 1	-0.234 3	-0.398 5	-0.043 3	0.061 7	0.071 2
8	80	79.827 2	-0.304 9	-0.483 5	-0.058 7	0.059 1	0.071 7
9	90	89.772 3	-0.356 8	-0.553 9	-0.060 2	0.049 0	0.069 5
10	100	99.784 8	-0.417 5	-0.725 5	-0.080 7	0.038 3	0.068 2

表1 不同Fsx下正交并联六维力传感器的标定实验结果

图5 Fcy与Fsx的耦合关系

图6 Fcz与Fsx的耦合关系

图7 Mcx与Fsx的耦合关系

图8 Mcy与Fsx的耦合关系

图9 Mcz与Fsx的耦合关系

图10 Fcx与Fsy的耦合关系

图11 Fcz与Fsy的耦合关系

图12 Mcx与Fsy的耦合关系

图13 Mcy与Fsy的耦合关系

图14 Mcz与Fsy的耦合关系

解耦方法	误差	$F x$	$F y$	$F z$	$M x$	$M y$	$M z$
线性解耦	线性度误差	0.417	0.925	3.095	0.144	0.084	0.226
线性解耦	最大耦合误差	2.509	1.599	9.867	0.546	0.243	0.313
多项式拟合解耦	线性度误差	0.403	0.904	2.984	0.108	0.076	0.189
多项式拟合解耦	最大耦合误差	1.340	0.472	0.953	0.055	0.059	0.042

表2 不同解耦算法的误差分析结果对比 (%)

1	刘晓宇，盖广洪.Stewart六维力传感器解耦算法优化［J］.传感技术学报，2018，31（12）：1858-1861，1868. doi：10.3969/j.issn.1004-1699.2018.012.014 LIU X Y， GAI G H. Optimization of Stewart six-dimensional force sensor decoupling algorithm［J］. Chinese Journal of Sensors and Actuators， 2018， 31（12）： 1858-1861， 1868. doi: 10.3969/j.issn.1004-1699.2018.012.014
2	PALLI G， MORIELLO L， SCARCIA U， et al. Development of an optoelectronic 6-axis force/torque sensor for robotic applications［J］. Sensors & Actuators A： Physical， 2014， 220： 333-346.
3	CIRILLO A， CIRILLO P， DE MARIA G， et al. Control of linear and rotational slippage based on six-axis force/tactile sensor［C］//IEEE International Conference on Robotics & Automation （ICRA）， Singapore， May 29-Jun. 3， 2017.
4	OZAWA R， ARIMOTO S， YOSHIDA M， et al. Stable grasping and relative angle control of an object by dual finger robots without object sensing［C］//IEEE International Conference on Robotics and Automation， New Orleans， LA， Apr. 26-May 1， 2004.
5	贺德建，张鸿海，刘胜，等.一种用于MEMS检测的无耦合六维力传感器的研制［J］.微纳电子技术，2003（Z1）：503-505，511. doi：10.3969/j.issn.1671-4776.2003.07.148 HE D J， ZHANG H H， LIU S， et al. Six-axis force/torque sensor for micro-testing system for MEMS［J］. Micronanoelectronic Technology， 2003（Z1）： 503-505， 511. doi: 10.3969/j.issn.1671-4776.2003.07.148
6	王晨，高波，杨旭.Stewart式六维力传感器轻量化设计［J］.工程设计学报，2022，29（4）：419-429. doi：10.3785/j.issn.1006-754X.2022.00.058 WANG C， GAO B， YANG X. Lightweight design of Stewart type six-axis force sensor［J］. Chinese Journal of Engineering Design， 2022， 29（4）： 419-429. doi: 10.3785/j.issn.1006-754X.2022.00.058
7	曹会彬，孙玉香，刘利民，等.多维力传感器耦合分析及解耦方法的研究［J］.传感技术学报，2011，24（8）：1136-1140. doi：10.3969/j.issn.1004-1699.2011.08.011 CAO H B， SUN Y X， LIU L M， et al. Coupling analysis of multi-axis force sensor and research of decoupling method［J］. Chinese Journal of Sensors and Actuators， 2011， 24（8）： 1136-1140. doi: 10.3969/j.issn.1004-1699.2011.08.011
8	LIANG Q， DAN Z， SONG Q， et al. Design and fabrication of a six-dimensional wrist force/torque sensor based on E-type membranes compared to cross beams［J］. Measurement， 2010， 43（10）： 1702-1719.
9	SUN Y J， LIU Y W， ZOU T， et al. Design and optimization of a novel six-axis force/torque sensor for space robot［J］. Measurement， 2015， 65： 135-148.
10	MERLET J P. Parallel robots［M］. 2nd ed. Berlin： Springer， 2006： 265-266.
11	LIANG Q K， ZHANG D， CHI Z Z， et al. Six-DOF micro-manipulator based on compliant parallel mechanism with integrated force sensor［J］. Robotics and Computer-Integrated Manufacturing， 2011， 27（1）： 124-134.
12	姚建涛，李立建，许允斗，等.并联结构六维力传感器及其超静定静力映射解析分析［J］.工程力学，2014，31（10）：205-211. doi：10.6052/j.issn.1000-4750.2013.04.0336 YAO J T， LI L J， XU Y D， et al. Redundant-parallel structure six-axis force sensor and hyperstatic static mapping analytical analysis［J］. Engineering Mechanics， 2014， 31（10）： 205-211. doi: 10.6052/j.issn.1000-4750.2013.04.0336
13	LIANG Q K， CHENG L K， LONG J Y， et al. A force/position measurement method of surgical forceps based on fiber Bragg gratings［J］. IEEE Sensors Journal， 2023， 23（1）： 363-373.
14	韩康，王智，李昂，等.大量程六维力传感器设计与标定研究［J］.传感器与微系统，2016，35（5）：87-90. doi：10.13873/J.1000-9787(2016)05-0087-04 HAN K， WANG Z， LI A， et al. Design of big-scale six-axis force sensor and study on calibration test［J］. Transducer and Microsystem Technologies， 2016， 35（5）： 87-90. doi: 10.13873/J.1000-9787(2016)05-0087-04
15	刘琬钰，王志军，田雪珂，等.基于时间函数的并联六维力传感器量程设计［J］.传感器与微系统，2016，35（8）：80-83. LIU W Y， WANG Z J， TIAN X K， et al. Design of parallel six-axis force sensor measuring range based on time function［J］. Transducer and Microsystem Technologies， 2016， 35（8）： 80-83.

[1]	王晨,高波,杨旭. Stewart式六维力传感器轻量化设计[J]. 工程设计学报, 2022, 29(4): 419-429.
[2]	王学军,普江华,陈明方. 自动化生产线用同步带传动升降机的动态特性分析[J]. 工程设计学报, 2022, 29(2): 212-219.
[3]	吴垚, 曹巨江, 刘言松, 燕卫亮. 曲柄群驱动机构刚柔耦合的动平衡研究[J]. 工程设计学报, 2016, 23(5): 468-480.
[4]	刘亚东, 杨忠炯, 周立强, 胥景. 湿喷机机械臂喷枪振动特性的研究[J]. 工程设计学报, 2013, 20(4): 303-308.

Viewed

Full text

Abstract

Cited

Shared

Discussed