一种相对全位姿检测装置及其应用制造方法及图纸

本发明专利技术涉及本发明专利技术涉及一种相对全位姿检测装置及其应用。该相对全位姿检测装置，包括传感器固定板和线头集结器固定板；传感器固定板上设置有多个拉线式位移传感器，线头集结器固定板上设置有与拉线式位移传感器相配合的线头集结器；拉线式位移传感器与线头集结器之间设置有输出拉线。本发明专利技术所述相对全位姿检测装置，借助拉线式位移传感器，通过检测不同平面多点间的距离变化，反推物体相对位姿变化；结构及检测原理简单，检测精度高，实现简单，具有广泛的推广价值。

Relative full pose detection device and application thereof

The invention relates to a relative full pose detection device and an application thereof. The relative detection device of full posture, which comprises a fixed plate fixed plate and lint collector sensor; sensor fixed board is provided with a plurality of cable displacement sensor, lint collector is arranged on the fixed plate with cable displacement sensor is lint collector; the output cable is arranged between the wire type displacement sensor and thread collector. The total relative pose detection device, by means of the displacement transducer, by detecting the distance change between different planar objects, backstepping relative pose change; structure and detection principle is simple, high detection precision, simple implementation, and wide popularization value.

【技术实现步骤摘要】
一种相对全位姿检测装置及其应用
本专利技术涉及一种相对全位姿检测装置及其应用，属于相对全位姿检测的

技术介绍
相对位姿检测技术是指，通过相对位姿的实时监测确定两独立物体间的相对位置关系及相对姿态变化，以实现对物体未来位姿的控制。目前，位姿检测多用于机械手或机器人领域，多数是通过角度传感器、位移传感器判断具有关联性质物体各组成元件的相对位姿，也有一部分是借助激光、红外线、电磁式传感器通过判断两物体相对距离实现局部位姿信息监测。例如，中国专利CN105444687A公开了一种基于对视摄像测量和激光测距的相对位姿变化测量方法。该装置利用摄像测量和激光测距技术高精度、简单快速的优点，测量两个刚体之间的相对位姿变化。上述通过角度、位移传感器或者激光、红外线、电磁式传感器的检测方法，实施成本一般较高，且很难实现两物体的全位姿检测。
技术实现思路
针对现有技术的不足，本专利技术提供一种相对全位姿检测装置。本专利技术还提供一种利用上述装置进行相对全位姿检测的方法。本专利技术的技术方案为：一种相对全位姿检测装置，包括传感器固定板和线头集结器固定板；传感器固定板上设置有多个拉线式位移传感器，线头集结器固定板上设置有与拉线式位移传感器相配合的线头集结器；拉线式位移传感器与线头集结器之间设置有输出拉线。优选的，所述拉线式位移传感器的个数至少为3个；多个拉线式位移传感器设置在传感器固定板的同一侧。优选的，线头集结器与拉线式位移传感器个数相同。优选的，拉线式位移传感器上设置有输出孔；线头集结器上设置有与所述输出孔相配合的线头进入孔；所述输出拉线从所述输出孔输出进入所述线头进入孔。进一步优选的，所述输出孔和线头进入孔均为圆形孔，圆形孔的面积大于穿过它的所有输出拉线的截面积之和。进一步优选的，所述拉线式位移传感器上的输出孔位于同一平面；所述线头集结器上的线头进入孔位于同一平面。优选的，每个拉线式位移传感器输出的输出拉线的根数与拉线式位移传感器的个数相同；每个拉线式位移传感器通过输出拉线分别与每个线头集结器独立连接。每个拉线式位移传感器与每个线头集结器间都有一根输出拉线。进一步优选的，拉线式位移传感器内设置有与输出拉线相配合的伸出量检测单元和自动拉紧装置。拉线式位移传感器的工作原理：拉绳式传感器的功能是把机械运动转换成可以计量、记录或传送的电信号。拉线式位移传感器由可拉伸的不锈钢绳绕在一个有螺纹的轮毂上，此轮毂与一个精密旋转感应器连接在一起，感应器可以是增量编码器、绝对值编码器、混合或导电塑料旋转电位计、同步器或解析器。操作上，拉绳式位移传感器安装在固定位置上，拉绳缚在移动物体上。拉绳直线运动和移动物体运动轴线对准。运动发生时，拉绳伸展和收缩。一个内部弹簧保证拉绳的张紧度不变。带螺纹的轮毂带动精密旋转感应器旋转，输出一个与拉绳移动距离成比例的电信号。测量输出信号可以得出运动物体的位移、方向或速率。所述伸出量检测单元可以被认为是上述提到的“精密旋转感应器”。所述自动张紧装置可以认为是上文提到的“内部弹簧”。这里的弹簧不仅可以使拉绳的张紧度不变，还可以使拉绳伸出末端松开后拉绳回卷入拉线式位移传感器内。进一步优选的，拉线式位移传感器内设置有与每根输出拉线相对应的伸出量检测单元和自动拉紧装置。传统的拉线式位移传感器只有一根输出拉线，只配备有一个检测单元，用于检测这一根拉线的伸出量；而本专利技术所述的拉线式位移传感器至少有三根拉线，每根拉线都需配一个独立的检测单元。优选的，多个拉线式位移传感器围成多边形。优选的，所述输出拉线的线头固定设置在线头集结器的线头固定器上。线头固定器是将拉绳伸出末端固定的结构，可以是压线螺钉，也可以是栓线孔。一种利用上述装置进行相对全位姿检测的方法，包括步骤如下：1)分别测量输出孔两两之间的距离和线头进入孔两两之间的距离；2)通过拉线式位移传感器测量所述输出孔到所述线头进入孔的距离；3)将传感器固定板和线头集结器固定板分别固定安装在待检测的两物体上，检测两物体的相对位姿变化。优选的，检测两物体的相对位姿变化的具体方法如下：分别在多个拉线式位移传感器和多个线头集结器所在平面建立直角坐标系xyz和x'y'z'，此时，直角坐标系xyz和x'y'z'的各个坐标轴和原点的关系代表两物体的初始位置和初始姿态关系；每个拉线式位移传感器和每个线头集结器之间的距离已知，当两物体发生位置和姿态变化时，坐标系xyz和x'y'z'相对位姿发生变化，通过检测拉线式位移传感器的拉线伸出量确定每个拉线式位移传感器和每个线头集结器之间的最新长度，通过求解直角坐标系xyz和x'y'z'各坐标轴及原点的关系，获得两物体此时的位姿关系。本专利技术的有益效果为：本专利技术所述相对全位姿检测装置，借助拉线式位移传感器，通过检测不同平面多点间的距离变化，反推物体相对位姿变化；结构及检测原理简单，检测精度高，实现简单，具有广泛的推广价值。附图说明图1为本专利技术所述相对全位姿检测装置的结构示意图；图2为实施例13中检测两点距离的示意图；图3为实施例13中通过四个点检测两物体位资的示意图；图4为实施例13中利用普通方法检测两个六面物体位资的示意图；图5为实施例13利用本专利技术所述方法检测两个物体位资的示意图；其中，1、传感器固定板；2、拉线式位移传感器；2-1、输出孔；2-2、输出拉线；3、线头集结器固定板；4、线头集结器；4-1、线头进入孔。具体实施方式下面结合实施例和说明书附图对本专利技术做进一步说明，但不限于此。实施例1如图1所示。一种相对全位姿检测装置，包括传感器固定板1和线头集结器固定板3；传感器固定板1上设置有多个拉线式位移传感器2，线头集结器固定板3上设置有与拉线式位移传感器2相配合的线头集结器4；拉线式位移传感器2与线头集结器4之间设置有输出拉线2-2。实施例2如实施例1所述的相对全位姿检测装置，所不同的是，所述拉线式位移传感器2的个数为3个；3个拉线式位移传感器2设置在传感器固定板1的同一侧。实施例3如实施例1所述的相对全位姿检测装置，所不同的是，线头集结器4与拉线式位移传感器2个数相同。实施例4如实施例1所述的相对全位姿检测装置，所不同的是，拉线式位移传感器2上设置有输出孔2-1；线头集结器4上设置有与所述输出孔2-1相配合的线头进入孔4-1；所述输出拉线2-2从所述输出孔2-1输出进入所述线头进入孔4-1。实施例5如实施例1所述的相对全位姿检测装置，所不同的是，每个拉线式位移传感器2输出的输出拉线2-2的根数与拉线式位移传感器2的个数相同；每个拉线式位移传感器2通过输出拉线2-2分别与每个线头集结器4独立连接。实施例6如实施例5所述的相对全位姿检测装置，所不同的是，拉线式位移传感器2内设置有与输出拉线2-2相配合的绝对值编码器和内部弹簧。实施例7如实施例6所述的相对全位姿检测装置，所不同的是，拉线式位移传感器2内设置有与每根输出拉线2-2相对应的绝对值编码器和内部弹簧。传统的拉线式位移传感器只有一根输出拉线，只配备有一个检测单元，用于检测这一根拉线的伸出量；而本专利技术所述的拉线式位移传感器至少有三根拉线，每根拉线都需配一个独立的检测单元。实施例8如实施例4所述的相对全位姿检测装置，所不同的是，所述输出孔2-1和线头进入孔4-1均为圆形孔，圆形孔的面积大于穿过它的所本文档来自技高网...

