1.本发明涉及一种三维力测量装置和方法,基于具体是叶草涉及了一种利用四叶草式光纤结阵列实现解耦的装置和方法,并展示一项该方案在机器人指尖三维力测量中的式光实例
。
背景技术:
2.力触觉感知,纤结特别是阵列置和摩擦力测量,在机器人灵巧操作中起着至关重要的力解量装流程作用
。
大量基于电学
、耦测
磁学和光学原理的基于柔性触觉传感器已被成功用于机器人应用中
。
其中,叶草光纤传感器具备显著优势和特点,式光如多模态
、纤结
分布式传感特性,阵列置和以及抗电磁干扰和耐腐蚀的力解量装流程能力
。
3.光纤结传感器为一种新型光纤传感器,耦测其核心部件为一个由聚合物光纤打结形成的基于光纤结
。
光纤结中光纤与自身交错,容易因外力产生弯曲损耗,导致光透过率下降,因此光纤结传感器适合用于压力测量
。
然而,单个光纤结传感器难以测量摩擦力
。
4.能够同时测量法向力和切向力的传感器被称为三维力传感器
。
三维力传感器常被安装在机械臂的关节处,用于碰撞检测
、
柔顺控制等场景,或安装在机械手指末端,用于测量抓取过程中指尖的压力和摩擦力
。
现有三维力传感器由于结构复杂或材料特性,都存在一定程度的维间耦合或非线性特征,使得三维力解耦存在一定困难,体现在标定工作量大
、
解耦算法复杂
、
解耦精度欠佳等方面
。
技术实现要素:
5.为解决背景技术中存在的问题,本发明的目的是针对机器人指尖三维力测量,提供一种利用四叶草式光纤结阵列的测量装置和实现解耦的方法
。
本发明无需借助解耦算法进行测量,具有无维间耦合
、
与机械手集成度高
、
制备简易
、
鲁棒性好
、
可同时测量压力和摩擦力的特点
。
6.本发明的技术方案是:一
、
一种基于四叶草式光纤结阵列的三维力解耦测量装置:包括用于组成三维力测量核心元件的五个光纤结传感器,其中四个光纤结传感器等距地分布在一个圆周上,且在圆周的圆心处设置第五个光纤结传感器,形成四叶草式阵列布局
。
7.所述的五个光纤结传感器分别用于测量-
x、
+
x、
-
y、
+
y、
+z方向的分力-
fx、
+
fx、
-
fy、
+
fy、
+
fz。
8.所述的五个光纤结传感器被封装在金属壳体中并通过滑块隔离,所述的滑块为刚性结构和材料,其中四个光纤结传感器和滑块之间均通过各自不同的压柱进行连接,第五个光纤结传感器放置于滑块内部,外力的分力通过不同的压柱传导到各个不同的光纤结传感器上,实现三维力解耦测量
。
9.所述的三维力测量核心元件包括五个光纤结传感器和金属壳体;所述的金属壳体包括用于容纳光纤结传感器的第一容器
、
滑块
、
盖子和底盘,滑块布置在第一容器的中心且能够沿垂直于第五个光纤结传感器所检测力的方向滑动,第一容
器内在滑块周围四面处沿周向等间距布置四个光纤结传感器,滑块内部设置有中心通道,中心通道内布置有第五个光纤结传感器,滑块底部和用于滑块的底盘滚动连接,第一容器上端封盖设有用于封盖住滑块周围四边处的四个光纤结传感器的盖子
。
10.具体实施中,中心通道内部设有台阶,第五个光纤结传感器下端置于且支撑于台阶上
。
11.所述的底盘包括从上到下依次层叠的底盘上盖
、
滚珠和底盘底板,底盘上盖上开设有多个用于滚珠穿设过的孔槽,底盘底板之上布置有多个滚珠,滚珠向上穿过底盘上盖上的孔槽后露出并和滑块底面滚动连接,使得滑块底部和支撑底盘滚动连接
。
12.所述的三维力测量核心元件安装在机械手指板件中,且在机械手指板件上端布置受力组件,受力组件伸入到三维力测量核心元件中和第五个光纤结传感器接触连接;外力
xy
方向的分力经受力组件
、
滑块和压柱传递到其中四个光纤结传感器上,外力在z方向的分力经受力组件传递到第五个光纤结传感器上
。
13.同时机械手指板件侧部固定于机械手上,机械手可以为两指机械手
500
,机械手指板件下端套装在用于容纳光纤尾纤的第二容器中
。
14.所述的受力组件包括从上到下依次层叠布置的橡胶垫
、
受力板
、
顶盖和三维力压柱,三维力压柱下端面设有中心的凸起杆,凸起杆穿过金属壳体的盖子伸入到滑块的中心通道中和第五个光纤结传感器的顶端面接触连接, 外力在z方向的分力经受力组件的橡胶垫
、
受力板
、
顶盖和三维力压柱依次传递后,最终经三维力压柱传递到第五个光纤结传感器上
。
15.第一容器内,滑块周围四面处的四个光纤结传感器分别和滑块周围四面之间均设置有一个压柱,使得每个光纤结传感器均经各自的一个压柱和滑块周围一侧面接触连接
。
16.具体实施中,四个光纤结传感器对应的压柱嵌装在盖子底部侧面的孔内
。
盖子底部设置环形凸起,环形凸起四周设置四个孔,压柱水平安装在孔中
。
17.外力在
xy
方向的分力经受力组件
、
滑块和压柱传递到其中四个光纤结传感器上,四个光纤结传感器被各自的压柱支撑压到滑块上,实现刚性接触
。
18.每个光纤结传感器包括一个光纤结和一个硅胶立方块,光纤结被封装在硅胶立方块中形成光纤结块,且位于硅胶立方块对称的中心截面上,且光纤结与硅胶立方块的顶面
、
底面
、
左右两侧面均相切;各个光纤结传感器的光纤结块以四叶草式阵列布局
。
19.每个光纤结传感器中,光纤结的两端尾纤从硅胶立方块穿出后和检测组件电连接,所述的检测组件包括发光二极管和光电二极管,光纤结的两端向下从硅胶立方块穿出后分别和发光二极管和光电二极管电连接,且发光二极管和光电二极管均布置在遮光夹具中
。
20.硅胶立方块采用硅胶制成
。
21.发光二极管和光电二极管电连接到电路板,由发光二极管发出的光在光纤结传感器中传输,最终由光电二极管接收并转换为电流,电路板向发光二极管提供恒定电流,同时收集光电二极管产生的电流并转换为电压输出
。
22.所述的第二容器侧壁开设用于光纤结传感器的光纤尾纤穿设过的通孔,通孔处布置用于光纤尾纤穿设过且进行保护的光纤保护套
。
光纤结两端的光纤尾纤依次从通孔和光纤保护套穿过后和机械手上的检测组件连接
。
23.各个光纤结传感器所连接的检测组件的发光二极管布置在一起组成发光二极管阵列,各个光纤结传感器所连接的检测组件的光电二极管布置在一起组成光电二极管阵列,发光二极管阵列和光电二极管阵列均布置在电路板上,电路板向发光二极管阵列提供恒定电流,同时收集光电二极管阵列产生的电流并转换为电压输出
。
24.电路板和计算机电连接,计算机又和两指机械手电连接,用于控制两指机械手的运动
。
25.二
、
基于三维力解耦测量装置的三维力解耦测量方法:水平面上建立两个相互正交的方向作为
x
方向和y方向在三维力解耦测量装置的水平面上建立三个相互正交的方向作为
xyz
方向,以三维力解耦测量装置的上下方向作为z方向,在垂直于z方向的平面上建立两个相互正交的方向作为z方向和y方向
。
26.外力
xy
方向的分力经受力组件
、
滑块和压柱传递到其中四个光纤结传感器上,外力在z方向的分力经受力组件传递到第五个光纤结传感器上;对于每个光纤结传感器,当压力加载在光纤结传感器的顶面
、
左侧面或右侧面时,光纤结传感器内的硅胶立方块发生形变并带动光纤结产生形变,使得光纤结产生弯曲损耗,使得经过光纤结的光透过率降低,进而使得从发光二极管发出经过光纤结被光电二极管接收的光强降低,从而光电二极管输出的电流以及转化输出的电压值降低;电路板向发光二极管提供恒定电流,同时收集光电二极管产生的电流并转换为电压输出;通过标定每个光纤结传感器对各自所测量分力和输出电压之间关系,根据标定的函数关系对待测情况所检测的输出电压处理获得直接的测量分力,而无需借助解耦算法,即可获得三维力传感器的“电压-力”转换关系
。
27.本发明通过上述整体结构设置,使得五个光纤结传感器被刚性的滑块结构巧妙隔离在不同的方位位置,相互互不干涉影响,能够各自独立测量力,从而无需解耦计算和处理,进行直接的力测量
。
28.本发明包括五个由硅胶立方块包裹聚合物光纤结制成的光纤结传感器;按照四叶草式布局,五个光纤结传感器被封装在金属壳体中,分别测量指向-
x、
+
x、
-
y、+y、+z
方向的分力,从而消除三维力测量中的维间耦合
。
具体将这五个光纤结传感器按照四叶草式布局封装在金属壳体中,通过压柱和滑块将外力的分力分别传导到每个光纤结传感器上,实现三维力测量
。
29.光纤结传感器为硅胶包裹的光纤结
。
光纤结由聚合物光纤打结形成
。
硅胶呈立方体块状
。
结位于硅胶块的一个对称面上
。
硅胶仅包裹光纤成结的部分,不包裹尾纤
。
尾纤指从结中延伸出的光纤段
。
30.光纤结传感器的两端分别连接发光二极管和光电二极管,由发光二极管发出的光在光纤结传感器中传输,最终由光电二极管接收并转换为电流
。
电路板向发光二极管提供恒定电流,同时收集光电二极管产生的电流并转换为电压输出
。
31.光纤结传感器受压力作用后,光纤结产生弯曲损耗,光透过率下降,电路板输出的电压值减小
。
32.通过分别标定每个光纤结传感器对各自所测量分力的响应,获得受力大小与输出电压大小的函数关系,无需借助解耦算法,即可获得三维力传感器的“电压-力”转换关系
。
33.与现有技术相比,本发明的有益效果是:(1)五个方向(-
x、
+
x、
-
y、+y、+z
)的分
力分别由五个光纤结传感器测量,消除了维间耦合,避免了解耦算法,降低了三维力求解难度和标定工作量
。
34.(2)通过调节光纤结的大小
、
硅胶硬度
、
压柱尺寸可以对传感器的灵敏度
、
工作范围等传感性能进行调整
。
35.(3)光纤结和硅胶的制备工艺简单
、
成本低廉
。
本发明所涉及的三维力传感器的机械结构简单易加工
。
36.(4)本发明所涉及的三维力传感器基于光学原理工作,抗电磁干扰和布线串扰,不会产生漏电
、
短路等安全隐患,安全性较高
。
附图说明
37.图1是本发明中四叶草式光纤结阵列的布局示意图;图2是本发明中三维力传感核心组件的爆炸示意图;图3是本发明中三维力传感核心组件的外观示意图;图4是本发明中三维力传感核心组件的盖子的外观示意图;图5是本发明中三维力传感核心组件的底盘的爆炸示意图;图6是本发明中光纤结传感器的结构和连线示意图;图7是本发明中三维力传感器的爆炸示意图;图8是本发明中三维力传感器的受力组件的爆炸示意图;图9是本发明中三维力传感器沿对称面的剖面示意图;图
10
是本发明中三维力传感器沿对称面的局部剖面示意图;图
11
是本发明中三维力传感器安装在机械手上的照片;图
12
是本发明中三维力传感器与机械手进行通信的示意图;图
13
是本发明中三维力传感器受不同方向分力作用的典型信号图
。
38.图中:
101—1
号光纤结传感器,
102—2
号光纤结传感器,
103—3
号光纤结传感器,
104—4
号光纤结传感器,
105—5
号光纤结传感器,
111—
光纤结,
112—
硅胶立方块,
113—
发光二极管(
led
),
114—
光电二极管(
pd
),
115—
遮光夹具;
201—
挤压1号光纤结传感器的压柱,
202—
挤压2号光纤结传感器的压柱,
203—
挤压3号光纤结传感器的压柱,
204—
挤压4号光纤结传感器的压柱;
300—
三维力传感核心组件,
301—
光纤结传感器的第一容器,
302—
滑块,
303—
盖子,
310—
底盘,
311—
底盘上盖,
312—
滚珠,
313—
底盘底板;
400—
三维力传感器,
401—
机械手指板件,
402—
光纤尾纤的第二容器,
403—
光纤保护套,
410—
受力组件,
411—
橡胶垫,
412—
受力板,
413—
顶盖,
414—
三维力压柱;
500—
两指机械手,
501—led
阵列,
502—pd
阵列,
503—
电路板,
504—
计算机;
601—1
号光纤结传感器的时序信号,
602—2
号光纤结传感器的时序信号,
603—3
号光纤结传感器的时序信号,
604—4
号光纤结传感器的时序信号,
605—5
号光纤结传感器的时序信号
。
具体实施方式
39.下面结合附图和实施例对本发明进一步说明
。
40.如图
1-图3所示,五个光纤结传感器
101、102、103、104、105
组成了三维力传感核心组件
300
的核心传感元件
。
41.其中,四个光纤结传感器
101、102、103、104
放置于圆柱形的第一容器
301
中,等距地分布在一个圆周上,呈四叶草式布局
。
42.每个光纤结传感器的尾纤经事先设置好的孔洞穿过第一容器
301
向下伸出
。
第一容器
301
的中心为一个方形通孔,滑块
302
从中穿过
。
滑块
302
呈方形柱状,其中心为一个方形的坑作为中心通道,中心通道中放置第五个光纤结传感器
105
,第五个光纤结传感器
105
的尾纤经滑块
302
底部事先设置好的孔洞穿过滑块
302
的底面向下伸出
。
在光纤结传感器
101、102、103、104
与滑块
302
的四个侧面之间,分别设置有一个圆柱形压柱
201、202、203、204。
43.当滑块
302
位于容器
301
的方形通孔的中心时,压柱
201、202、203、204
分别恰好接触光纤结传感器
101、102、103、104
以及滑块
302
的四周面
。
当滑块
302
向任一方向平移时,压柱
201、202、203、204
中最多两个将被推动,从而挤压相应的光纤结传感器
。
44.如图
2-图4所示,盖子
303
盖在第一容器
301
上方,其下表面设置有一个方形围挡,围挡插入第一容器
301
的方形通孔中
。
围挡的四个侧面的中心分别设置有一个圆形通孔,用于放置压柱
201、202、203、204
,使每一个压柱恰好对准光纤结传感器
101、102、103、104
的中心
。
45.如图
2、
图3和图5所示,滑块
302
的底部为一块圆形薄板,被限制在第一容器
301
和底盘
310
之间的空隙中,从而避免滑块
302
从第一容器
301
中脱落
。
底盘
310
的中心为一个矩形通孔,使光纤结传感器
105
的尾纤从中通过
。
底盘
310
由底盘上盖
311、
滚珠
312、
底盘底板
313
组成
。
底盘上盖
311
与底盘底板
313
限制滚珠
312
的移动,使它们只能在底盘上盖
311
的凹坑中转动
。
透过底盘上盖
311
的圆形开口,滚珠
312
与滑块
302
的底面接触,从而降低滑块
302
平移过程中的摩擦力
。
46.如图2和图5所示,为便于光纤结传感器
101、102、103、104
的尾纤向下伸出不受遮挡,滑块
302
的底部薄板
、
底盘
310
上都等距地设置有四个开口
。
这些开口的尺寸使得在滑块
302
平移过程中,光纤结传感器的尾纤始终不会被触碰到
。
47.如图6所示,光纤结传感器由一个光纤结
111
和一个硅胶立方块
112
构成
。
光纤结
111
被封装在硅胶立方块
112
中,并位于硅胶立方块
112
的中心的对称面上,且光纤结
111
与硅胶立方块
112
的顶面
、
底面
、
左侧面和右侧面相切,光纤结
111
两端尾纤向下从硅胶立方块
112
穿出
。
48.当压力加载在光纤结传感器的顶面
、
左侧面或右侧面时,硅胶发生形变并带动光纤结
111
产生形变,使得光纤结
111
产生弯曲损耗,光透过率降低
。
49.光纤结
111
的两端尾纤分别与发光二极管(
led
)
113
和光电二极管(
pd
)
114
相连
。
光纤与二极管的连接方式是借助遮光夹具
115
使光纤垂直得靠近
led113
的发光面或
pd114
的感光面
。
光纤端面与发光面或感光面之间的距离小于3毫米
。
遮光夹具
115
采用黑色不透明塑料制成,包裹光纤端面和二极管,使
led113
发出的光线不会泄露到外界,并且使
pd114
不会接收到来自外界的光线
。
50.第二容器
402
侧壁开设用于光纤结传感器的光纤尾纤穿设过的通孔,通孔处布置用于光纤尾纤穿设过且进行保护的光纤保护套
403。
光纤结
111
两端的光纤尾纤依次从通孔和光纤保护套
403
穿过后和机械手上的检测组件连接
。
51.如图
7-图
10
所示,三维力传感核心组件
300
被放置于机械手指板件
401
的前端凹坑中,光纤结传感器的尾纤经事先设置好的孔洞穿过机械手指板件
401
的底面向下伸出,进入光纤尾纤的第二容器
402
,并经过光纤保护套
403
向外伸出
。
受力组件
410
位于三维力传感核心组件
300
的正上方,由橡胶垫
411、
受力板
412、
顶盖
413
和三维力压柱
414
组成
。
三维力压柱
414
的柱状部分插入滑块
302
的方形中心通道中
。
52.外力施加在橡胶垫
411
上,经受力板
412
传导到三维力压柱
414
上
。
受力后,三维力压柱
414
发生移动,挤压位于滑块
302
中的光纤结传感器
105
,并推动滑块
302
发生侧移,使其推动压柱
201、202、203、204
中的最多两个,挤压周围的光纤结传感器
101、102、103、104
中的最多两个
。
53.当光纤结传感器
101、102、103、104
中的两个同时受压时,可能的组合方式仅四种:光纤结传感器
101
和光纤结传感器
103、
光纤结传感器
101
和光纤结传感器
104、
光纤结传感器
102
和光纤结传感器
103、
光纤结传感器
102
和光纤结传感器
104。
54.如图
11
所示,三维力传感器
400
通过螺丝安装在机械手
500
上
。
55.如图
12
所示,三维力传感器
400
经电路板
503
与计算机
504
连通
。
计算机
504
接收电路板
503
传输来的实时数据,并向电路板
503
提供电源
。
机械手
500
也与计算机
504
连通
。
计算机
504
向机械手
500
发送运动控制指令,并接收机械手
500
反馈的运动数据
。
56.在电路板
503
上设置有一排
led
阵列
501
和一排
pd
阵列
502。led
阵列
501
包含五个相同的
led
,
pd
阵列
502
包含五个相同的
pd。
从三维力传感器
400
伸出的光纤结传感器的尾纤与
led
阵列
501
和
pd
阵列
502
相连
。
每一个光纤结传感器的两根尾纤中的一根与
led
相连,另一根与
pd
相连
。
57.由
led
阵列
501
发出的光在三维力传感器
400
中传输,最终由
pd
阵列
502
接收并转换为电流
。
电路板
503
向
led
阵列
501
提供恒定电流使其稳定发光,同时收集
pd
阵列
502
产生的电流并转换为电压输出
。
电路板
503
输出的电压为
pd
阵列
502
中五个
pd
输出的电压值
。
当光纤结传感器
101、102、103、104、105
受力产生弯曲损耗时,电路板
503
输出的电压值将减小
。
58.如图
13
所示,分别施加压力+
fz
和摩擦力-
fx、
+
fx、
-
fy、
+
fy
于三维力传感器
400
的橡胶垫
411
上时,电压时序信号
601、602、603、604、605
分别产生显著变化,并且相互之间不存在明显的串扰
。
59.光纤结传感器
101
测量-
x
方向分力-
fx
,光纤结传感器
102
测量+
x
方向分力+
fx
,光纤结传感器
103
测量-y方向分力-
fy
,光纤结传感器
104
测量+y方向分力+
fy
,光纤结传感器
105
测量+z方向分力+
fz。
60.通过分别标定每个光纤结传感器对各自所测量分力的响应,获得受力大小与输出电压大小的函数关系vi =f (fi)
,即可获得三维力传感器
400
的“电压-力”转换关系fi =f ‑
1 (vi) ,其中
i= 1,2
…
,5。fi分别为-
fx、
+
fx、
-
fy、
+
fy、
+
fz。vi分别为
pd
阵列
502
中五个
pd
输出的电压值
。
电路板
503
或计算机
504
通过转换关系fi =f ‑
1 (vi)
将电压值实时地转化为分力大小
。