CN101738163A - 全光电式磁浮工件台六维位姿测量系统 - Google Patents

全光电式磁浮工件台六维位姿测量系统 Download PDF

Info

Publication number
CN101738163A
CN101738163A CN200910311646A CN200910311646A CN101738163A CN 101738163 A CN101738163 A CN 101738163A CN 200910311646 A CN200910311646 A CN 200910311646A CN 200910311646 A CN200910311646 A CN 200910311646A CN 101738163 A CN101738163 A CN 101738163A
Authority
CN
China
Prior art keywords
magnetic suspension
workpiece table
suspension workpiece
displacement
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.)
Granted
Application number
CN200910311646A
Other languages
English (en)
Other versions
CN101738163B (zh
Inventor
曹家勇
王石刚
冯磊
董汉成
朱文
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Shanghai Jiaotong University
Original Assignee
Shanghai Jiaotong University
Priority date (The priority date 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 date listed.)
Filing date
Publication date
Application filed by Shanghai Jiaotong University filed Critical Shanghai Jiaotong University
Priority to CN2009103116460A priority Critical patent/CN101738163B/zh
Publication of CN101738163A publication Critical patent/CN101738163A/zh
Application granted granted Critical
Publication of CN101738163B publication Critical patent/CN101738163B/zh
Expired - Fee Related legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

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所述的全光电式磁浮工件台六维位姿测量系统，其特征是，所述的传感器组包括：两个微图像位移传感器和三个激光位移传感器，其中：每个微图像位移传感器和每个激光位移传感器分别固定于磁浮工件台上，每个微图像位移传感器的输入端和每个激光位移传感器的输入端分别采集其所在点的位移方向和距离信息，每个微图像位移传感器的输出端和每个激光位移传感器的输出端分别与六维坐标导出单元相连传输磁浮工件台的位移方向和距离信息。
CN2009103116460A 2009-12-17 2009-12-17 全光电式磁浮工件台六维位姿测量系统 Expired - Fee Related CN101738163B (zh)

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 true CN101738163A (zh) 2010-06-16
CN101738163B 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)

Cited By (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN103292707A (zh) * 2013-04-27 2013-09-11 清华大学 一种动圈式平面电机动子三自由度位移测量方法
CN103292706A (zh) * 2013-04-27 2013-09-11 清华大学 动圈式平面电机动子三自由度位移测量方法
CN105162361A (zh) * 2015-07-21 2015-12-16 陈巨根 低功耗永磁力控制系统
CN105549332A (zh) * 2016-01-14 2016-05-04 哈尔滨工业大学 一种工件台三自由度位移测量方法
CN113028987A (zh) * 2021-03-03 2021-06-25 中国科学院光电技术研究所 一种基于激光测距仪的高精度六自由度测量方法及装置

Cited By (8)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN103292707A (zh) * 2013-04-27 2013-09-11 清华大学 一种动圈式平面电机动子三自由度位移测量方法
CN103292706A (zh) * 2013-04-27 2013-09-11 清华大学 动圈式平面电机动子三自由度位移测量方法
CN103292706B (zh) * 2013-04-27 2015-12-23 清华大学 动圈式平面电机动子三自由度位移测量方法
CN103292707B (zh) * 2013-04-27 2016-02-03 清华大学 一种动圈式平面电机动子三自由度位移测量方法
CN105162361A (zh) * 2015-07-21 2015-12-16 陈巨根 低功耗永磁力控制系统
CN105549332A (zh) * 2016-01-14 2016-05-04 哈尔滨工业大学 一种工件台三自由度位移测量方法
CN105549332B (zh) * 2016-01-14 2017-11-03 哈尔滨工业大学 一种工件台三自由度位移测量方法
CN113028987A (zh) * 2021-03-03 2021-06-25 中国科学院光电技术研究所 一种基于激光测距仪的高精度六自由度测量方法及装置

Also Published As

Publication number Publication date
CN101738163B (zh) 2011-06-08

Similar Documents

Publication Publication Date Title
CN108267095B (zh) 自由曲面形貌双边错位差动共焦检测方法与装置
CN101738163B (zh) 全光电式磁浮工件台六维位姿测量系统
CN104596418B (zh) 一种多机械臂系统坐标系标定及精度补偿方法
TWI579123B (zh) 機器人校正系統與方法
USRE33774E (en) Coordinate measuring and testing machine
CN106352823B (zh) 一种基于多瞄准装置的复合坐标测量系统
CN107957626B (zh) 一种面向光学镜片的六自由度并联自动调偏系统及方法
CN108362221B (zh) 一种自由曲面形貌纳米精度检测方法与装置
CN102410836A (zh) 基于二维位置敏感传感器的空间六自由度物体定位系统
CN107398926B (zh) 一种基于末端视觉检测的柔性臂振动测量装置及方法
CN105806309A (zh) 基于激光三角测距的机器人零位标定系统与方法
CN1720427A (zh) 用于高速扫描的探针
CA1336532C (en) Probe motion guiding device, position sensing apparatus and position sensing method
CN205192445U (zh) 一种光学三维成像装置
CN202975814U (zh) 一种立体视觉空间动态跟踪装置
CN111026166A (zh) 平面二自由度宏微复合定位系统及控制方法
CN1387021A (zh) 一种二维位移工作台
CN103336588B (zh) 一种激光跟踪式无线三维鼠标
CN116428955A (zh) 三自由度霍尔位移传感器标定系统和方法
CN208117874U (zh) 一种机械手定位装置
CN114216396B (zh) 一种基于激光干涉仪的复眼单元运动误差测量装置
DE3867797D1 (de) Beruehrungsloses messsystem fuer genauigkeitskenngroessen, insbesondere von industrierobotern.
KR920003740B1 (ko) 3차원 직교좌표형 고속정밀측정기
CN208847328U (zh) 多柔性板振动检测装置
CN107367221A (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: 20110608

Termination date: 20131217