CN107807612B - 基于四元数螺旋线球面插补法的数控机床球面加工方法 - Google Patents

基于四元数螺旋线球面插补法的数控机床球面加工方法 Download PDF

Info

Publication number
CN107807612B
CN107807612B CN201711318701.XA CN201711318701A CN107807612B CN 107807612 B CN107807612 B CN 107807612B CN 201711318701 A CN201711318701 A CN 201711318701A CN 107807612 B CN107807612 B CN 107807612B
Authority
CN
China
Prior art keywords
spherical surface
interpolation
numerical control
machine tool
spherical
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
Application number
CN201711318701.XA
Other languages
English (en)
Other versions
CN107807612A (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.)
Dalian Kede Numerical Control Co Ltd
Original Assignee
Dalian Kede Numerical Control Co Ltd
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 Dalian Kede Numerical Control Co Ltd filed Critical Dalian Kede Numerical Control Co Ltd
Priority to CN201711318701.XA priority Critical patent/CN107807612B/zh
Publication of CN107807612A publication Critical patent/CN107807612A/zh
Application granted granted Critical
Publication of CN107807612B publication Critical patent/CN107807612B/zh
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Classifications

    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05BCONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
    • G05B19/00Programme-control systems
    • G05B19/02Programme-control systems electric
    • G05B19/18Numerical control [NC], i.e. automatically operating machines, in particular machine tools, e.g. in a manufacturing environment, so as to execute positioning, movement or co-ordinated operations by means of programme data in numerical form
    • G05B19/41Numerical control [NC], i.e. automatically operating machines, in particular machine tools, e.g. in a manufacturing environment, so as to execute positioning, movement or co-ordinated operations by means of programme data in numerical form characterised by interpolation, e.g. the computation of intermediate points between programmed end points to define the path to be followed and the rate of travel along that path

Landscapes

  • Engineering & Computer Science (AREA)
  • Computing Systems (AREA)
  • Theoretical Computer Science (AREA)
  • Human Computer Interaction (AREA)
  • Manufacturing & Machinery (AREA)
  • Physics & Mathematics (AREA)
  • General Physics & Mathematics (AREA)
  • Automation & Control Theory (AREA)
  • Numerical Control (AREA)

Abstract

本发明公开了一种基于四元数螺旋线球面插补法的数控机床球面加工方法,包括如下步骤:S1、数控机床给定参数信息:加工球心坐标、加工球半径r、取球加工范围t以及螺纹生成圈数n;S2、将生成的球面螺旋线四元数化;S3、基于四元数法进行空间圆弧插补的原理对螺旋线从开始点每相邻两点间进行插补,直止结束点,完成整球面的螺旋线插补计算。S4、数控机床刀具移动到加工起点,基于S3的插值结果数控机床实现球面加工。本发明应用于球面插补场合,能够有效避免欧拉角存在的万向锁问题和旋转矩阵计算量过大的问题,从而提高五轴数控机床的加工效率和加工质量。

Description

