CN101788257A - 基于电容传感器的六自由度微位姿测量的装置及方法 - Google Patents
基于电容传感器的六自由度微位姿测量的装置及方法 Download PDFInfo
- Publication number
- CN101788257A CN101788257A CN201010300293A CN201010300293A CN101788257A CN 101788257 A CN101788257 A CN 101788257A CN 201010300293 A CN201010300293 A CN 201010300293A CN 201010300293 A CN201010300293 A CN 201010300293A CN 101788257 A CN101788257 A CN 101788257A
- Authority
- CN
- China
- Prior art keywords
- mounting blocks
- capacitive transducer
- degrees
- shift value
- axis
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Granted
Links
Images
Landscapes
- Force Measurement Appropriate To Specific Purposes (AREA)
Abstract
基于电容传感器的六自由度微位姿测量的装置及方法，涉及微位姿测量的装置及方法。本发明为了能够准确的获得微动机构的末端位姿。本发明的装置：三组电容传感器分别固定在外安装块的三个长方体上的通孔中，内安装块位于外安装块的正方形凹槽中，内安装块的三个互为相邻的表面分别与外安装块的三个内表面平行。本发明的方法：将内安装块的一个表面固定在待测微动机构上；采用三组电容传感器测量待测微动机构的六个自由度的位姿，获得测量结果。本发明适用于微动机构的微位姿的测量场合。
Description
技术领域
本发明涉及一种微位姿测量的装置及方法。
背景技术
随着微纳米技术的快速发展，在各种精密工程领域对定位精度的要求日益提高。为了实现微纳器件装配、光纤对接、生物组织操纵等各种高精度作业，具有纳米级精度的微动机器人技术得到了广泛的关注。在六自由度微动机器人位姿控制和运动学参数标定中，位姿检测是其中的关键。对于微动机构，测量方法和测量装置的精度对测量结果会有很大的影响。因此，为了能够准确的获得微动机构的末端位姿，需要引入高精度的测量装置及相应的测量方法。
发明内容
本发明是为了能够准确的获得微动机构的末端位姿，从而提供了一种基于电容传感器的六自由度微位姿测量装置及方法。
基于电容传感器的六自由度微位姿测量装置，它包括外安装块、内安装块和三组电容传感器，所述每组电容传感器中电容传感器的数量均为两个；外安装块由三个长方体相互垂直组成的一体结构，所述三个长方体的内表面围成一个正方形凹槽；所述外安装块的每个长方体上均开有两个通孔；三组电容传感器分别固定在外安装块的三个长方体上的通孔中，且一个电容传感器与一个通孔相对应；内安装块为正方体结构；所述内安装块位于外安装块的正方形凹槽中，内安装块的三个互为相邻的表面分别与外安装块的正方形凹槽的三个内表面平行。
基于上述装置的六自由度微位姿测量方法由以下步骤完成：
步骤一、将内安装块的一个表面固定在待测微动机构上；
步骤二、设定X轴、Y轴和Z轴为三个坐标轴；将所述的三个坐标轴的静坐标系原点O建立在外安装块的正方形凹槽的中心点处，并且三个坐标轴分别与外安装块的正方形凹槽的三个内表面相互垂直；
步骤三、将内安装块设置在外安装块的正方形凹槽中，所述内安装块的中心点与静坐标系原点O重合，并且三个坐标轴分别与内安装块的相应边线相平行；
步骤四、在待测微动机构运动时，三组电容传感器组测量内安装块的六个点位位移；
位于XOY面内的一组电容传感器测量其两个传感器点S1和S2的点位位移，获得S1点位位移值ΔXs1和S2点位位移值ΔXs2，并根据公式：ΔX＝(ΔXs1+ΔXs2)/2，获得内安装块的X向位移值ΔX；并根据公式：γ-(ΔXs2-ΔXs1)/D，获得内安装块绕Z轴的转角γ；
位于XOZ面内的一组电容传感器测量其两个传感器点S3和S4的点位位移，获得S3点位位移值ΔZs3和S4点位位移值ΔZs1，并根据公式：ΔZ-(ΔZs3·ΔZs1)/2，获得内安装块的Z向位移值ΔZ；并根据公式：β-(ΔZs4-ΔZs3)/D 获得待测微动机构绕Y轴的转角β；
位于YOZ面内的一组电容传感器测量其两个传感器点S5和S6的点位位移，获得S5点位位移值ΔYs5和S6点位位移值ΔYs6并根据公式：ΔY-(ΔYs5(ΔYs6)/2，获得内安装块的Y向位移值ΔY；并根据公式：α-(ΔYs6-ΔYs5)/D，获得待测微动机构绕X轴的转角α；
式中D为一组电容传感器中两个电容传感器之间的距离；
步骤五，通过三组电容传感器对六个点点位测量计算获得内安装块X向位移值ΔX，Y 向位移值ΔY，Z 向位移值ΔZ，X 轴的转角α、Y轴的转角β和Z轴的转角γ六个参数，即为待测微动机构的六个自由度姿态
位于XOY面内的一组电容传感器对称分布在X轴两侧；位于XOZ面内的一组电容传感器对称分布在Z轴两侧；位于YOZ面内的一组电容传感器对称分布在Y轴两侧。
位于XOY面内的一组电容传感器对称分布在X轴两侧；位于XOZ面内的一组电容传感器对称分布在Z轴两侧；位于YOZ面内的一组电容传感器对称分布在Y轴两侧。
本发明的装置和方法可以同时测量待测微动机构的六个自由度的末端位姿，并且采用差动模式，能够有效的减小时漂等外界因素对测量结果的影响；本发明采用的电容传感器，将两极板之间的相对位移变化转化为电容变化，实现位移测量，且每组电容传感器分别测量待测微动机构的两个自由度，从而获得六个自由度的测量结果，每组之间不会发生耦合和干扰。本发明具有分辨力强、动态响应快的特点。
附图说明
图1是本发明装置的结构示意图；图2是本发明的具体实施方式三中外安装块与三组电容传感器的位置关系示意图；图3本发明具体实施方式三中的三组电容传感器的位置关系的XOZ面投影图；图4～图6是本发明的测量结果的计算原理示意图。
具体实施方式
具体实施方式一、结合图1说明本具体实施方式，基于电容传感器的六自由度微位姿测量装置，它包括外安装块7、内安装块8和三组电容传感器9，所述每组电容传感器9中电容传感器的数量均为两个；外安装块7由三个长方体相互垂直组成的一体结构，所述三个长方体的内表面围成一个正方形凹槽；所述外安装块7的每个长方体上均开有两个通孔；三组电容传感器9分别固定在外安装块7的三个长方体上的通孔中，且一个电容传感器与一个通孔相对应；内安装块8为正方体结构；所述内安装块8位于外安装块7的正方形凹槽中，内安装块8的三个互为相邻的表面分别与外安装块7的正方形凹槽的三个内表面平行。
本实施方式相对于双极板式电容传感器，具有安装调整简单的特点。
工作原理：本发明将内安装块8和待测微动机构固联，其中三个互为相邻的体面作为三个极板。六个电容传感器分成三组，分别安装于外安装块7的三个相互垂直的面上。通过使用三组电容传感器9，通过测量六点位移实现六自由度位姿测量。
具体实施方式二、本具体实施方式与具体实施方式一所述的基于电容传感器的六自由度微位姿测量装置的区别在于，外安装块7的每个长方体上开有的两个通孔位于同一条竖直或水平直线上。
具体实施方式三、本具体实施方式与具体实施方式二所述的基于电容传感器的六自由度微位姿测量装置的区别在于，外安装块7的每个长方体上开有的两个通孔位于这个体面的中线上。
具体实施方式四、本具体实施方式与具体实施方式三所述的基于电容传感器的六自由度微位姿测量装置的区别在于，外安装块7的三个长方体上的通孔所在的中线相互垂直。
具体实施方式五、本具体实施方式与具体实施方式一、二、三或四所述的基于电容传感器的六自由度微位姿测量装置的区别在于，每组电容传感器9中的两个电容传感器中心之间的距离均为9mm。
具体实施方式六、本具体实施方式与具体实施方式五所述的基于电容传感器的六自由度微位姿测量装置的区别在于，每个电容传感器均为测量平动分辨率为1nm的电容传感器。
本实施方式中每个电容传感器的测量平动分辨率也可优于1nm。
具体实施方式七、本具体实施方式与具体实施方式一、二、三、四或六所述的基于电容传感器的六自由度微位姿测量装置的区别在于，每个电容传感器探头的型号均为S601-0.05。
具体实施方式八、基于具体实施方式一所述的基于电容传感器的六自由度微位姿测量装置的基于电容传感器的六自由度微位姿测量方法，它由以下步骤完成：
基于上述装置的六自由度微位姿测量方法由以下步骤完成：
步骤一、将内安装块8的一个表面固定在待测微动机构上；
步骤二、设定X轴、Y轴和Z轴为三个坐标轴；将所述的三个坐标轴的静坐标系原点O建立在外安装块7的正方形凹槽的中心点处，并且三个坐标轴分别与外安装块7的正方形凹槽的三个内表面相互垂直；
步骤三、将内安装块8设置在外安装块7的正方形凹槽中，所述内安装块8的中心点与静坐标系原点O重合，并且三个坐标轴分别与内安装块8的相应边线相平行；
步骤四、在待测微动机构运动时，三组电容传感器组9测量内安装块8的六个点位位移；
位于XOY面内的一组电容传感器测量其两个传感器点S1和S2的点位位移，获得S1点位位移值ΔXs1和S2点位位移值ΔXs2，并根据公式：ΔX-(ΔXs1(ΔXs2)/2，获得内安装块8的X向位移值ΔX；并根据公式：γ-(ΔXs2-ΔXs1)/D，获得内安装块8绕Z轴的转角γ；
位于XOZ面内的一组电容传感器测量其两个传感器点S3和S4的点位位移，获得S3点位位移值ΔZs3和S4点位位移值ΔZs4，并根据公式：ΔZ-(ΔZs3+ΔZs4)/2，获得内安装块8的Z向位移值ΔZ；并根据公式：β＝(ΔZs4-ΔZs3)/D，获得待测微动机构绕Y轴的转角β；
位于YOZ面内的一组电容传感器测量其两个传感器点S5和S6的点位位移，获得S5点位位移值ΔYs5和S6点位位移值ΔYs6，并根据公式：ΔY-(ΔYs5+ΔYs6)/2，获得内安装块8的Y向位移值ΔY；并根据公式：α＝(ΔYs4-ΔYs5)/D，获得待测微动机构绕X轴的转角α；
式中D为一组电容传感器中两个电容传感器之间的距离；
步骤五、通过三组电容传感器9对六个点点位测量计算获得内安装块8的X向位移值ΔX，Y向位移值ΔY，Z向位移值ΔZ，X轴的转角α、Y轴的转角β和Z轴的转角γ六个参数，即为待测微动机构的六个自由度姿态。
结合图4-图6说明本方法的原理：为计算简便，静坐标系原点建立在内安装块8中心点处，三个坐标轴与内安装块8的相应边线平行。位于XOY面内的一组电容传感器9对称分布在X轴两侧；位于XOZ面内的一组电容传感器9对称分布在Z轴两侧；位于YOZ面内的一组电容传感器9对称分布在Y轴两侧。设待测微动机构运动时，位于XOY面内的电容传感器9在其点位S1和S2点测得的位移分别为ΔXs1、ΔXs2，则内安装块8的X向的位移为ΔX＝(ΔXs1+ΔXs2)/2，待测微动机构绕Z轴的转角为γ＝(ΔXs2-ΔXs1)/D；式中D为两个电容传感器中心之间的距离。
同理，位于XOZ面内的一组电容传感器9在其点位S3和S4测得的位移分别为ΔZs3和ΔZs4，位于YOZ面内的一组电容传感器9在其点位S5和S6测得的位移分别为ΔYs5和ΔYs6，则内安装块8的Z向的位移为ΔZ＝(ΔZs3+ΔZs4)/2，绕Y轴的转角为β＝(ΔZs4-ΔZs3)/D，内安装块8的Y向的位移为ΔY＝(ΔYs5+ΔYs6)/2，待测微动机构绕X轴的转角为α＝(ΔYs6-ΔYs5)/D，
可以看出，位于XOY面内的一组电容传感器可以得到X向的直线位移和绕Z轴的转角；位于XOZ面内的一组电容传感器9可以得到Z向直线位移和绕Y轴的转角；位于YOZ面内的一组电容传感器9可以得到Y向直线位移和绕X轴的转角。因此通过六点测量可以获得动平台六个自由度的位姿。
Claims (9)
1.基于电容传感器的六自由度微位姿测量装置，其特征是：它包括外安装块(7)、内安装块(8)和三组电容传感器(9)，所述每组电容传感器(9)中电容传感器的数量均为两个；外安装块(7)由三个长方体相互垂直组成的一体结构，所述三个长方体的内表面围成一个正方形凹槽；所述外安装块(7)的每个长方体上均开有两个通孔；三组电容传感器(9)分别固定在外安装块(7)的三个长方体上的通孔中，且一个电容传感器与一个通孔相对应；内安装块(8)为正方体结构；所述内安装块(8)位于外安装块(7)的正方形凹槽中，内安装块(8)的三个互为相邻的表面分别与外安装块(7)的正方形凹槽的三个内表面平行。
2.根据权利要求1所述的基于电容传感器的六自由度微位姿测量装置，其特征在于外安装块(7)的每个长方体上开有的两个通孔位于同一条竖直或水平直线上。
3.根据权利要求2所述的基于电容传感器的六自由度微位姿测量装置，其特征在于外安装块(7)的每个长方体上开有的两个通孔位于这个体面的中线上。
4.根据权利要求3所述的基于电容传感器的六自由度微位姿测量装置，其特征在于外安装块(7)的三个长方体上的通孔所在的中线相互垂直。
5.根据权利要求1、2、3或4所述的基于电容传感器的六自由度微位姿测量装置，其特征在于每组电容传感器(9)中的两个电容传感器中心之间的距离均为9mm。
6.根据权利要求5所述的基于电容传感器的六自由度微位姿测量装置，其特征在于每个电容传感器均为测量平动分辨率为1nm的电容传感器。
7.根据权利要求1、2、3、4或6所述的基于电容传感器的六自由度微位姿测量装置，其特征在于每个电容传感器探头的型号均为S601-0.05。
8.基于权利要求1所述的基于电容传感器的六自由度微位姿测量装置的基于电容传感器的六自由度微位姿测量方法，其特征是：它由以下步骤完成：
步骤一、将内安装块(8)的一个表面固定在待测微动机构上；
步骤二、设定X轴、Y轴和Z轴为三个坐标轴：将所述的三个坐标轴的静坐标系原点0建立在外安装块(7)的正方形凹槽的中心点处，并且三个坐标轴分别与外安装块(7)的正方形凹槽的三个内表面相互垂直；
步骤三、将内安装块(8)设置在外安装块(7)的正方形凹槽中，所述内安装块(8)的中心点与静坐标系原点0重合，并且三个坐标轴分别与内安装块(8)的相应边线相平行；
步骤四、在待测微动机构运动时，三组电容传感器组(9)测量内安装块(8)的六个点位位移；
位于XOY面内的一组电容传感器测量其两个传感器点S1和S2的点位位移，获得S1点位位移值ΔXs1和S2点位位移值ΔXs2，并根据公式：ΔX＝(ΔXs1+ΔXs2)/2，获得内安装块(8)的X向位移值ΔX；并根据公式：γ＝(ΔXs2-ΔXs1)/D，获得内安装块(8)绕Z轴的转角γ；
位于XOZ面内的一组电容传感器测量其两个传感器点S3和S4的点位位移，获得S3点位位移值ΔZs3和S4点位位移值ΔZs4，并根据公式：ΔZ＝(ΔZs3+ΔZs4)/2，获得内安装块(8)的Z向位移值ΔZ；并根据公式：β＝(ΔZs4-ΔZs3)/D，获得待测微动机构绕Y轴的转角β：
位于YOZ面内的一组电容传感器测量其两个传感器点S5和S6的点位位移，获得S5点位位移值ΔYs5和S6点位位移值ΔYs6，并根据公式：ΔY＝(ΔYs5+ΔYs6)/2，获得内安装块(8)的Y向位移值ΔY；并根据公式：α＝(ΔYs6-ΔYs5)/D，获得待测微动机构绕X轴的转角α；
式中D为一组电容传感器中两个电容传感器之间的距离；
步骤五、通过三组电容传感器(9)对六个点点位测量计算获得内安装块(8)X向位移值ΔX、Y向位移值ΔY、Z向位移值ΔZ、X轴的转角α、Y轴的转角β和 Z轴的转角γ六个参数，即为侍测微动机构的六个自由度姿态。
9.根据权利要求8所述的基于电容传感器的六自由度微位姿测量方法，其特征在于位于XOY面内的一组电容传感器(9)对称分布在X轴两侧；位于XOZ面内的一组电容传感器(9)对称分布在Z轴两侧；位于YOZ面内的一组电容传感器(9)对称分布在Y轴两侧。
Priority Applications (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| CN2010103002937A CN101788257B (zh) | 2010-01-14 | 2010-01-14 | 基于电容传感器的六自由度微位姿测量的装置及方法 |
Applications Claiming Priority (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| CN2010103002937A CN101788257B (zh) | 2010-01-14 | 2010-01-14 | 基于电容传感器的六自由度微位姿测量的装置及方法 |
Publications (2)
| Publication Number | Publication Date |
|---|---|
| CN101788257A true CN101788257A (zh) | 2010-07-28 |
| CN101788257B CN101788257B (zh) | 2011-08-31 |
Family
ID=42531569
Family Applications (1)
| Application Number | Title | Priority Date | Filing Date |
|---|---|---|---|
| CN2010103002937A Expired - Fee Related CN101788257B (zh) | 2010-01-14 | 2010-01-14 | 基于电容传感器的六自由度微位姿测量的装置及方法 |
Country Status (1)
| Country | Link |
|---|---|
| CN (1) | CN101788257B (zh) |
Cited By (6)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN102095356A (zh) * | 2010-11-09 | 2011-06-15 | 浙江大学 | 一种基于柱面电容传感器的主轴五自由度测量方法与装置 |
| CN104236459A (zh) * | 2014-09-24 | 2014-12-24 | 烟台拓伟机械有限公司 | 六点定位式相对位姿检测*** |
| CN105804605A (zh) * | 2016-03-14 | 2016-07-27 | 南京赛百联人防科技有限公司 | 防护门多维监测运维传感器以及防护门 |
| CN106767512A (zh) * | 2016-12-29 | 2017-05-31 | 哈尔滨工业大学 | 基于实时监测运动误差的光学元件高精度测量装置 |
| CN111716331A (zh) * | 2020-06-28 | 2020-09-29 | 中国科学院长春光学精密机械与物理研究所 | 一种六自由度并联机构参数标定装置及方法 |
| CN115655094A (zh) * | 2022-11-02 | 2023-01-31 | 北京工业大学 | 一种不等极板面积的角位移测量电容传感器 |
-
2010
- 2010-01-14 CN CN2010103002937A patent/CN101788257B/zh not_active Expired - Fee Related
Cited By (11)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN102095356A (zh) * | 2010-11-09 | 2011-06-15 | 浙江大学 | 一种基于柱面电容传感器的主轴五自由度测量方法与装置 |
| CN102095356B (zh) * | 2010-11-09 | 2012-06-27 | 浙江大学 | 一种基于柱面电容传感器的主轴五自由度测量方法与装置 |
| CN104236459A (zh) * | 2014-09-24 | 2014-12-24 | 烟台拓伟机械有限公司 | 六点定位式相对位姿检测*** |
| CN104236459B (zh) * | 2014-09-24 | 2015-06-17 | 烟台拓伟机械有限公司 | 六点定位式相对位姿检测*** |
| CN105804605A (zh) * | 2016-03-14 | 2016-07-27 | 南京赛百联人防科技有限公司 | 防护门多维监测运维传感器以及防护门 |
| CN106767512A (zh) * | 2016-12-29 | 2017-05-31 | 哈尔滨工业大学 | 基于实时监测运动误差的光学元件高精度测量装置 |
| CN111716331A (zh) * | 2020-06-28 | 2020-09-29 | 中国科学院长春光学精密机械与物理研究所 | 一种六自由度并联机构参数标定装置及方法 |
| CN113183137A (zh) * | 2020-06-28 | 2021-07-30 | 中国科学院长春光学精密机械与物理研究所 | 一种六自由度并联机构的参数标定装置及方法 |
| CN113183137B (zh) * | 2020-06-28 | 2022-07-01 | 中国科学院长春光学精密机械与物理研究所 | 一种六自由度并联机构的参数标定装置及方法 |
| CN115655094A (zh) * | 2022-11-02 | 2023-01-31 | 北京工业大学 | 一种不等极板面积的角位移测量电容传感器 |
| CN115655094B (zh) * | 2022-11-02 | 2024-03-29 | 北京工业大学 | 一种不等极板面积的角位移测量电容传感器 |
Also Published As
| Publication number | Publication date |
|---|---|
| CN101788257B (zh) | 2011-08-31 |
Similar Documents
| Publication | Publication Date | Title |
|---|---|---|
| CN103076131B (zh) | 用于测量大型机械臂大力与小力矩的六维力与力矩传感器 | |
| CN101788257B (zh) | 基于电容传感器的六自由度微位姿测量的装置及方法 | |
| EP2396622B1 (en) | Coordinate measuring machine (cmm) and method of compensating errors in a cmm | |
| CN105067206B (zh) | 一种桥梁结构挠度线形测量方法 | |
| CN201083760Y (zh) | 三轴集成压阻式加速度传感器 | |
| CN102364311B (zh) | 基于三轴加速度传感器阵列的六自由度振动绝对测试方法 | |
| CN102636297B (zh) | 一种三维力传感器 | |
| CN102721393B (zh) | 一种精密旋转工作台测量***误差在位自标定方法 | |
| CN101539463B (zh) | 对称互补结构的霍尔差分式测力方法 | |
| CN107042527A (zh) | 一种基于三维力传感器的工业机器人标定装置及标定方法 | |
| CN103791868B (zh) | 一种基于虚拟球的空间标定体及其标定方法 | |
| CN207908539U (zh) | 一种梳齿电容式三轴mems加速度传感器 | |
| CN105698661A (zh) | 微纳米三坐标测量机接触式扫描探头 | |
| CN109253710B (zh) | 一种revo测头a轴零位误差标定方法 | |
| CN104483891A (zh) | 一种提高机床空间运动精度的方法 | |
| CN110793439B (zh) | 一种多传感器测量机坐标统一的标准器和坐标统一方法 | |
| CN111536877A (zh) | 一种三坐标测量机上的线激光传感器姿态标定方法 | |
| CN103591874B (zh) | 用标准块实现极坐标齿轮测量中心零点标定的方法 | |
| CN205403689U (zh) | 微纳米三坐标测量机接触式扫描探头 | |
| CN103322920B (zh) | 一种扩大激光位移传感器量程的测量方法 | |
| CN103075951B (zh) | 一种基于电容传感器阵列的三维微接触式测头 | |
| CN113771093A (zh) | 基于直线运动台的机械臂标定与精度测量装置 | |
| CN205719350U (zh) | 一种并联式五维力传感器 | |
| CN202974174U (zh) | 一种基于电容传感器阵列的三维微接触式测头 | |
| CN201037760Y (zh) | 一种窝测量工具 |
Legal Events
| Date | Code | Title | Description |
|---|---|---|---|
| C06 | Publication | ||
| PB01 | Publication | ||
| C10 | Entry into substantive examination | ||
| SE01 | Entry into force of request for substantive examination | ||
| C14 | Grant of patent or utility model | ||
| GR01 | Patent grant | ||
| C17 | Cessation of patent right | ||
| CF01 | Termination of patent right due to non-payment of annual fee |
Granted publication date: 20110831 Termination date: 20140114 |