CN102012690B - 基于正解的五自由度纯并联机床断电后寻址及回零的控制方法 - Google Patents
基于正解的五自由度纯并联机床断电后寻址及回零的控制方法 Download PDFInfo
- Publication number
- CN102012690B CN102012690B CN2010105521401A CN201010552140A CN102012690B CN 102012690 B CN102012690 B CN 102012690B CN 2010105521401 A CN2010105521401 A CN 2010105521401A CN 201010552140 A CN201010552140 A CN 201010552140A CN 102012690 B CN102012690 B CN 102012690B
- Authority
- CN
- China
- Prior art keywords
- hooke
- hinge
- lathe
- rod
- control method
- 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
Classifications
-
- Y—GENERAL TAGGING OF NEW TECHNOLOGICAL DEVELOPMENTS; GENERAL TAGGING OF CROSS-SECTIONAL TECHNOLOGIES SPANNING OVER SEVERAL SECTIONS OF THE IPC; TECHNICAL SUBJECTS COVERED BY FORMER USPC CROSS-REFERENCE ART COLLECTIONS [XRACs] AND DIGESTS
- Y02—TECHNOLOGIES OR APPLICATIONS FOR MITIGATION OR ADAPTATION AGAINST CLIMATE CHANGE
- Y02P—CLIMATE CHANGE MITIGATION TECHNOLOGIES IN THE PRODUCTION OR PROCESSING OF GOODS
- Y02P70/00—Climate change mitigation technologies in the production process for final industrial or consumer products
- Y02P70/10—Greenhouse gas [GHG] capture, material saving, heat recovery or other energy efficient measures, e.g. motor control, characterised by manufacturing processes, e.g. for rolling metal or metal working
Landscapes
- Automatic Control Of Machine Tools (AREA)
Abstract
本发明公开一种基于正解的五自由度纯并联机床断电后寻址及回零的控制方法,该控制方法将五杆五环并联机床的结构几何参数、杆件姿态、主轴上一固定点和主轴在空间中位姿的数学模型形成一一对应的函数关系,从而建立正解控制模型,适应于任何采用环形铰链的并联机床。本发明的优点是解决了机床刀具主轴实时位姿的判定,断电后的寻址及机床回零的问题。
Description
技术领域
本发明涉及一种五自由度纯并联机床,特别涉及一种基于正解的五自由度纯并联机床断电后寻址及回零的控制方法。
背景技术
并联机床以其高刚度、高精度和高承载能力等特性而备受关注。在并联机床现存的许多问题中,三自由度以上的并联机床位置正解一直是个难题,而位置正解又是解决机床失电后正确判断动平台位姿以及机床回零的最直接的方法。
由于并联机床结构的特点,机床逆解比较容易获得,而正解往往没有解析解或存在多解。因而目前五自由度纯并联机床的回零方法一般采用基于并联机床逆解的栅格回零法,即控制并联机床各驱动杆回到各自的零位;而并联机床遇到中途断电刀具主轴(动平台)的位姿要靠实际仪器当场测量,不仅操作困难,而且误差大。
发明内容
本发明所要解决的技术问题是针对具有环型铰链的五自由度纯并联机床,提出一种基于正解的判定机床刀具主轴(动平台)实时位姿的控制方法,该控制方法同时解决了断电后寻址及机床回零的问题,是该种并联机床数控系统的内核部分。控制方法将五杆五环并联机床结构几何参数、杆件姿态和刀具主轴在空间中的位姿形成一一对应的函数关系,该方法可用于机床刀具主轴(动平台)运动时实时位姿的在线检测,当机床发生断电,信息丢失的情况时,接通电源后用该方法可以识别刀具主轴当前位姿,并帮助机床回到零点。
本发明的控制方法包括如下的步骤:
(1)建立控制模型,该控制模型将五杆五环并联机床结构几何参数、杆件姿态、主轴在空间中的位姿形成一一对应的函数关系。
其中:
②正解的数学模型中各已知参数的获取:
本发明中涉及到的参数比较多,主要有两大类:机床处于初始状态时各初始尺寸值,称为固定值,实时变化值称为变量。
固定值由机床装配完成后直接测量获得。
变量由绝对坐标传感器直接测量或转换获得;五根杆中任意选取两根杆作为测量对象,在两根杆虎克铰的固定轴和转动轴上分别设有多个角度传感器,在两根杆件的杆底设有线位移传感器,并在机床顶部安装激光跟踪仪;
;
;
其中:
----推杆与虎克铰转环的铰接点,变量,由以上算式转换获得;
(2)断电后寻址:
(3)机床回零路径是由机床的逆解控制模型决定,但回零路径起点是根据刀具主轴的当前姿态获得的。由正解获得的当前点作为回零路径的起点写入上位PC机,由上位PC机将回零路径算式写入运动控制卡;
(4)运动控制卡输出控制信号至伺服控制系统,从而控制机床回零。
本发明的优越功效在于:
1.本发明提出了一种五自由度纯并联机床的正解控制方法,该控制方法能够解决并联机床刀具主轴(动平台)实时位姿的判定、断电后寻址及机床的回零等问题;
2.控制方法将五杆五环并联机床的结构几何参数、杆件姿态和主轴在空间中的位姿形成一一对应的解析关系,极大程度地减少了误差。该正解控制方法是一种解决环型并联机床刀具主轴(动平台)实时位姿的判定、断电后的寻址及机床的回零等问题最直接的方法。
附图说明
图1为本发明算法所针对的五杆五环并联机床的结构示意图;
图2为正解原理图;
图3为确定通过主轴中心线的平面的三点获得示意图;
图4为动坐标系变换示意图;
图5为动静坐标系在空间中的分布图;
图6为传感器安装图;
图中标号说明
1—虎克铰; 2—机床;
3—激光跟踪仪; 4—角度传感器a;
5—角度传感器b; 6—角度传感器c;
7—角度传感器d; 8—线位移传感器。
具体实施方式
下面结合具体的实物样机(涉及尺寸均为样机上的实测值)对本发明作进一步说明:
如图1-图6所示,本发明需在五根杆中任意选择两根杆作为测量对象,现选取杆件、作为测量对象。在杆件虎克铰2的固定轴上设有角度传感器4a、转动轴上设有角度传感器5b,在杆件虎克铰4的固定轴上设有角度传感器6c、转动轴上设有角度传感器7d,在杆件、的杆底设有线位移传感器8,并在机床2顶部安装激光跟踪仪3。
本发明的控制方法包括如下的步骤:
(1)建立控制模型,该控制模型将五杆五环并联机床结构几何参数、杆件姿态、主轴在空间中的位姿形成一一对应的函数关系。
其中:
②获取正解数学模型中的各个参数:
本发明中涉及到的参数比较多,主要有两大类:机床处于初始状态时各初始尺寸值,称为固定值,实时变化值称为变量。初始尺寸测量值,长度单位为“mm”、角度单位为“°”。
虎克铰2的局部坐标系与定坐标系之间的初始夹角,由机床装配后实测所得:
虎克铰4的局部坐标系与定坐标系之间的初始夹角,由机床装配后实测所得:
现将机床主轴(动平台)由原点任意动到另一个位置,得到实时测量值(长度单位为“mm”、角度单位为“°”):
到此所有测量值均已罗列完毕,现将以上各值代入以上各公式:
;
;
;
;
(2)将以上数据代入正解模型,可以计算出此时主轴的位姿坐标为
(3)将正解获得的当前点作为回零路径的起点写入上位PC机,由上位PC机将回零路径算式写入运动控制卡;
(4)运动控制卡输出控制信号至伺服控制系统,从而控制机床回零。
Claims (1)
1.一种基于正解的五自由度纯并联机床断电后寻址及回零的控制方法,五杆五环并联运动机床的数控系统是由运动控制卡分别与上位PC机、伺服控制系统双向连接而构成的,该控制方法的建立包括如下的步骤:
(1)建立控制模型,该控制模型将五杆五环并联运动机床结构几何参数、杆件姿态、主轴在空间中的位姿形成一一对应的函数关系;
②获取正解数学模型中的各个参数:
固定值由机床装配完成后直接测量获得;
变量由绝对坐标传感器直接测量或转换获得;五根杆中任意选取两根杆作为测量对象,在两根杆虎克铰的固定轴和转动轴上分别设有多个角度传感器,在两根杆件的杆底设有线位移传感器,并在机床顶部安装激光跟踪仪;
;
(2)断电后寻址:
(3)将正解获得的当前点作为回零路径的起点写入上位PC机,由上位PC机将回零路径算式写入运动控制卡;
(4)运动控制卡输出控制信号至伺服控制系统,从而控制机床回零。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN2010105521401A CN102012690B (zh) | 2010-11-22 | 2010-11-22 | 基于正解的五自由度纯并联机床断电后寻址及回零的控制方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN2010105521401A CN102012690B (zh) | 2010-11-22 | 2010-11-22 | 基于正解的五自由度纯并联机床断电后寻址及回零的控制方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN102012690A CN102012690A (zh) | 2011-04-13 |
CN102012690B true CN102012690B (zh) | 2012-06-06 |
Family
ID=43842883
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN2010105521401A Expired - Fee Related CN102012690B (zh) | 2010-11-22 | 2010-11-22 | 基于正解的五自由度纯并联机床断电后寻址及回零的控制方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN102012690B (zh) |
Families Citing this family (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN108015750A (zh) * | 2018-01-15 | 2018-05-11 | 上海联影医疗科技有限公司 | 医用机械臂 |
CN112318204B (zh) * | 2020-09-17 | 2022-03-01 | 珠海格力电器股份有限公司 | 一种机床机械零点寻回装置、方法和机床 |
CN114594681B (zh) * | 2020-12-07 | 2024-05-14 | 南京长峰航天电子科技有限公司 | 一种五自由度伺服控制系统及校准仪 |
Family Cites Families (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
DE19636102A1 (de) * | 1996-09-05 | 1998-03-12 | Fraunhofer Ges Forschung | Verfahren und Vorrichtung zur Steuerung der Bewegung eines Trägers |
DE19903613C1 (de) * | 1999-01-29 | 2000-12-07 | Fraunhofer Ges Forschung | Tripod-Lagerungseinrichtung und Verfahren zur Torsionskompensation |
CN101349908B (zh) * | 2008-08-29 | 2011-07-20 | 江门市科杰机械自动化有限公司 | 数控机床的数据分区方法 |
CN101587346B (zh) * | 2009-06-19 | 2011-06-22 | 同济大学 | 五杆五环并联运动机床加工的控制方法 |
-
2010
- 2010-11-22 CN CN2010105521401A patent/CN102012690B/zh not_active Expired - Fee Related
Also Published As
Publication number | Publication date |
---|---|
CN102012690A (zh) | 2011-04-13 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN107443382A (zh) | 工业机器人结构参数误差辨识与补偿方法 | |
CN105583824B (zh) | 力控牵引和摆位的多自由度机械臂控制装置及其控制方法 | |
Lei et al. | Double ballbar test for the rotary axes of five-axis CNC machine tools | |
CN204575030U (zh) | 三维激光全自动扫描测量系统 | |
CN105269404B (zh) | 数控机床刀尖动态特性精度检测装置及其方法 | |
CN102001021A (zh) | 五轴联动数控机床回转摆动轴几何误差参数值的测量方法 | |
US9423785B2 (en) | Tool trajectory display device having function for displaying inversion position of servo axis | |
CN107421442A (zh) | 一种外部测量辅助的机器人定位误差在线补偿方法 | |
CN102866030A (zh) | 一种五轴联动机床加载试验装置及加载试验方法 | |
CN101968344A (zh) | 数控加工中心在机三维形面检测系统 | |
CN102012690B (zh) | 基于正解的五自由度纯并联机床断电后寻址及回零的控制方法 | |
CN101634847B (zh) | 相贯线切割机可重构数控系统 | |
CN109352663A (zh) | 一种面向复合材料舱段的机器人自动精确定位制孔装置及方法 | |
CN108527441B (zh) | 一种用于检测工业机器人轨迹误差的装置 | |
CN105467927A (zh) | 一种基于配准对齐的免划线锻铸件加工定位方法 | |
CN110370271B (zh) | 工业串联机器人的关节传动比误差校准方法 | |
CN101804470A (zh) | 翼身对接自动制孔系统及方法 | |
CN109968402B (zh) | 回程间隙测量方法及控制方法、装置、系统和存储介质 | |
US7612516B2 (en) | Measuring method and system for CNC machine | |
CN109571481A (zh) | 一种关节奇异点处理方法、装置、设备和存储介质 | |
CN116400642B (zh) | 机床精度补偿方法、装置、存储介质及电子设备 | |
CN109373900A (zh) | 一种自驱动的关节臂坐标测量机 | |
CN102896446A (zh) | 海上石油平台精密切割控制系统 | |
CN104959872A (zh) | 五轴联动运动轨迹生成方法及基于该轨迹的精度测试方法 | |
CN113778018B (zh) | 一种基于R-test的五轴机床刀轴矢量误差测量方法 |
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 | ||
CF01 | Termination of patent right due to non-payment of annual fee |
Granted publication date: 20120606 Termination date: 20141122 |
|
EXPY | Termination of patent right or utility model |