基于四元数螺旋线球面插补法的数控机床球面加工方法
技术领域
本发明涉及一种五轴数控机床的球面加工,更具体地说,涉及球面的获取与加工。
背景技术
目前数控系统中,对于空间球面的加工,一般采用小线段逼近空间曲线的方法,但这种方法精度较差,并且计算量大、效率较低。本文,采用空间圆弧的插补方式,用空间圆弧逼近待加工的曲线。对于空间圆弧的和螺旋线的计算中,需要利用欧拉角进行旋转运动计算,但是欧拉角不利于插补运算,并且存在万向节锁定等问题。
此外,为了说明本发明的技术内容,如下背景需要描述:
一、整球面螺旋线
1、球面坐标
在空间中建立直角坐标系(笛卡尔坐标系)后,以
Figure GDA0002539510930000014
点为中心,|MN|=r为半径的球面上,θ为有向线段MN与z轴正向的夹角,
Figure GDA0002539510930000011
为从正z轴来看自x轴按逆时针方向转到MN所转过的角,如图1所示。
则在笛卡尔坐标系中球面点的坐标可以表示为:
Figure GDA0002539510930000012
2、球面螺旋线
螺旋线参数方程如下所示:
Figure GDA0002539510930000013
由公式2.1和2.2整理可以得到整球面螺旋线方程为:
Figure GDA0002539510930000021
二、对偶四元数
1、对偶数
对偶数如公式2.4定义所示,a为实数部分,b为对偶部分。
Figure GDA0002539510930000025
对偶向量是特殊的对偶数,其实数和对偶部分都为向量。单位对偶向量可以用来表示空间直线。
2、四元数
四元数由公式2.5定义所示,其中s是一个标量,v是一个三维向量。
q=[s,v]——式2.5
图2为,刀具绕旋转轴l,旋转角度为θ的示意图,可用四元数表示如公式2.6所示。旋转轴l[lx ly lz]为单位轴,则模长
Figure GDA0002539510930000022
为1。
q=[cos(θ/2),sin(θ/2)l]——式2.6
3、对偶四元数
对偶四元数可以有两种表现形式,如公式2.7所示为元素为四元数的对偶数,也可以如公式2.8所示为元素是对偶数的四元数。
Figure GDA0002539510930000023
Figure GDA0002539510930000024
对偶四元数的使用可以同时表示出刀具的平移和旋转,本文采取公式 2.8的表示形式。
发明内容
本发明应用于球面插补场合,能够有效避免欧拉角存在的万向锁问题和旋转矩阵计算量过大的问题,从而提高五轴数控机床的加工效率和加工质量。本发明采用球面螺旋线法生成所有加工球面的密集螺旋线,然后利用四元数插补法进行插补,本技术方案主要解决的问题在于以下几个方面:
1、球面螺旋线生成;
2、采用四元数法进行空间圆弧的插补。
为了达到上述目的,本发明提供了一种基于四元数螺旋线球面插补法的数控机床球面加工方法,包括如下步骤:
S1、数控机床给定参数信息:加工球心坐标M[Mx My Mz]、加工球半径 r、取球加工范围t以及螺纹生成圈数n,其中,当t=1时,加工整球面;
根据公式2.3生成球面螺旋线
Figure GDA0002539510930000031
S2、螺旋线四元数化
设q为四元数,绕Z轴旋转φ角度,绕Y轴旋转
Figure GDA0002539510930000032
角度,绕X轴旋转θ角度,
Figure GDA0002539510930000033
利用公式3.2,将生成的球面螺旋线四元数化
S3、基于四元数法进行空间圆弧插补的原理对螺旋线从开始点每相邻两点间进行插补,直止结束点,完成整球面的螺旋线插补计算,所述四元数法进行空间圆弧插补的原理为:
假设两个单位四元数p1和p2,参数u∈[0,1],则p1和p2旋转角度为uω,
可以推导出P(u)在p1和p2方向上的分量长度C1(u)和C2(u):
Figure GDA0002539510930000034
此时插值如下:
Figure GDA0002539510930000041
S4、数控机床刀具移动到加工起点,基于S3的插值结果数控机床实现球面加工。
对偶数可以表示刀具平移运动,四元数可以表示刀具的旋转运动。对偶四元数代替平移向量和旋转矩阵直观的表示出刀具的空间运动。空间球面的插补可以先利用螺旋线公式生成整球面的坐标值,然后将坐标值转换成四元数形式。本发明应用于球面插补场合,能够有效避免欧拉角存在的万向锁问题和旋转矩阵计算量过大的问题,从而提高五轴数控机床的加工效率和加工质量。
附图说明
图1是球面坐标示意图。
图2是刀具绕单位轴旋转示意图。
图3是球面螺旋线示意图。
图4是插补的相邻两点示意图。
图5是绕轴旋转角度示意图。
图6是两单位四元数插补示意图。
图7是本发明数控系统球面加工中进行球面插补的流程示意图。
具体实施方式
数控系统进行球面加工时,刀具移动到加工起点后,给定加工所需数值,根据公式2.3即可生成球面螺旋线。需要给定的默认值为,加工球心坐标,加工球半径,取球加工范围t(当t=1时,则加工整球面),螺纹生成圈数n。生成球面螺旋线示例,如图3。
实际上,图3所示的螺旋线是由间隔距离很短的点所形成的,因而在对螺旋线插补时,实际上是对相邻的两点进行插补。从开始点,每相邻两点间进行插补,一直到结束点为止,完成整球面的螺旋线插补。而插补点数量由t控制,每相邻两点用q(t1)和q(t2)表示,如图4所示。下文中,将用t1和t2做为参数来表示要进行插补的相邻两点。
一、螺旋线四元数化
设q为四元数,设
Figure GDA0002539510930000051
按照绕Z轴旋转φ角度,绕Y 轴旋转
Figure GDA0002539510930000052
角度,绕X轴旋转θ角度,如图5所示。
旋转轴均为单位矢量,Z轴为
Figure GDA0002539510930000053
Y轴为
Figure GDA0002539510930000054
X轴为
Figure GDA0002539510930000055
具体转换过程如下所示:
Figure GDA0002539510930000056
根据公式2.2,可知螺旋线旋转参数方程
Figure GDA0002539510930000057
θ是绕X轴旋转角度,
Figure GDA0002539510930000058
是绕Z轴旋转的角度。结合公式2.3和公式3.1,可以得到四元数化的螺旋线公式如下:
Figure GDA0002539510930000061
本技术中,利用公式3.2,将生成的球面螺旋线四元数化。
二、四元数法进行空间圆弧的插补
给定两个单位四元数p1和p2,参数u∈[0,1],则p1和p2旋转角度为uω,由图6所示相似三角形可以推导出P(u)在p1和p2方向上的分量长度C1(u)和 C2(u):
Figure GDA0002539510930000062
此时插值如下:
Figure GDA0002539510930000063
本技术中,将四元数化的螺旋线利用公式3.3进行插补计算。此处的p1和 p2可以用q(t1)和q(t2)来表示
实施例1:球面螺旋线四元数插补法
利用前述公式,结合实例来进行本文技术说明,具体如图7所示过程。
功能要求:给定一个空间球,球心
Figure GDA0002539510930000064
球半径r,进行球面插补。
首先,利用公式2.3生成球面螺旋线。
Figure GDA0002539510930000065
为程序控制变量取值,螺旋线旋转100圈。t=0时,为螺旋线起点;t=1时,为螺旋线终点。
Figure GDA0002539510930000071
然后,利用公式3.2转换成四元数q(t)表示方式。
Figure GDA0002539510930000072
最后,按照公式3.3进行插补,插补后四元数值用V(u)表示。u∈[0,1]为变量由程序控制。
Figure GDA0002539510930000073
Figure GDA0002539510930000074
为螺旋线生成的相邻两个点的四元数表示,两点之间角度为α=cos-1(q2λ)-cos-1(q1λ)。
Figure GDA0002539510930000075
则插补值为公式3.5所示。
Figure GDA0002539510930000081
在GNC1.5数控系统中本技术通过G218来激活功能。启动功能后,先根据 NC程序段输入的球面默认值来生成螺旋线。然后将螺旋线四元数化,再在相邻两个四元数矢量中进行四元数插补。
功能输入:生成球心坐标,球半径。生成螺旋线前后两点q(t1)和q(t2)中的控制变量t1,t2。插补控制变量u。
功能输出:球面插补值Q(u)。
以上所述,仅为本发明较佳的具体实施方式,但本发明的保护范围并不局限于此,任何熟悉本技术领域的技术人员在本发明披露的技术范围内,根据本发明的技术方案及其发明构思加以等同替换或改变,都应涵盖在本发明的保护范围之内。

