CN101738163B - 全光电式磁浮工件台六维位姿测量*** - Google Patents
全光电式磁浮工件台六维位姿测量*** Download PDFInfo
- Publication number
- CN101738163B CN101738163B CN2009103116460A CN200910311646A CN101738163B CN 101738163 B CN101738163 B CN 101738163B CN 2009103116460 A CN2009103116460 A CN 2009103116460A CN 200910311646 A CN200910311646 A CN 200910311646A CN 101738163 B CN101738163 B CN 101738163B
- Authority
- CN
- China
- Prior art keywords
- magnetic suspension
- workpiece table
- suspension workpiece
- displacement
- sensor
- 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.)
- Expired - Fee Related
Links
Images
Landscapes
- Measurement Of Length, Angles, Or The Like Using Electric Or Magnetic Means (AREA)
- Length Measuring Devices With Unspecified Measuring Means (AREA)
Abstract
本发明公开了一种机械电子技术领域的全光电式磁浮工件台六维位姿测量***,包括:磁浮工件台、传感器组和六维坐标导出单元,其中:传感器组固定于磁浮工件台上,传感器组的输入端随磁浮工件台自由移动以采集磁浮工件台位移方向和距离信息,传感器组的输出端与六维坐标导出单元相连传输磁浮工件台位移方向和距离信息,六维坐标导出单元输出磁浮工件台的六维位姿信息;所述的传感器组包括:两个微图像位移传感器和三个激光位移传感器。本发明应用于制造设备与机器人领域,***整体尺寸小、结构紧凑;测量范围大大拓展;采用全光电式传感器,其抗电磁干扰能力得以增强。
Description
技术领域
本发明涉及的是一种机械电子技术领域的***,具体是一种全光电式磁浮工件台六维位姿测量***。
背景技术
磁浮平面工作台是一种通过电磁力直接驱动的XY工作台,因不含机械传动链,其具有近零摩擦、高响应、高精度的优点。从刚体运动学的角度,磁浮平面工作台的功能可描述为:其所包含的工件台在电磁力的作用下,既能在XY平面上以一定的精度跟踪给定轨迹,也能在非运动自由度方向(包括偏航方向、纵倾方向、横倾方向和Z方向)上保持微小范围内的波动。
磁浮平面工作台上述功能的实现离不开位姿测控***的作用,位姿测控***由六维位姿测量***和位姿控制器两部分构成。其中:六维位姿测量***实现对工件台X向、Y向宏动方向坐标的测量和其他微动方向广义坐标的测量,是基础性的环节,其测量范围、测量角度、测量速度直接影响整个控制***的性能指标。
经对现有文献检索发现,美国麻省理工学院的Kim在其1997年完成的博士毕业论文《High-precision planar magnetic levitation(高精度平面磁悬浮台)》中建立了一种磁浮平面工作台位姿测量***,该***包含一台多轴激光干涉测量仪和一个由3个电容传感器构成的传感器组。但是该技术中:1)激光干涉仪光路长,使得测量***所占面积较大;2)受到安装于工件台上直角反射镜长度的限制,其测量范围较小,一般小于工件台的平面尺寸;3)电容传感器是一种模拟式电学传感器,更容易受到磁浮工作台中固有的交变电磁场的干扰。
发明内容
本发明的目的是克服现有技术存在的上述不足,提供一种全光电式磁浮工件台六维位姿测量***。本发明通过使用图像位移传感器和激光位移传感器替代激光干涉仪和电容传感器,实现了结构紧凑、大测量范围、强抗电磁干扰能力的功能。
本发明是通过以下技术方案实现的:
本发明包括:磁浮工件台、传感器组和六维坐标导出单元,其中:传感器组固定于磁浮工件台上,传感器组的输入端随磁浮工件台移动以采集磁浮工件台的位移方向和距离信息,传感器组的输出端与六维坐标导出单元相连传输磁浮工件台的位移方向和距离信息,六维坐标导出单元输出磁浮工件台的六维位姿信息。
所述的传感器组包括:两个微图像位移传感器和三个激光位移传感器,其中:每个微图像位移传感器和每个激光位移传感器分别固定于磁浮工件台上,每个微图像位移传感器的输入端和每个激光位移传感器的输入端分别采集其所在点的位移方向和距离信息,每个微图像位移传感器的输出端和每个激光位移传感器的输出端分别与六维坐标导出单元相连传输磁浮工件台的位移方向和距离信息。
所述的微图像位移传感器包括:发光器件、两个光学透镜、数字微成像器和数字接口电路,其中:第一光学透镜位于发光器件正前方,第一光学透镜和发光器件的光轴重合,第二光学透镜位于数字微成像器输入端正前方,第二光学透镜和数字微成像器的光轴重合,第一光学透镜透射出的光束反射后射入第二光学透镜,数字微成像器与数字接口电路相连传输磁浮工件台的位移方向和距离信息,数字接口电路与六维坐标导出单元相连传输磁浮工件台的位移方向和距离信息。
所述的六维坐标导出单元包括:数字信号处理芯片和两个单片机,其中:每个微图像位移传感器分别与第一单片机相连传输每个微图像位移传感器所在点的位移方向和距离信息,第一单片机与第二单片机相连传输每个微图像位移传感器所在点的位移方向和距离信息,每个激光位移传感器分别与第二单片机相连传输每个激光位移传感器所在点的位移方向和距离信息,第二单片机与数字信号处理芯片相连传输每个微图像位移传感器和每个激光位移传感器所在点的位移方向和距离信息,数字信号处理芯片输出磁浮工件台的六维位姿信息。
所述的第二单片机是高性能模拟信号处理单片机。
与现有技术相比,本发明的有益效果是:1)所采用的光电传感器体积小,无长距离光路,***整体尺寸小、结构紧凑;2)相比于激光干涉仪测量方式,无需高光洁度的L型反射镜头,其测量范围大大拓展;3)采用全光电式传感器,避免使用电容传感器等模拟电学传感器,其抗电磁干扰能力得以增强。
附图说明
图1是本发明的***结构框图。
具体实施方式
下面结合附图对本发明的实施例作详细说明:本实施例在以本发明技术方案为前提下进行实施,给出了详细的实施方式和具体的操作过程,但本发明的保护范围不限于下述的实施例。
实施例
如图1所示,本实施例包括:磁浮工件台1、传感器组2和六维坐标导出单元3,其中:传感器组2固定于磁浮工件台1上,传感器组2的输入端随磁浮工件台1自由移动以采集磁浮工件台1的位移方向和距离信息,传感器组2的输出端与六维坐标导出单元3相连传输磁浮工件台1的位移方向和距离信息,六维坐标导出单元3输出磁浮工件台1的六维位姿信息。
所述的传感器组2包括:两个微图像位移传感器和三个激光位移传感器,其中:第一微图像位移传感器4、第二微图像位移传感器5、第一激光位移传感器6、第二激光位移传感器7和第三激光位移传感器8分别固定于磁浮工件台1上,每个微图像位移传感器的输入端和每个激光位移传感器的输入端分别采集其所在点的位移方向和距离信息,每个微图像位移传感器的输出端和每个激光位移传感器的输出端分别与六维坐标导出单元3相连传输磁浮工件台1的位移方向和距离信息。
所述激光位移传感器是基恩士(Keyence)生产的LK-G系列激光位移传感器。
所述的微图像位移传感器包括:发光器件、两个光学透镜、数字微成像器和数字接口电路,其中:第一光学透镜位于发光器件正前方,第一光学透镜和发光器件的光轴重合,第二光学透镜位于数字微成像器输入端正前方,第二光学透镜和数字微成像器的光轴重合,第一光学透镜透射出的光束反射后射入第二光学透镜,数字微成像器与数字接口电路相连传输磁浮工件台的位移方向和距离信息,数字接口电路与六维坐标导出单元相连传输磁浮工件台的位移方向和距离信息。
所述的发光器件是发光二极管,或者是激光器。
所述的数字微成像器是安捷伦(Agilent)出产的ADNS-2051,或者是罗技出产的MX光学感应器。
所述的数字接口电路是原相科技(PixArt)公司的A2601芯片。
所述的六维坐标导出单元3包括:数字信号处理芯片9和两个单片机,其中:每个微图像位移传感器分别与第一单片机10相连传输每个微图像位移传感器所在点的位移方向和距离信息,第一单片机10与第二单片机11相连传输每个微图像位移传感器所在点的位移方向和距离信息,每个激光位移传感器分别与第二单片11机相连传输每个激光位移传感器所在点的位移方向和距离信息,第二单片机11与数字信号处理芯片9相连传输每个微图像位移传感器和每个激光位移传感器所在点的位移方向和距离信息,数字信号处理芯片9输出磁浮工件台1的六维位姿信息。
所述的数字信号处理芯片9是德州仪器公司的TMS320C2000数字处理芯片。
所述的第一单片机10采用英特尔公司生产的MSC-51系列单片机。
所述的第二单片机11是高性能模拟信号处理单片机,本实施例采用德州仪器公司生产的MSC1210单片机。
本实施例的工作过程:通过两个图像位移传感器和三个激光位移传感器对磁浮工件台1的位移方向和距离进行测量;六维坐标导出单元3根据两个微图像位移传感器和三个激光位移传感器得到的磁浮工件台1的位移方向和距离信息,分析得到磁浮工件台1的六维姿态坐标(x,y,z,ψ,θ,φ),其中:ψ是偏航姿态角,θ是纵倾姿态角,φ是横倾姿态角。
本实施例的优点:1)采用的光电传感器体积小,无长距离光路,其整体尺寸小、结构紧凑;2)相比于激光干涉仪测量方式,无需高光洁度的L型反射镜头,其测量范围大大拓展;3)采用全光电式传感器,避免使用电容传感器等模拟电学传感器,其抗电磁干扰能力得以增强。
Claims (4)
1.一种全光电式磁浮工件台六维位姿测量***,包括:磁浮工件台、传感器组,其特征在于,还包括:六维坐标导出单元,其中:传感器组固定于磁浮工件台上,传感器组的输入端随磁浮工件台移动以采集磁浮工件台的位移方向和距离信息,传感器组的输出端与六维坐标导出单元相连传输磁浮工件台的位移方向和距离信息,六维坐标导出单元输出磁浮工件台的六维位姿信息;
所述的六维坐标导出单元包括:数字信号处理芯片和两个单片机,其中:传感器组的每个微图像位移传感器分别与第一单片机相连传输每个微图像位移传感器所在点的位移方向和距离信息,第一单片机与第二单片机相连传输每个微图像位移传感器所在点的位移方向和距离信息,传感器组的每个激光位移传感器分别与第二单片机相连传输每个激光位移传感器所在点的位移方向和距离信息,第二单片机与数字信号处理芯片相连传输每个微图像位移传感器和每个激光位移传感器所在点的位移方向和距离信息,数字信号处理芯片输出磁浮工件台的六维位姿信息。
2.根据权利要求1所述的全光电式磁浮工件台六维位姿测量***,其特征是,所述的微图像位移传感器包括:发光器件、两个光学透镜、数字微成像器和数字接口电路,其中:第一光学透镜位于发光器件正前方,第一光学透镜和发光器件的光轴重合,第二光学透镜位于数字微成像器输入端正前方,第二光学透镜和数字微成像器的光轴重合,第一光学透镜透射出的光束反射后射入第二光学透镜,数字微成像器与数字接口电路相连传输磁浮工件台的位移方向和距离信息,数字接口电路与六维坐标导出单元相连传输磁浮工件台的位移方向和距离信息。
3.根据权利要求1所述的全光电式磁浮工件台六维位姿测量***,其特征是,所述的第二单片机是高性能模拟信号处理单片机。
4.根据权利要求1所述的全光电式磁浮工件台六维位姿测量***,其特征是,所述的传感器组包括:两个微图像位移传感器和三个激光位移传感器,其中:每个微图像位移传感器和每个激光位移传感器分别固定于磁浮工件台上,每个微图像位移传感器的输入端和每个激光位移传感器的输入端分别采集其所在点的位移方向和距离信息,每个微图像位移传感器的输出端和每个激光位移传感器的输出端分别与六维坐标导出单元相连传输磁浮工件台的位移方向和距离信息。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN2009103116460A CN101738163B (zh) | 2009-12-17 | 2009-12-17 | 全光电式磁浮工件台六维位姿测量*** |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN2009103116460A CN101738163B (zh) | 2009-12-17 | 2009-12-17 | 全光电式磁浮工件台六维位姿测量*** |
Publications (2)
Publication Number | Publication Date |
---|---|
CN101738163A CN101738163A (zh) | 2010-06-16 |
CN101738163B true CN101738163B (zh) | 2011-06-08 |
Family
ID=42461943
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN2009103116460A Expired - Fee Related CN101738163B (zh) | 2009-12-17 | 2009-12-17 | 全光电式磁浮工件台六维位姿测量*** |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN101738163B (zh) |
Families Citing this family (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN103292706B (zh) * | 2013-04-27 | 2015-12-23 | 清华大学 | 动圈式平面电机动子三自由度位移测量方法 |
CN103292707B (zh) * | 2013-04-27 | 2016-02-03 | 清华大学 | 一种动圈式平面电机动子三自由度位移测量方法 |
CN105162361A (zh) * | 2015-07-21 | 2015-12-16 | 陈巨根 | 低功耗永磁力控制*** |
CN105549332B (zh) * | 2016-01-14 | 2017-11-03 | 哈尔滨工业大学 | 一种工件台三自由度位移测量方法 |
CN113028987A (zh) * | 2021-03-03 | 2021-06-25 | 中国科学院光电技术研究所 | 一种基于激光测距仪的高精度六自由度测量方法及装置 |
-
2009
- 2009-12-17 CN CN2009103116460A patent/CN101738163B/zh not_active Expired - Fee Related
Also Published As
Publication number | Publication date |
---|---|
CN101738163A (zh) | 2010-06-16 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN108267095B (zh) | 自由曲面形貌双边错位差动共焦检测方法与装置 | |
CN101738163B (zh) | 全光电式磁浮工件台六维位姿测量*** | |
CN104596418B (zh) | 一种多机械臂***坐标系标定及精度补偿方法 | |
US4908951A (en) | Coordinate measuring and testing machine | |
TWI579123B (zh) | 機器人校正系統與方法 | |
CN106352823B (zh) | 一种基于多瞄准装置的复合坐标测量*** | |
CN108362221B (zh) | 一种自由曲面形貌纳米精度检测方法与装置 | |
CN100350213C (zh) | 具有双传感器***的探针 | |
CN102410836B (zh) | 基于二维位置敏感传感器的空间六自由度物体定位*** | |
CN103604376A (zh) | 抗光学混叠的双频激光光栅干涉三维测量方法及*** | |
CN107782244B (zh) | 一种基于视觉的六自由度小位移检测方法 | |
CN205192445U (zh) | 一种光学三维成像装置 | |
CN202975814U (zh) | 一种立体视觉空间动态跟踪装置 | |
CN108760025B (zh) | 多柔性板振动检测装置及方法 | |
CN102589448A (zh) | 高精度六自由度位姿监测装置 | |
CN103336588B (zh) | 一种激光跟踪式无线三维鼠标 | |
CN116428955A (zh) | 三自由度霍尔位移传感器标定***和方法 | |
CN205607402U (zh) | 基于一维运动机构和二维位置传感器的六自由度定位*** | |
DE3867797D1 (de) | Beruehrungsloses messsystem fuer genauigkeitskenngroessen, insbesondere von industrierobotern. | |
CN105865443A (zh) | 基于一维运动机构和二维位置传感器的六自由度定位*** | |
KR920003740B1 (ko) | 3차원 직교좌표형 고속정밀측정기 | |
CN113352334A (zh) | 一种移动柔性扫描机器人*** | |
CN208847328U (zh) | 多柔性板振动检测装置 | |
CN107367221A (zh) | 超声波电机驱动主从结构电感传感器校准方法与装置 | |
Lu et al. | Double position sensitive detectors (PSDs) based measurement system of trajectory tracking of a moving target |
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: 20110608 Termination date: 20131217 |