CN105508823B - 一种柔性六自由度并联精密调整装置运动控制方法 - Google Patents
一种柔性六自由度并联精密调整装置运动控制方法 Download PDFInfo
- Publication number
- CN105508823B CN105508823B CN201510962184.4A CN201510962184A CN105508823B CN 105508823 B CN105508823 B CN 105508823B CN 201510962184 A CN201510962184 A CN 201510962184A CN 105508823 B CN105508823 B CN 105508823B
- Authority
- CN
- China
- Prior art keywords
- flexible
- leg
- motion
- adjusting apparatus
- degree
- 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.)
- Active
Links
- 230000033001 locomotion Effects 0.000 title claims abstract description 50
- 238000000034 method Methods 0.000 title claims abstract description 36
- 238000006073 displacement reaction Methods 0.000 claims abstract description 39
- 230000008859 change Effects 0.000 claims abstract description 14
- 230000009471 action Effects 0.000 claims description 7
- 238000004458 analytical method Methods 0.000 claims description 3
- 230000005540 biological transmission Effects 0.000 claims 1
- 230000007246 mechanism Effects 0.000 abstract description 12
- 230000003321 amplification Effects 0.000 abstract 1
- 230000000694 effects Effects 0.000 abstract 1
- 238000003199 nucleic acid amplification method Methods 0.000 abstract 1
- 238000004364 calculation method Methods 0.000 description 3
- 230000005611 electricity Effects 0.000 description 3
- 230000007812 deficiency Effects 0.000 description 2
- 238000010586 diagram Methods 0.000 description 2
- 238000005516 engineering process Methods 0.000 description 2
- 230000004044 response Effects 0.000 description 2
- 230000009286 beneficial effect Effects 0.000 description 1
- 238000000205 computational method Methods 0.000 description 1
- 239000011159 matrix material Substances 0.000 description 1
- 238000005259 measurement Methods 0.000 description 1
- 230000003287 optical effect Effects 0.000 description 1
- 239000004065 semiconductor Substances 0.000 description 1
- 239000003351 stiffener Substances 0.000 description 1
- 230000009466 transformation Effects 0.000 description 1
Classifications
-
- F—MECHANICAL ENGINEERING; LIGHTING; HEATING; WEAPONS; BLASTING
- F16—ENGINEERING ELEMENTS AND UNITS; GENERAL MEASURES FOR PRODUCING AND MAINTAINING EFFECTIVE FUNCTIONING OF MACHINES OR INSTALLATIONS; THERMAL INSULATION IN GENERAL
- F16M—FRAMES, CASINGS OR BEDS OF ENGINES, MACHINES OR APPARATUS, NOT SPECIFIC TO ENGINES, MACHINES OR APPARATUS PROVIDED FOR ELSEWHERE; STANDS; SUPPORTS
- F16M11/00—Stands or trestles as supports for apparatus or articles placed thereon ; Stands for scientific apparatus such as gravitational force meters
- F16M11/02—Heads
- F16M11/04—Means for attachment of apparatus; Means allowing adjustment of the apparatus relatively to the stand
Landscapes
- Engineering & Computer Science (AREA)
- General Engineering & Computer Science (AREA)
- Mechanical Engineering (AREA)
- Control Of Position Or Direction (AREA)
Abstract
本发明一种基于柔性片体的六自由度并联精密调整装置的运动控制方法,属于机械精密仪器控制领域,实现了使并联精密调整装置的运动平台获得准确的位置和姿态;本发明的运动控制方法基于柔性六自由度并联精密调整装置,柔性六自由度并联精密调整装置中每个柔性腿内部采用运动缩小机构的并联调整机构,每个柔性腿上的直线驱动电机与腿长变化的成一定比例,直线位移传感器与腿长变化的成一定比例,直线驱动电机作为驱动系统,直线位移传感器作为反馈系统,驱动系统和反馈系统构成了半闭环控制系统;本发明适用于多组基于柔性片体的具有运动缩小或运动放大作用的柔性腿并联而成的机构,工作效率高,调整快,定位精准。
Description
技术领域
本发明属于机械精密仪器控制领域,具体涉及一种柔性六自由度并联精密调整装置运动控制方法。
背景技术
并联调整机构与串联调整机构相比,具有负载大、精确定位能力好、稳定性高等优点,所以并联调整机构越来越多的应用于光学组件定位、精密/超精密加工、半导体器件制造、精密检测等研究领域。传统并联调整机构的运动副通过刚性元件的相对运动实现转向功能,但是存在回程间隙与摩擦,这对定位精度和调整分辨率是不利的,柔性六自由度并联精密调整装置通过多组柔性腿的协调运动实现运动平台的位置定位以及姿态的调整,基于柔性六自由度并联精密调整装置的柔性片体的铰链有效地克服了传统并联调整机构存在的技术缺陷,更多的应用于微纳米调整的并联机构中。
但是柔性六自由度并联精密调整装置的运动控制难度增加了,同时需要高效的解算方法和控制方法使运动平台快速响应,以实现平台位置定位和姿态的调整。
发明内容
本发明的目的是提供一种柔性六自由度并联精密调整装置运动控制方法,解决现有技术存在的平台运动难于控制的技术缺陷,并提出高效的解算方法和控制方法实现运动平台快速响应和精确定位。
本发明一种柔性六自由度并联精密调整装置运动控制方法,本发法所涉及的柔性六自由度并联精密调整装置包括运动平台、基座平台和六个柔性腿;六个柔性腿分布在运动平台与基座平台之间;每个柔性腿的两端分别设有柔性片体,且设有驱动柔性腿运动的直线驱动电机以及用于检测柔性腿位移的直线位移传感器;
本方法包括以下步骤:
步骤一:通过速度瞬心法或有限元分析法分别计算出每个柔性腿上的直线驱动电机与柔性腿的腿长变化的传动比和直线位移传感器与柔性腿的腿长变化的传动比;
步骤二:将柔性片体等效为理想运动副,建立柔性六自由度并联精密调整装置的等效模型,并以基座平台为原点建立空间直角坐标系;
步骤三:求解运动平台运动到目标位置和姿态;通过逆解的方法求解出各个柔性腿的变化,进而确定直线驱动电机的位移参数以及直线位移传感器的反馈值;
步骤四:根据各个柔性腿上直线位移传感器反馈值,各个柔性腿上的直线驱动电机执行驱动位移的动作,循环此动作,直至直线位移传感器反馈值进入阈值范围内。
本发明的有益效果:本发明的运动控制方法基于柔性六自由度并联精密调整装置,柔性六自由度并联精密调整装置中每个柔性腿内部采用运动缩小机构的并联调整机构,每个柔性腿上的直线驱动电机与腿长变化的成一定比例,直线位移传感器与腿长变化的成一定比例,直线驱动电机作为驱动系统,直线位移传感器作为反馈系统,驱动系统和反馈系统构成了半闭环控制系统;本发明适用于多组基于柔性片体的具有运动缩小或运动放大作用的柔性腿并联而成的机构,工作效率高,调整快,定位精准。
附图说明
图1为本发明一种柔性六自由度并联精密调整装置运动控制方法中柔性六自由度并联精密调整装置的结构示意图;
图2为本发明一种柔性六自由度并联精密调整装置运动控制方法中柔性六自由度并联精密调整装置的等效模型示意图;
图3为本发明一种柔性六自由度并联精密调整装置运动控制方法中柔性六自由度并联精密调整装置的另一等效模型示意图;
图4为本发明一种柔性六自由度并联精密调整装置运动控制方法的流程图;
其中,1、运动平台,2、基座平台,3、柔性片体,4、直线驱动电机,5、直线位移传感器。
具体实施方式
下面结合附图对本发明作进一步阐述。
具体实施例一:
参见附图1、附图2、附图3和附图4,本发明一种柔性六自由度并联精密调整装置运动控制方法,本发法所涉及的柔性六自由度并联精密调整装置包括运动平台1、基座平台2和六个柔性腿;六个柔性腿分布在运动平台1与基座平台2之间;每个柔性腿的两端分别设有柔性片体3,且设有驱动柔性腿运动的直线驱动电机4以及用于检测柔性腿位移的直线位移传感器5;
本方法包括以下步骤:
步骤一:通过速度瞬心法或有限元分析法分别计算出电机与柔性腿的腿长变化的传动比和直线位移传感器5与柔性腿的腿长变化的传动比;
步骤二:将柔性片体3等效为理想运动副,建立柔性六自由度并联精密调整装置的等效模型,并以基座平台2为原点建立空间直角坐标系;
步骤三:求解运动平台1运动到目标位置和姿态;通过逆解的方法求解出各个柔性腿的变化,进而确定直线驱动电机4的位移参数以及直线位移传感器5的反馈值;
步骤四:根据各个柔性腿上直线位移传感器5反馈值,各个柔性腿上的直线驱动电机4执行驱动位移的动作,循环此动作,直至直线位移传感器5反馈值进入阈值范围内。
具体实施例二:
本发明一种柔性六自由度并联精密调整装置运动控制方法,包括以下步骤:
步骤一:通过速度瞬心法或有限元分析方法计算出各个柔性腿腿长的直线直线驱动电机4的位移与柔性腿腿长长变化的传动比以及直线位移传感器5反馈值与腿长变化的传动比;
步骤二::将柔性片体3等效为理想运动副,建立柔性六自由度并联精密调整装置的等效模型,并以基座平台2为原点建立空间直角坐标系XboYbZb,等效模型中A1-A6、B1-B6为等效的万向铰,R为万向铰B1-B6的分布圆直径,r为万向铰A1-A6的分布圆直径,h为等效并联机构模型运动平台1的高度,l为等效并联机构模型的腿长;
步骤三:求解运动平台1运动到目标位置和姿态,通过逆解的方法求解出各个柔性腿的变化,进而确定直线驱动电机4的驱动位移以及直线位移传感器5的反馈值;其中逆解算法为设运动平台坐标系原点沿基座平台2坐标系XboYbZb的Xb、Yb、Zb轴的移动量分别为xp、yp、zp,绕Xb、Yb、Zb轴的转动角度为分别为α、β、γ,得出逆解算的等式:
其中:为A1~A6在基座平台2坐标系{B}:Ob-XbYbZb下的坐标矢量,为A1~A6在运动平台1坐标系{P}:Op-XpYpZp下的坐标矢量,{P}:Op-XpYpZp相对于{B}:Ob-XbYbZb的旋转变换矩阵为R:
各支链长度l'及变化量Δl为:其中各支链长度指模型中等效的各腿长,并且是姿态变化后的各等效腿长;变化量指的是各等效腿长相对于姿态没变化之前的各腿长的变化量。
Δli=l'i-li
步骤四:各个柔性腿的直线驱动电机4采集对应的直线位移传感器5的反馈值,若反馈值进入直线位移传感器5的阈值范围内,直线驱动电机4停止驱动,否则根据当前值与目标值之差,计算出直线驱动电机4还需要的驱动的位移并执行,循环此动作,直至直线位移传感器5反馈值进入阈值范围内,根据此方法依次驱动其余电机,从而完成对运动平台1精确定位。其中直线驱动电机还需要的驱动位移的计算方法如下:已知需要的姿态,然后解算出各个腿长的变化量,再根据传动比计算出直线驱动电机的驱动位移。
Claims (1)
1.一种柔性六自由度并联精密调整装置运动控制方法,本发法所涉及的柔性六自由度并联精密调整装置包括运动平台(1)、基座平台(2)和六个柔性腿;六个柔性腿分布在运动平台(1)与基座平台(2)之间;每个柔性腿的两端分别设有柔性片体(3),且设有驱动柔性腿运动的直线驱动电机(4)以及用于检测柔性腿位移的直线位移传感器(5);其特征在于,
本方法包括以下步骤:
步骤一:通过速度瞬心法或有限元分析法分别计算出电机与柔性腿的腿长变化的传动比和直线位移传感器(5)与柔性腿的腿长变化的传动比;
步骤二:将柔性片体(3)等效为理想运动副,建立柔性六自由度并联精密调整装置的等效模型,并以基座平台(2)为原点建立空间直角坐标系;
步骤三:求解运动平台(1)运动到目标位置和姿态;通过逆解的方法求解出各个柔性腿的变化,进而确定各个柔性腿上的直线驱动电机(4)的位移参数以及直线位移传感器(5)的反馈值;
步骤四:根据各个柔性腿上直线位移传感器(5)反馈值,各个柔性腿上的直线驱动电机(4)执行驱动位移的动作,循环此动作,直至直线位移传感器(5)反馈值进入阈值范围内。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201510962184.4A CN105508823B (zh) | 2015-12-21 | 2015-12-21 | 一种柔性六自由度并联精密调整装置运动控制方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201510962184.4A CN105508823B (zh) | 2015-12-21 | 2015-12-21 | 一种柔性六自由度并联精密调整装置运动控制方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN105508823A CN105508823A (zh) | 2016-04-20 |
CN105508823B true CN105508823B (zh) | 2017-10-31 |
Family
ID=55717015
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201510962184.4A Active CN105508823B (zh) | 2015-12-21 | 2015-12-21 | 一种柔性六自由度并联精密调整装置运动控制方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN105508823B (zh) |
Families Citing this family (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN110095138B (zh) * | 2019-06-03 | 2021-01-12 | 磐翼信息科技(上海)有限公司 | 一种柔性管线空间走向标定台架 |
CN113655814B (zh) * | 2021-10-21 | 2022-02-08 | 气味王国(山东)科技有限公司 | 一种喷嘴方位矢量调控结构 |
CN113931828B (zh) * | 2021-10-21 | 2023-06-23 | 气味王国(山东)科技有限公司 | 一种气腔压缩体积可调的气味涡圈高频喷射器动力装置 |
CN116374191B (zh) * | 2023-06-02 | 2023-12-29 | 成都国营锦江机器厂 | 一种直升机尾梁自动安装方法及系统 |
Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US6330837B1 (en) * | 1997-08-28 | 2001-12-18 | Microdexterity Systems, Inc. | Parallel mechanism |
CN101116968A (zh) * | 2007-09-06 | 2008-02-06 | 上海交通大学 | 六维力传感器装配机械手姿态及力的控制方法 |
CN102486250A (zh) * | 2010-12-03 | 2012-06-06 | 西安金和光学科技有限公司 | 六自由度姿态调整平台 |
CN104793646A (zh) * | 2015-04-20 | 2015-07-22 | 中国科学院长春光学精密机械与物理研究所 | 一种基于柔性片体的六自由度并联精密调整装置 |
Family Cites Families (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
FR2628670B1 (fr) * | 1988-03-21 | 1990-08-17 | Inst Nat Rech Inf Automat | Dispositif articule, notamment utilisable dans le domaine de la robotique |
US5028180A (en) * | 1989-09-01 | 1991-07-02 | Sheldon Paul C | Six-axis machine tool |
-
2015
- 2015-12-21 CN CN201510962184.4A patent/CN105508823B/zh active Active
Patent Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US6330837B1 (en) * | 1997-08-28 | 2001-12-18 | Microdexterity Systems, Inc. | Parallel mechanism |
CN101116968A (zh) * | 2007-09-06 | 2008-02-06 | 上海交通大学 | 六维力传感器装配机械手姿态及力的控制方法 |
CN102486250A (zh) * | 2010-12-03 | 2012-06-06 | 西安金和光学科技有限公司 | 六自由度姿态调整平台 |
CN104793646A (zh) * | 2015-04-20 | 2015-07-22 | 中国科学院长春光学精密机械与物理研究所 | 一种基于柔性片体的六自由度并联精密调整装置 |
Non-Patent Citations (2)
Title |
---|
六自由度微动并联机器人工作空间分析;郭本银等;《长春理工大学学报(自然科学版)》;20150831;第38卷(第4期);第1-5页 * |
同步辐射光束线六杆并联机构的逆运动学精确求解及应用;李勇军等;《核技术》;20080731;第31卷(第7期);第485-488页 * |
Also Published As
Publication number | Publication date |
---|---|
CN105508823A (zh) | 2016-04-20 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN105508823B (zh) | 一种柔性六自由度并联精密调整装置运动控制方法 | |
CN108161896B (zh) | 6-pss并联机构 | |
CN103425100B (zh) | 基于力矩平衡的机器人直接示教控制方法 | |
CN106994686A (zh) | 关节外力力矩的计算方法及装置、机器人 | |
US11780085B2 (en) | Robot posture control method and robot and computer readable storage medium using the same | |
JP2010524548A5 (zh) | ||
CN106233214B (zh) | 补偿机器人运动偏差 | |
CN103792956B (zh) | 智能臂空间运动控制方法及装置 | |
US20170259427A1 (en) | Robotic systems for supporting a user | |
CN106808484A (zh) | 挠曲测量系统 | |
CN107662205A (zh) | 机器人及其关节运动控制方法和装置 | |
CN105938364A (zh) | 一种3d欠驱动双足机器人的动力学模型计算方法 | |
CN105459114A (zh) | 冗余驱动并联机构驱动力优化方法及轴组控制验证平台 | |
CN105320057A (zh) | 基于坐标转换矩阵的双振动台同步运动控制方法 | |
CN104977816B (zh) | 基于Compact Particle Swarm Optimization算法的光刻机掩模台微动台的机械参数软测量方法 | |
JP5869991B2 (ja) | 駆動装置 | |
CN102722086B (zh) | 一种无接触式单自由度定位装置及其同步运动控制方法 | |
CN108714887B (zh) | 具有三自由度空间并联机构 | |
CN105486340B (zh) | 一种多功能手指传感器标定工装 | |
CN114859698A (zh) | 一种6-3-pus并联机构的轨迹跟踪控制方法及装置 | |
CN201323018Y (zh) | 摆杆重心扰动倒立摆装置 | |
CN106446481B (zh) | 含柔性运动副欠驱动机构运动学、动力学求解方法 | |
RU2487008C1 (ru) | Электропривод манипулятора | |
CN108081240A (zh) | 一种气动肌肉气缸并联平台 | |
Chen et al. | On the motion of a reconstructed ancient Chinese wooden horse carriage |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
C06 | Publication | ||
PB01 | Publication | ||
C10 | Entry into substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
GR01 | Patent grant | ||
GR01 | Patent grant |