Claims (1)

1.一种基于四元数螺旋线球面插补法的数控机床球面加工方法,其特征在于,包括如下步骤:
S1、数控机床给定参数信息:加工球心坐标M[Mx My Mz]、加工球半径r、取球加工范围t以及螺纹生成圈数n,其中,当t=1时,加工整球面;
根据公式2.3生成球面螺旋线
Figure FDA0002539510920000011
S2、螺旋线四元数化
设q为四元数,绕Z轴旋转φ角度,绕Y轴旋转
Figure FDA0002539510920000012
角度,绕X轴旋转θ角度,
Figure FDA0002539510920000013
利用公式3.2,将生成的球面螺旋线四元数化;
S3、基于四元数法进行空间圆弧插补的原理对螺旋线从开始点每相邻两点间进行插补,直至结束点,完成整球面的螺旋线插补计算,所述四元数法进行空间圆弧插补的原理为:
假设两个单位四元数p1和p2,参数u∈[0,1],则p1和p2旋转角度为uω;
从而确定在p1和p2方向上的分量长度C1(u)和C2(u):
Figure FDA0002539510920000014
此时插值如下:
Figure FDA0002539510920000015
S4、数控机床刀具移动到加工起点,基于S3的插值结果数控机床实现球面加工;
此外,螺旋线的生成包括:
1、球面坐标
在空间中建立直角坐标系(笛卡尔坐标系)后,以M[Mx My Mz]点为中心,|MN|=r为半径的球面上,θ为有向线段MN与z轴正向的夹角,
Figure FDA0002539510920000024
为从正z轴来看自x轴按逆时针方向转到MN所转过的角;
则在笛卡尔坐标系中球面点的坐标可以表示为:
Figure FDA0002539510920000021
2、球面螺旋线
螺旋线参数方程如下所示:
Figure FDA0002539510920000022
其中参数t∈[0,1],n为螺旋线圈数——式2.2
由公式2.1和2.2整理可以得到整球面螺旋线方程为:
Figure FDA0002539510920000023
CN201711318701.XA 2017-12-12 2017-12-12 基于四元数螺旋线球面插补法的数控机床球面加工方法 Active CN107807612B (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN201711318701.XA CN107807612B (zh) 2017-12-12 2017-12-12 基于四元数螺旋线球面插补法的数控机床球面加工方法

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN201711318701.XA CN107807612B (zh) 2017-12-12 2017-12-12 基于四元数螺旋线球面插补法的数控机床球面加工方法

Publications (2)

Publication Number Publication Date
CN107807612A CN107807612A (zh) 2018-03-16
CN107807612B true CN107807612B (zh) 2020-09-22

Family

ID=61589120

Family Applications (1)

Application Number Title Priority Date Filing Date
CN201711318701.XA Active CN107807612B (zh) 2017-12-12 2017-12-12 基于四元数螺旋线球面插补法的数控机床球面加工方法

Country Status (1)

Country Link
CN (1) CN107807612B (zh)

Families Citing this family (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN113791581B (zh) * 2021-08-03 2023-08-08 天津中德应用技术大学 一种基于等弦分割采样的球形灌木球面插补算法

Citations (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN101738984A (zh) * 2009-12-23 2010-06-16 哈尔滨工业大学 一种基于四元数的五坐标样条插补控制方法
JP2011230213A (ja) * 2010-04-26 2011-11-17 Honda Motor Co Ltd ロボット、制御システムおよび制御プログラム
CN102707664A (zh) * 2012-05-21 2012-10-03 华中科技大学 一种对五轴加工刀具平滑加工路径的方法
CN103513605A (zh) * 2012-06-28 2014-01-15 发那科株式会社 具有多轴加工机用刀具姿态控制功能的数值控制装置
CN105773620A (zh) * 2016-04-26 2016-07-20 南京工程学院 基于倍四元数的工业机器人自由曲线的轨迹规划控制方法

Patent Citations (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN101738984A (zh) * 2009-12-23 2010-06-16 哈尔滨工业大学 一种基于四元数的五坐标样条插补控制方法
JP2011230213A (ja) * 2010-04-26 2011-11-17 Honda Motor Co Ltd ロボット、制御システムおよび制御プログラム
CN102707664A (zh) * 2012-05-21 2012-10-03 华中科技大学 一种对五轴加工刀具平滑加工路径的方法
CN103513605A (zh) * 2012-06-28 2014-01-15 发那科株式会社 具有多轴加工机用刀具姿态控制功能的数值控制装置
CN105773620A (zh) * 2016-04-26 2016-07-20 南京工程学院 基于倍四元数的工业机器人自由曲线的轨迹规划控制方法

Non-Patent Citations (1)

* Cited by examiner, † Cited by third party
Title
复杂轮廓曲线的轨迹插补与速度控制方法研究;刘放;《中国优秀硕士学位论文全文数据库工程科技Ⅰ辑(月刊)》;20100715(第07期);B022-229:P12-14、27-38 *

Also Published As

Publication number Publication date
CN107807612A (zh) 2018-03-16

Similar Documents

Publication Publication Date Title
Affouard et al. Avoiding 5-axis singularities using tool path deformation
JP4888619B1 (ja) 数値制御装置
KR101056600B1 (ko) 클로소이드 곡선을 이용한 공업 제품의 설계 방법 및 이설계 방법에 의해 설계된 공업 제품, 클로소이드 곡선을이용한 수치 제어 방법 및 장치
JP4503659B2 (ja) 座標変換工具位相制御用数値制御装置
She et al. Postprocessor development of a five-axis machine tool with nutating head and table configuration
CN105598975A (zh) 一种确定工业机器人运动轨迹的方法
Sun et al. An on-line tool path smoothing algorithm for 6R robot manipulator with geometric and dynamic constraints
CN111633668B (zh) 一种用于机器人加工三维自由曲面的运动控制方法
CN112454366A (zh) 一种手眼标定方法
CN107807612B (zh) 基于四元数螺旋线球面插补法的数控机床球面加工方法
CN112356032B (zh) 一种姿态平滑过渡方法及系统
CN111413924A (zh) 装万向角度头非正交五轴数控机床后处理方法
Yu et al. Post-processing algorithm of a five-axis machine tool with dual rotary tables based on the TCS method
Li et al. Tool path optimization in postprocessor of five-axis machine tools
Min et al. A C2 continuous trajectory planning method for 6-DOF rotational robot manipulators
JP5461980B2 (ja) ワーク設置誤差補正手段を有する5軸加工機を制御する数値制御装置
JP2003005811A (ja) 6軸制御ncプログラム生成方法及び生成装置、並びに6軸制御ncプログラム生成プログラム及びこのプログラムを記憶したコンピュータ読み取り可能な記録媒体
JP2005174010A (ja) 数値制御曲面加工装置
JPH02168303A (ja) ロボットの制御方法
WO2020133882A1 (zh) 一种机器人应用于再现机加工的方法
JP4667794B2 (ja) 数値制御方法、数値制御装置、プログラム及びコンピュータ読み取り可能な記録媒体
Ge et al. Kinematics modeling and analysis of manipulator using the dual quaternion
JP4667796B2 (ja) 数値制御方法、数値制御装置、プログラム及びコンピュータ読み取り可能な記録媒体
Lin Path generation for robot polishing system based on cutter location data
Mullineux et al. Smooth Tool Motions Through Precision Poses

Legal Events

Date Code Title Description
PB01 Publication
PB01 Publication
SE01 Entry into force of request for substantive examination
SE01 Entry into force of request for substantive examination
GR01 Patent grant
GR01 Patent grant