【技术保护点】
一种相对全位姿检测装置，其特征在于，包括传感器固定板和线头集结器固定板；传感器固定板上设置有多个拉线式位移传感器，线头集结器固定板上设置有与拉线式位移传感器相配合的线头集结器；拉线式位移传感器与线头集结器之间设置有输出拉线。

【技术特征摘要】
1.一种相对全位姿检测装置，其特征在于，包括传感器固定板和线头集结器固定板；传感器固定板上设置有多个拉线式位移传感器，线头集结器固定板上设置有与拉线式位移传感器相配合的线头集结器；拉线式位移传感器与线头集结器之间设置有输出拉线。2.根据权利要求1所述的相对全位姿检测装置，其特征在于，所述拉线式位移传感器的个数至少为3个；多个拉线式位移传感器设置在传感器固定板的同一侧。3.根据权利要求1所述的相对全位姿检测装置，其特征在于，线头集结器与拉线式位移传感器个数相同。4.根据权利要求1所述的相对全位姿检测装置，其特征在于，拉线式位移传感器上设置有输出孔；线头集结器上设置有与所述输出孔相配合的线头进入孔；所述输出拉线从所述输出孔输出进入所述线头进入孔。5.根据权利要求4所述的相对全位姿检测装置，其特征在于，所述输出孔和线头进入孔均为圆形孔，圆形孔的面积大于穿过它的所有输出拉线的截面积之和；所述拉线式位移传感器上的输出孔位于同一平面；所述线头集结器上的线头进入孔位于同一平面。6.根据权利要求1所述的相对全位姿检测装置，其特征在于，每个拉线式位移传感器输出的输出拉线的根数与拉线式位移传感器的个数相同；每个拉线式位移传感器通过输出拉线分别与每个线头集结器独立连接。7.根据权利要求6所述的相对全位姿检测装置，其特征在...

【专利技术属性】
技术研发人员：高魁东，曾庆良，张鑫，万丽荣，姜考，
申请(专利权)人：山东科技大学，
类型：发明
国别省市：山东,37