CN100447528C - 位姿测量平面传感器 - Google Patents

Abstract

一种位姿测量平面传感器，包括安装座、连杆和用于测量角度的编码器，其中左安装座安装在固定位置上，右安装座安装于被测物体上，左安装座与右安装座之间为左连杆、右连杆与三个旋转副的串联结构；每个旋转副上安装有编码器。采用本发明能高精度、实时、快速的检测出物体在平面内三自由度位姿。

Description

位姿测量平面传感器技术领域本发明涉及位姿测量跟踪技术，具体地说是一种基于三个旋转副串联的三自由度串联位姿跟踪的新型结抅平面传感器。它适合平板类物体在X-z平面内的位姿测量跟踪。 背景技术现有的位姿测量跟踪机械式传感器技术中，由于应用的条件、环境不 同导致具有特定精度的专用传感器的种类和形式较多，但都仅适用于特定 环境。在同类机械式传感器中尚没有能高精度、实时、快速的检测出物体 在平面内三自由度位姿的传感器装置。发明内容为了满足被测物体的测量要求，本发明的目的是提供一种具有能计算 出实时解析解、跟踪速度快、测量精度高的新型位姿测量平面传感器装置。为了实现上述目的，本发明的技术方案是：包括安装座、连杆和用于 测量角度的编码器，其中左安装座安装在固定位置上，右安装座安装于被 测物体上，左安装座与右安装座之间为左连杆、右连杆与三个旋转副的串联结构；每个旋转副上安装有编码器；具体结构为：由左安装座、左轴、左连杆、中安装座、中轴、右连杆、 右轴、右安装座、右编码器、中编码器、左编码器组成，左连杆一端通过 左轴旋转式安装在左安装座上，左连杆另一端与中安装座相连，右连杆一 端通过中轴旋转式安装于中安装座上，右连杆的另 一端通过右轴旋转式安装于右安装座上；左编码器、中编码器、右编码器分别设在左安装座、中 安装座、右安装座上；所述右安装座与被测物体相连，左安装座安装在固 定位置上；所述左连杆和右连杆长度相等；所述左轴、中轴、右轴与左连 杆、右连杆之间设有轴承。 本发明工作原理如下：本发明通过左安装座工作时安装在固定位置上，右安装座8安装于被测物体上，中间由左连杆、右连杆通过三个旋转副实现串联结构。每个旋转副上安装有角度编码器，当被测物体位姿发生变化时，三个角度编码器 可以测量出左连杆相对固定位置的旋转角.右连杆相对左连杆的旋转角-被测物体相对右连杆的旋转角三个角度。利用位姿计算公式就亩以计算得 到被测物体的位姿变化情况。本发明具有如下优点：1. 测量精度高。由于本发明利用长度不变的连杆（左连杆和右连杆）， 三个同型号角度编码器来实现对平板类物体的平面内位姿检测。这种结构形式简单，误差源少：所以测量精度高，特别适用于平板类物体的平面内位姿检测。2. 能实时、准确的测量出被测物体在平面内的位姿。由吁本发明具有 功能性元件少，结构简单、紧凑，计算公式简捷的特点，可以实现实时跟 踪检测。具有测量结果快速、准确的优点。附图说明附图1为本发明结构设计装配图— 具体实施方式下面结合附图1对本发明作进一步详细说明。如附图l所示，本发明由左安装座l、左轴2、左连杆3、中安装座4、 中轴5、右连杆6、右轴7、右安装座8、右编码器9、中编码器IO、左编 码器ll组成，左连杆3—端通过左轴2安装在左安装座1上，左连杆3能 够相对左安装座1转动，安装于左安装座1上的左编码器11可测量出此转 动角度。左连杆3另 一端安装在中安装座4上，右连杆6 —端通过中轴5 安装于中安装座4上,右连杆6能够相对左连杆3转动，安装于中安装座4 上的中编码器10可测量出此转动角度。右连杆6的另 一端通过右轴7安装 于右安装座8上，右安装座8能够相对右连杆6转动，安装于右安装座8 上的右编码器9可测量出此转动角度。利用三个编码器测量出的角度变化 就可计算出被测物体的位姿变化情况。其中：所述左轴2、中轴5、右轴7与左连杆3、右连杆6之间安装有 轴承。本发明工作过程如下：当被测物体在本发明测量范围内发生位姿变化 时，安装在被测物体上的右安装座8也跟着发生相应的位姿变化，右安装 座8带动右连杆6进而带动左连杆3发生相应的转动。左编码器.ll测量出 左连杆相对固定位置的旋转角《，中编码器IO测量出右连杆相对左连杆的旋转角《，右编码器9测量出被测物体相对右连杆的旋转角《，左连杆3 和右连杆6长度不变并且已知，利用位姿计算公式计算出被测物体在左安 装座1建立的坐标系中的位置变化情况（此坐标系以左安装座1 ^轴承安位姿计算公式：x = /, cos & + Z2 cos( A + 6*2) + c cos( 61, + (92 + 6*3.) <{ z = sin《+ /2 sin( + (92) + c sin( + 02 + )其中：/，左轴2轴心与中轴5轴心的直线距离，/2右轴7轴心与中轴5 轴心的直线距离，c右轴7轴心与被测物体中心的直线距离，0左连杆3相 对左安装座转过的角（即相对固定位置的旋转角），《右连杆相对左连杆的 旋转角，《被测物相对右连杆的旋转角。发明的测量范围如下表：<table>table see original document page 5</column></row> <table>

Claims (4)

1.一种位姿测量平面传感器，包括安装座、连杆和用于测量角度的编码器，其中左安装座安装在固定位置上，右安装座安装于被测物体上，左安装座与右安装座之间为中安装座，通过左连杆、右连杆构成串联结构；每个安装座上均安装有编码器。

2. 按照权利要求l所述位姿测量平面传感器，其特征在于：具体结构 为：由左安装座（1)、左轴（2)、左连杆（3)、中安装座（4)、中轴（5)、 右连杆（6)、右轴（7)、右安装座（8)、右编码器（9)、中编码器（10)、 左编码器（11)组成，左连杆（3) —端通过左轴（2)旋转式安装在左安 装座（1)上，左连杆（3)另一端与中安装座（4)相连，右连杆（6) — 端通过中轴（5)旋转式安装于中安装座（4)上，右连杆（6)的另一端通 过右轴（7)旋转式安装于右安装座（8)上；左编码器（ll)、中编码器（IO)、 右编码器（9)分别设在左安装座（1)、中安装座（4)、右安装座（8)上。

3. 按照权利要求2所述位姿测量平面传感器，其特征在于：所述左连 杆（3)和右连杆（6)长度相等。

4. 按照权利要求2所述位姿测量平面传感器，其特征在于：其中：所 述左轴（2)、中轴（5)、右轴（7)与左连杆（3)、右连杆（6)之间设有 轴承。