CN116449772B - 一种多轴协同运动控制方法、装置、设备及介质 - Google Patents

一种多轴协同运动控制方法、装置、设备及介质 Download PDF

Info

Publication number
CN116449772B
CN116449772B CN202310713592.0A CN202310713592A CN116449772B CN 116449772 B CN116449772 B CN 116449772B CN 202310713592 A CN202310713592 A CN 202310713592A CN 116449772 B CN116449772 B CN 116449772B
Authority
CN
China
Prior art keywords
axis
coordinate system
coordinate
real
numerical control
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
CN202310713592.0A
Other languages
English (en)
Other versions
CN116449772A (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.)
Chengdu Aircraft Industrial Group Co Ltd
Original Assignee
Chengdu Aircraft Industrial Group 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 Chengdu Aircraft Industrial Group Co Ltd filed Critical Chengdu Aircraft Industrial Group Co Ltd
Priority to CN202310713592.0A priority Critical patent/CN116449772B/zh
Publication of CN116449772A publication Critical patent/CN116449772A/zh
Application granted granted Critical
Publication of CN116449772B publication Critical patent/CN116449772B/zh
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

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/414Structure of the control system, e.g. common controller or multiprocessor systems, interface to servo, programmable interface controller
    • G05B19/4142Structure of the control system, e.g. common controller or multiprocessor systems, interface to servo, programmable interface controller characterised by the use of a microprocessor
    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05BCONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
    • G05B2219/00Program-control systems
    • G05B2219/30Nc systems
    • G05B2219/34Director, elements to supervisory
    • G05B2219/34013Servocontroller
    • YGENERAL 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
    • Y02TECHNOLOGIES OR APPLICATIONS FOR MITIGATION OR ADAPTATION AGAINST CLIMATE CHANGE
    • Y02PCLIMATE CHANGE MITIGATION TECHNOLOGIES IN THE PRODUCTION OR PROCESSING OF GOODS
    • Y02P90/00Enabling technologies with a potential contribution to greenhouse gas [GHG] emissions mitigation
    • Y02P90/02Total factory control, e.g. smart factories, flexible manufacturing systems [FMS] or integrated manufacturing systems [IMS]

Landscapes

  • Engineering & Computer Science (AREA)
  • Computer Hardware Design (AREA)
  • Microelectronics & Electronic Packaging (AREA)
  • Human Computer Interaction (AREA)
  • Manufacturing & Machinery (AREA)
  • Physics & Mathematics (AREA)
  • General Physics & Mathematics (AREA)
  • Automation & Control Theory (AREA)
  • Numerical Control (AREA)

Abstract

本申请公开了一种多轴协同运动控制方法、装置、设备及介质,方法包括以下步骤:构建装配坐标系,获得飞机部件从实际坐标到理论坐标的旋转平移量;根据旋转平移量,获得飞机部件旋转平移后的位姿移动量;构建各三坐标数控***对应的设备坐标系,并根据位姿移动量,以获得各三坐标数控***在对应设备坐标系下的位移量;在运动控制器中构建虚轴和实轴,以虚轴作为引导轴,以实轴作为跟随轴;根据位移量,建立虚轴与实轴之间的同步关系;根据同步关系,以进行各三坐标数控***的协同运动控制,本申请具有协同性好、可有效维持各个三坐标数控***的球窝之间的刚性状态的优点。

Description

一种多轴协同运动控制方法、装置、设备及介质
技术领域
本申请涉及飞机装配位姿控制技术领域,尤其涉及一种多轴协同运动控制方法、装置、设备及介质。
背景技术
近年来,伴随着航空制造技术水平不断提高,对飞机装配技术要求也越来越高。飞机装配是整个机身制造过程必不可少的环节,其涉及学科领域多且技术难度大。在飞机装配制造过程中,通常是将整机分成若干个装配部件,装配方式采用先部装再总装,其中飞机大部件(大尺寸、弱刚性部件)的调姿、对合是两个非常重要的工艺过程,影响着整个飞机装配过程的安全和效率。
大部件在调姿、对合过程中,通常利用多个三坐标数控***支撑定位大部件进行调姿,首先,大部件和三坐标数控***通过球头和球窝进行软连接;其次,通过工控计算机对各个三坐标数控***上X轴、Y轴、Z轴的运动,分别进行轨迹规划;最后,控制伺服***协同运动,实现对大部件的调姿、对合装配,整个过程的难点在于如何维持各个三坐标数控***的球窝之间的刚性状态。
发明内容
本申请的主要目的在于提供一种多轴协同运动控制方法、装置、设备及介质,旨在解决现有通过多个三坐标数控***支撑定位大部件进行调姿的方法难以维持各个三坐标数控***的球窝之间的刚性状态的技术问题。
为实现上述目的,本申请提供一种多轴协同运动控制方法,包括以下步骤:
构建装配坐标系,基于所述装配坐标系,获得飞机部件从实际坐标到理论坐标的旋转平移量;
根据所述旋转平移量,获得所述飞机部件旋转平移后的位姿移动量;
构建各三坐标数控***对应的设备坐标系,并根据所述位姿移动量,以获得各所述三坐标数控***在对应所述设备坐标系下的位移量;其中,所述三坐标数控***上设有球窝,所述球窝用于对接所述飞机部件上的球头;
在运动控制器中构建虚轴和实轴,以所述虚轴作为引导轴,以所述实轴作为跟随轴;其中,所述运动控制器用于控制各所述三坐标数控***同步运动;
根据所述位移量,建立所述虚轴与所述实轴之间的同步关系;
根据所述同步关系,以进行各所述三坐标数控***的协同运动控制。
可选地,所述构建装配坐标系,基于所述装配坐标系,获得飞机部件从实际坐标到理论坐标的旋转平移量,包括:
以飞机部件的装配中心位置构建装配坐标系;
基于所述装配坐标系,并根据所述飞机部件的表面特征点的理论值和实测值,以获得所述飞机部件从实际坐标到理论坐标的旋转平移量,记为[x,y,z,α,β,γ];其中,x为所述飞机部件在x轴方向的平移量,y为所述飞机部件在y轴方向的平移量,z为所述飞机部件在z轴方向的平移量,α为所述飞机部件绕x轴的旋转量,β为所述飞机部件绕y轴的旋转量,γ为所述飞机部件绕z轴的旋转量。
可选地,所述根据所述旋转平移量,获得所述飞机部件旋转平移后的位姿移动量,包括:
构建所述三坐标数控***的坐标轴轨迹函数X(t),表达式如下:
式中,a5、a4、a3均为系数,且a5=6/te 5,a4=15/te 4,a3=10/te 3,te为设定的总时间常数C,Xte=[0,0,0,0,0,0,],X0为所述飞机部件的初始位姿参数,t为自变量;
将每个所述三坐标数控***的坐标轴轨迹函数X(t)根据旋转平移量[x,y,z,α,β,γ]及工艺需求分解为N个插补点,则有:
式中,t'为插补周期,C为设定的总时间常数;
并获得以下函数:
式中,n为拆分后对应的各个插补点,X(x)、X(y)、X(z)、X(α)、X(β)和X(γ)即为所述飞机部件旋转平移后的位姿移动量。
可选地,所述构建各三坐标数控***对应的设备坐标系,并根据所述位姿移动量,以获得各所述三坐标数控***在对应所述设备坐标系下的位移量,包括:
构建各三坐标数控***对应的设备坐标系;
求解各所述三坐标数控***在所述设备坐标系下的移动量刚性变换转换关系式M,表达式如下:
式中,αt表示在t时刻各个球窝中心点沿装配坐标系X轴旋转的角度,βt表示在t时刻各个球窝中心点沿装配坐标系Y轴旋转的角度,γt表示在t时刻各个球窝中心点沿装配坐标系Z轴旋转的角度;
对所述移动量刚性变换转换关系式M进行运动学逆解,获得如下函数关系:
式中,f(x)n为所述三坐标数控***在所述设备坐标系下X方向上的第n点所对应的位移量,f(y)n为所述三坐标数控***在所述设备坐标系下Y方向上的第n点所对应的位移量,f(zn)为所述三坐标数控***在所述设备坐标系下Y方向上的第n点所对应的位移量,αn表示各个球窝中心点在第n点时沿对应装配坐标系X轴旋转的角度,βn为各个球窝中心点在第n点时沿对应装配坐标系Y轴旋转的角度,γn为各个球窝中心点在第n点时沿对应装配坐标系Z轴旋转的角度。
可选地,所述根据所述位移量,建立所述虚轴与所述实轴之间的同步关系,包括:
根据所述位移量,建立所述实轴的位置与时间的关系,以重构各所述实轴的移动函数;
对所有所述实轴的起始点和终止点的移动量差值进行比较运算,以获取最大移动量Q,并将所述移动量Q按照所述实轴拆分点数进行等距离拆分,建立所述虚轴的位置与时间的关系,以重构所述虚轴的移动函数;
根据所述实轴的移动函数和所述虚轴的移动函数,将所述实轴和所述虚轴进行关联,以建立起所述虚轴与所述实轴之间的同步关系。
可选地,所述实轴的移动函数的表达式如下:
式中,i为程序扫描时间,Yiout为各实轴当前的位置,Yin为各实轴在第n个插补点时各实轴的位置,Yi(n+1)为各实轴在第n+1个插补点时的位置,其中Yin、Yi(n+1)由f(x)n、f(y)n、f(zn)计算得出;Xin为各实轴在第n个插补点的时间,Xi(n+1)为各实轴在第n+1个插补点的时间,Xiin为各实轴运行的当前时间。
可选地,所述虚轴的移动函数的表达式如下:
式中,YMaster_iout为虚轴当前的位置,YMaster_in为虚轴在第n个插补点时的位置,YMaster_i(n+1)为虚轴在第n+1个插补点时的位置,XMaster_in为各虚轴在第n个插补点的时间,XMaster_i(n+1)为虚轴在第n+1个插补点的时间,XMaster_iin为各实轴运行的当前时间。
为实现上述目的,本申请还提供一种多轴协同运动控制装置,包括:
第一计算模块,用于构建装配坐标系,基于所述装配坐标系,获得飞机部件从实际坐标到理论坐标的旋转平移量;
第二计算模块,用于根据所述旋转平移量,获得所述飞机部件旋转平移后的位姿移动量;
第三计算模块,用于构建各三坐标数控***对应的设备坐标系,并根据所述位姿移动量,以获得各所述三坐标数控***在对应所述设备坐标系下的位移量;其中,所述三坐标数控***上设有球窝,所述球窝用于对接所述飞机部件上的球头;
第一构建模块,用于在运动控制器中构建虚轴和实轴,以所述虚轴作为引导轴,以所述实轴作为跟随轴;其中,所述运动控制器用于控制各所述三坐标数控***同步运动;
第二构建模块,用于根据所述位移量,建立所述虚轴与所述实轴之间的同步关系;
协同控制模块,用于根据所述同步关系,以进行各所述三坐标数控***的协同运动控制。
为实现上述目的,本申请还提供一种计算机设备,该计算机设备包括存储器和处理器,所述存储器中存储有计算机程序,所述处理器执行所述计算机程序,实现上述的方法。
为实现上述目的,本申请还提供一种计算机可读存储介质,所述计算机可读存储介质上存储有计算机程序,处理器执行所述计算机程序,实现上述的方法。
本申请所能实现的有益效果如下:
本申请通过分别构建装配坐标系和设备坐标系,先根据装配坐标系计算获得飞机部件从实际坐标到理论坐标的旋转平移量,从而可计算获得飞机部件旋转平移后的位姿移动量,然后将位姿移动量结合设备坐标系,可计算获得各三坐标数控***在对应设备坐标系下的位移量,并根据位移量建立虚轴与实轴之间的同步关系,保证各轴运动的同步性,最后即可根据同步关系来实现对各三坐标数控***的协同运动控制,从而实现多轴协同运动的轨迹规划,保证了在运动控制器同一扫描周期内,可有效维持各个三坐标数控***的球窝之间的刚性状态,避免了各轴运动时对飞机部件产生拉扯,很好的实现了对飞机部件的低应力、精确装配功能。
附图说明
为了更清楚地说明本申请具体实施方式或现有技术中的技术方案,下面将对具体实施方式或现有技术描述中所需要使用的附图作简单地介绍。在所有附图中,类似的元件或部分一般由类似的附图标记标识。附图中,各元件或部分并不一定按照实际的比例绘制。
图1为本申请的实施例中一种多轴协同运动控制方法的流程示意图;
图2为本申请的实施例中安装有球头的飞机部件的结构示意图;
图3为本申请的实施例中三坐标数控***的结构示意图;
图4为本申请的实施例中涉及到的硬件部分的连接示意图;
图5为本申请的实施例中飞机部件调姿对合时的模拟示意图;
图6为本申请的实施例中设备坐标系和装配坐标系的对应关系示意图。
附图标记:
110-飞机部件,120-球头,130-三坐标数控***,131-X轴移动机构,132-Y轴移动机构,133-Z轴移动机构,134-电机,135-球窝,140-工控计算机,150-运动控制器,160-伺服***,170-装配坐标系,180-设备坐标系。
本申请目的的实现、功能特点及优点将结合实施例,参照附图做进一步说明。
具体实施方式
下面将结合本申请实施例中的附图,对本申请实施例中的技术方案进行清楚、完整地描述,显然,所描述的实施例仅仅是本申请的一部分实施例,而不是全部的实施例。基于本申请中的实施例,本领域普通技术人员在没有作出创造性劳动前提下所获得的所有其他实施例,都属于本申请保护的范围。
需要说明的是,本申请实施例中所有方向性指示(诸如上、下、左、右、前、后……)仅用于解释在某一特定姿态下各部件之间的相对位置关系、运动情况等,如果该特定姿态发生改变时,则该方向性指示也相应地随之改变。
在本申请中,除非另有明确的规定和限定,术语“连接”、“固定”等应做广义理解,例如,“固定”可以是固定连接,也可以是可拆卸连接,或成一体;可以是机械连接,也可以是电连接;可以是直接相连,也可以通过中间媒介间接相连,可以是两个元件内部的连通或两个元件的相互作用关系,除非另有明确的限定。对于本领域的普通技术人员而言,可以根据具体情况理解上述术语在本申请中的具体含义。
另外,若本申请实施例中有涉及“第一”、“第二”等的描述,则该“第一”、“第二”等的描述仅用于描述目的,而不能理解为指示或暗示其相对重要性或者隐含指明所指示的技术特征的数量。由此,限定有“第一”、“第二”的特征可以明示或者隐含地包括至少一个该特征。另外,全文中出现的“和/或”的含义,包括三个并列的方案,以“A和/或B”为例,包括A方案、或B方案、或A和B同时满足的方案。另外,各个实施例之间的技术方案可以相互结合,但是必须是以本领域普通技术人员能够实现为基础,当技术方案的结合出现相互矛盾或无法实现时应当认为这种技术方案的结合不存在,也不在本申请要求的保护范围之内。
实施例1
参照图1-图6,本实施例提供一种多轴协同运动控制方法,包括以下步骤:
步骤S100:构建装配坐标系170,基于所述装配坐标系170,获得飞机部件110从实际坐标到理论坐标的旋转平移量;
步骤S200:根据所述旋转平移量,获得所述飞机部件110旋转平移后的位姿移动量;
步骤S300:构建各三坐标数控***130对应的设备坐标系180,并根据所述位姿移动量,以获得各所述三坐标数控***130在对应所述设备坐标系180下的位移量;其中,所述三坐标数控***130上设有球窝135,所述球窝135用于对接所述飞机部件110上的球头120;
步骤S400:在运动控制器150中构建虚轴和实轴,以所述虚轴作为引导轴,以所述实轴作为跟随轴;其中,所述运动控制器150用于控制各所述三坐标数控***130同步运动;
步骤S500:根据所述位移量,建立所述虚轴与所述实轴之间的同步关系;
步骤S600:根据所述同步关系,以进行各所述三坐标数控***130的协同运动控制。
在本实施例中,通过分别构建装配坐标系170和设备坐标系180,先根据装配坐标系170计算获得飞机部件110从实际坐标到理论坐标的旋转平移量,从而可计算获得飞机部件110旋转平移后的位姿移动量,然后将位姿移动量结合设备坐标系180,可计算获得各三坐标数控***130在对应设备坐标系180下的位移量,并根据位移量建立虚轴与实轴之间的同步关系,保证各轴运动的同步性,最后即可根据同步关系来实现对各三坐标数控***130的协同运动控制,从而实现多轴协同运动的轨迹规划,保证了在运动控制器150同一扫描周期内,可有效维持各个三坐标数控***130的球窝135之间的刚性状态,避免了各轴运动时对飞机部件110产生拉扯,很好的实现了对飞机部件110的低应力、精确装配功能。
需要说明的是,三坐标数控***130主体结构包括X轴移动机构131、Y轴移动机构132、Z轴移动机构133以及驱动各移动机构运行的电机134,Z轴移动机构133上设置有滑枕,滑枕一侧设置有定位座,定位座上开设有与飞机部件110上的球头120配合的球窝135,飞机部件110上一般具有多个球头120,一个球头120则配置一个三坐标数控***130进行对接,通过X轴移动机构131、Y轴移动机构132和Z轴移动机构133的互相配合,可实现定位座的三轴移动,三坐标数控***130为现有技术,其具体结构这里不再赘述;本实施例涉及到的硬件部分包括依次电性连接的工控计算机140、运动控制器150、伺服***160和电机134,飞机部件110在调姿对合过程中,通常利用多个三坐标数控***130支撑定位飞机部件110,首先,飞机部件110和三坐标数控***130通过球头120和球窝135进行软连接;其次,通过工控计算机140对各个三坐标数控***130上X轴、Y轴、Z轴的运动,分别进行轨迹规划;最后,控制伺服***160启动对应电机134以进行协同运动,从而实现对大部件的调姿对合装配。
作为一种可选的实施方式,所述构建装配坐标系170,基于所述装配坐标系170,获得飞机部件110从实际坐标到理论坐标的旋转平移量,包括:
以飞机部件110的装配中心位置构建装配坐标系170;
基于所述装配坐标系170,并根据所述飞机部件110的表面特征点的理论值和实测值,以获得所述飞机部件110从实际坐标到理论坐标的旋转平移量,记为[x,y,z,α,β,γ] ;其中,x为所述飞机部件110在x轴方向的平移量,y为所述飞机部件110在y轴方向的平移量,z为所述飞机部件110在z轴方向的平移量,α为所述飞机部件110绕x轴的旋转量,β为所述飞机部件110绕y轴的旋转量,γ为所述飞机部件110绕z轴的旋转量。
在本实施方式中,在装配坐标系170下,基于飞机部件110表面特征点即可求解飞机部件110从实际坐标到理论坐标的旋转平移量(即位姿六元组),求解时,可根据飞机部件110表面特征点的理论值和实测值,使用奇异值分解法(SVD)分解,若基准点超差,利用粒子群优化算法(PSO)或加权的奇异值分解法算法(WSVD),进行迭代优化,从而可求解出飞机部件110从实际坐标到理论坐标的旋转平移量。
需要说明的是,奇异值分解法(SVD)是在机器学习领域广泛应用的算法,它可以用于降维算法中的特征分解,即进行数据降维;粒子群优化算法(PSO) 是一种通过模拟鸟群觅食行为而发展起来的一种基于群体协作的随机搜索 算法,它只能够得到全局最优的近似解,可能得不到全局最优解,该算法可以用在全局路径搜索、网络路由规划、寻找复杂函数的最值点等应用;WSVD是小波奇异值分解的简称,它是在小波变换的基础上,对小波子带矩阵进行奇异值分解,奇异值分解可以作为矩阵化简的工具,而且奇异值分解对秘密信息的嵌入十分敏感。使用奇异值分解提取特征的方式同直接使用小波系数提取特征相比,可以大大的减少计算复杂度和特征维度;上述算法均为现有技术,这里不再赘述。
作为一种可选的实施方式,所述根据所述旋转平移量,获得所述飞机部件110旋转平移后的位姿移动量,包括:
构建所述三坐标数控***130的坐标轴轨迹函数X(t),表达式如下:
式中,a5、a4、a3均为系数,且a5=6/te 5,a4=15/te 4,a3=10/te 3,te为设定的总时间常数C,Xte=[0,0,0,0,0,0,],X0为所述飞机部件110的初始位姿参数,t为自变量;
将每个所述三坐标数控***130的坐标轴轨迹函数X(t)根据旋转平移量[x,y,z,α,β,γ]及工艺需求分解为N个插补点,则有:
式中,t'为插补周期,C为设定的总时间常数;
并获得以下函数:
式中,n为拆分后对应的各个插补点,X(x)、X(y)、X(z)、X(α)、X(β)和X(γ)即为所述飞机部件110旋转平移后的位姿移动量。
在本实施方式中,通过构建三坐标数控***130的坐标轴轨迹函数X(t),然后将坐标轴轨迹函数X(t)根据旋转平移量及工艺需求分解为N个插补点,得到插补周期t',代入坐标轴轨迹函数X(t),即可获得飞机部件110旋转平移后的位姿移动量,本实施例利用五次多项式曲线,进行轨迹规划,从而保证了在运动控制器150同一扫描周期内各个三坐标数控***130的球窝135之间的刚性状态。
作为一种可选的实施方式,所述构建各三坐标数控***130对应的设备坐标系180,并根据所述位姿移动量,以获得各所述三坐标数控***130在对应所述设备坐标系180下的位移量,包括:
构建各三坐标数控***130对应的设备坐标系180;
求解各所述三坐标数控***130在所述设备坐标系180下的移动量刚性变换转换关系式M,表达式如下:
式中,αt表示在t时刻各个球窝135中心点沿装配坐标系X轴旋转的角度,βt表示在t时刻各个球窝135中心点沿装配坐标系Y轴旋转的角度,γt表示在t时刻各个球窝135中心点沿装配坐标系Z轴旋转的角度;
对所述移动量刚性变换转换关系式M进行运动学逆解,获得如下函数关系:
式中,f(x)n为所述三坐标数控***130在所述设备坐标系180下X方向上的第n点所对应的位移量,f(y)n为所述三坐标数控***130在所述设备坐标系180下Y方向上的第n点所对应的位移量,f(zn)为所述三坐标数控***130在所述设备坐标系180下Y方向上的第n点所对应的位移量,αn表示各个球窝135中心点在第n点时沿对应装配坐标系X轴旋转的角度,βn为各个球窝135中心点在第n点时沿对应装配坐标系Y轴旋转的角度,γn为各个球窝135中心点在第n点时沿对应装配坐标系Z轴旋转的角度。
在本实施方式中,通过求解各三坐标数控***130在设备坐标系180下的移动量刚性变换转换关系式M,并对移动量刚性变换转换关系式M进行运动学逆解,从而可获得各三坐标数控***130在对应设备坐标系180下的位移量,即f(x)n、f(y)n、f(zn),为后续实现多轴协同运动提供了先决条件。
作为一种可选的实施方式,所述根据所述位移量,建立所述虚轴与所述实轴之间的同步关系,包括:
根据所述位移量,建立所述实轴的位置与时间的关系,以重构各所述实轴的移动函数;
对所有所述实轴的起始点和终止点的移动量差值进行比较运算,以获取最大移动量Q,并将所述移动量Q按照所述实轴拆分点数进行等距离拆分,建立所述虚轴的位置与时间的关系,以重构所述虚轴的移动函数;
根据所述实轴的移动函数和所述虚轴的移动函数,将所述实轴和所述虚轴进行关联,以建立起所述虚轴与所述实轴之间的同步关系。
在本实施方式中,通过分别重构实轴和虚轴的移动函数,可有效将实轴和虚轴进行关联,从而实现虚轴与实轴之间的同步关系建立,本实施例通过对各个轴目标位置分解与运动函数重构,同时利用运动控制器150刷新周期短(1ms)的优点,降低了各跟随轴(实轴)与引导轴(虚拟轴)耦合运动时的相互影响,保证各轴运动的同步性,很好的实现了对飞机部件110的低应力、精确装配功能。
需要说明的是,这里可通过使用运动控制器150的电子凸轮功能或跟随模式功能,将实轴和虚轴进行关联,建立起虚轴与实轴之间的同步关系,按照绝对定位的方式,启停虚轴,此时跟随轴(实轴)将跟随引导轴(虚轴)做等周期多轴同步运动,实现超大空间多轴协同运动控制功能。
作为一种可选的实施方式,所述实轴的移动函数的表达式如下:
式中,i为程序扫描时间,Yiout为各实轴当前的位置,Yin为各实轴在第n个插补点时各实轴的位置,Yi(n+1)为各实轴在第n+1个插补点时的位置,其中Yin、Yi(n+1)由f(x)n、f(y)n、f(zn)计算得出;Xin为各实轴在第n个插补点的时间,Xi(n+1)为各实轴在第n+1个插补点的时间,Xiin为各实轴运行的当前时间。
作为一种可选的实施方式,所述虚轴的移动函数的表达式如下:
式中,YMaster_iout为虚轴当前的位置,YMaster_in为虚轴在第n个插补点时的位置,YMaster_i(n+1)为虚轴在第n+1个插补点时的位置,XMaster_in为各虚轴在第n个插补点的时间,XMaster_i(n+1)为虚轴在第n+1个插补点的时间,XMaster_iin为各实轴运行的当前时间。
实施例2
如图1-图6,基于与前述实施例相同的发明思路,本实施例提供一种多轴协同运动控制装置,包括:
第一计算模块,用于构建装配坐标系170,基于所述装配坐标系170,获得飞机部件110从实际坐标到理论坐标的旋转平移量;
第二计算模块,用于根据所述旋转平移量,获得所述飞机部件110旋转平移后的位姿移动量;
第三计算模块,用于构建各三坐标数控***130对应的设备坐标系180,并根据所述位姿移动量,以获得各所述三坐标数控***130在对应所述设备坐标系180下的位移量;其中,所述三坐标数控***130上设有球窝135,所述球窝135用于对接所述飞机部件110上的球头120;
第一构建模块,用于在运动控制器150中构建虚轴和实轴,以所述虚轴作为引导轴,以所述实轴作为跟随轴;其中,所述运动控制器150用于控制各所述三坐标数控***130同步运动;
第二构建模块,用于根据所述位移量,建立所述虚轴与所述实轴之间的同步关系;
协同控制模块,用于根据所述同步关系,以进行各所述三坐标数控***130的协同运动控制。
本实施例的装置中各模块的相关解释和举例可参照前述实施例的方法,这里不再赘述。
实施例3
基于与前述实施例相同的发明思路,本实施例提供一种计算机设备,该计算机设备包括存储器和处理器,所述存储器中存储有计算机程序,所述处理器执行所述计算机程序,实现上述的方法。
实施例4
基于与前述实施例相同的发明思路,本实施例提供一种计算机可读存储介质,所述计算机可读存储介质上存储有计算机程序,处理器执行所述计算机程序,实现上述的方法。
以上仅为本申请的优选实施例,并非因此限制本申请的专利范围,凡是利用本申请说明书及附图内容所作的等效结构或等效流程变换,或直接或间接运用在其他相关的技术领域,均同理包括在本申请的专利保护范围内。

Claims (4)

1.一种多轴协同运动控制方法,其特征在于,包括以下步骤:
构建装配坐标系,基于所述装配坐标系,获得飞机部件从实际坐标到理论坐标的旋转平移量,包括:以飞机部件的装配中心位置构建装配坐标系;基于所述装配坐标系,并根据所述飞机部件的表面特征点的理论值和实测值,以获得所述飞机部件从实际坐标到理论坐标的旋转平移量,记为[x,y,z,α,β,γ];其中,x为所述飞机部件在x轴方向的平移量,y为所述飞机部件在y轴方向的平移量,z为所述飞机部件在z轴方向的平移量,α为所述飞机部件绕x轴的旋转量,β为所述飞机部件绕y轴的旋转量,γ为所述飞机部件绕z轴的旋转量;
根据所述旋转平移量,获得所述飞机部件旋转平移后的位姿移动量,包括:构建三坐标数控***的坐标轴轨迹函数X(t),表达式如下:
式中,a5、a4、a3均为系数,且a5=6/te 5,a4=15/te 4,a3=10/te 3,te为设定的总时间常数C,Xte=[0,0,0,0,0,0,],X0为所述飞机部件的初始位姿参数,t为自变量;
将每个所述三坐标数控***的坐标轴轨迹函数X(t)根据旋转平移量[x,y,z,α,β,γ]及工艺需求分解为N个插补点,则有:
式中,t'为插补周期,C为设定的总时间常数;
并获得以下函数:
式中,n为拆分后对应的各个插补点,X(x)、X(y)、X(z)、X(α)、X(β)和X(γ)即为所述飞机部件旋转平移后的位姿移动量;
构建各三坐标数控***对应的设备坐标系,并根据所述位姿移动量,以获得各所述三坐标数控***在对应所述设备坐标系下的位移量;其中,所述三坐标数控***上设有球窝,所述球窝用于对接所述飞机部件上的球头;包括:构建各三坐标数控***对应的设备坐标系;求解各所述三坐标数控***在所述设备坐标系下的移动量刚性变换转换关系式M,表达式如下:
式中,αt表示在t时刻各个球窝中心点沿装配坐标系X轴旋转的角度,βt表示在t时刻各个球窝中心点沿装配坐标系Y轴旋转的角度,γt表示在t时刻各个球窝中心点沿装配坐标系Z轴旋转的角度;
对所述移动量刚性变换转换关系式M进行运动学逆解,获得如下函数关系:
式中,f(x)n为所述三坐标数控***在所述设备坐标系下X方向上的第n点所对应的位移量,f(y)n为所述三坐标数控***在所述设备坐标系下Y方向上的第n点所对应的位移量,f(zn)为所述三坐标数控***在所述设备坐标系下Y方向上的第n点所对应的位移量,αn表示各个球窝中心点在第n点时沿对应装配坐标系X轴旋转的角度,βn为各个球窝中心点在第n点时沿对应装配坐标系Y轴旋转的角度,γn为各个球窝中心点在第n点时沿对应装配坐标系Z轴旋转的角度;
在运动控制器中构建虚轴和实轴,以所述虚轴作为引导轴,以所述实轴作为跟随轴;其中,所述运动控制器用于控制各所述三坐标数控***同步运动;
根据所述位移量,建立所述虚轴与所述实轴之间的同步关系,包括:根据所述位移量,建立所述实轴的位置与时间的关系,以重构各所述实轴的移动函数;对所有所述实轴的起始点和终止点的移动量差值进行比较运算,以获取最大移动量Q,并将所述移动量Q按照所述实轴拆分点数进行等距离拆分,建立所述虚轴的位置与时间的关系,以重构所述虚轴的移动函数;根据所述实轴的移动函数和所述虚轴的移动函数,将所述实轴和所述虚轴进行关联,以建立起所述虚轴与所述实轴之间的同步关系;
所述实轴的移动函数的表达式如下:
式中,i为程序扫描时间,Yiout为各实轴当前的位置,Yin为各实轴在第n个插补点时各实轴的位置,Yi(n+1)为各实轴在第n+1个插补点时的位置,其中Yin、Yi(n+1)由f(x)n、f(y)n、f(zn)计算得出;Xin为各实轴在第n个插补点的时间,Xi(n+1)为各实轴在第n+1个插补点的时间,Xiin为各实轴运行的当前时间;
所述虚轴的移动函数的表达式如下:
式中,YMaster_iout为虚轴当前的位置,YMaster_in为虚轴在第n个插补点时的位置,YMaster_i(n+1)为虚轴在第n+1个插补点时的位置,XMaster_in为各虚轴在第n个插补点的时间,XMaster_i(n+1)为虚轴在第n+1个插补点的时间,XMaster_iin为各实轴运行的当前时间;
根据所述同步关系,以进行各所述三坐标数控***的协同运动控制。
2.一种多轴协同运动控制装置,其特征在于,包括:
第一计算模块,用于构建装配坐标系,基于所述装配坐标系,获得飞机部件从实际坐标到理论坐标的旋转平移量,包括:以飞机部件的装配中心位置构建装配坐标系;基于所述装配坐标系,并根据所述飞机部件的表面特征点的理论值和实测值,以获得所述飞机部件从实际坐标到理论坐标的旋转平移量,记为[x,y,z,α,β,γ];其中,x为所述飞机部件在x轴方向的平移量,y为所述飞机部件在y轴方向的平移量,z为所述飞机部件在z轴方向的平移量,α为所述飞机部件绕x轴的旋转量,β为所述飞机部件绕y轴的旋转量,γ为所述飞机部件绕z轴的旋转量;
第二计算模块,用于根据所述旋转平移量,获得所述飞机部件旋转平移后的位姿移动量,包括:构建三坐标数控***的坐标轴轨迹函数X(t),表达式如下:
式中,a5、a4、a3均为系数,且a5=6/te 5,a4=15/te 4,a3=10/te 3,te为设定的总时间常数C,Xte=[0,0,0,0,0,0,],X0为所述飞机部件的初始位姿参数,t为自变量;
将每个所述三坐标数控***的坐标轴轨迹函数X(t)根据旋转平移量[x,y,z,α,β,γ]及工艺需求分解为N个插补点,则有:
式中,t'为插补周期,C为设定的总时间常数;
并获得以下函数:
式中,n为拆分后对应的各个插补点,X(x)、X(y)、X(z)、X(α)、X(β)和X(γ)即为所述飞机部件旋转平移后的位姿移动量;
第三计算模块,用于构建各三坐标数控***对应的设备坐标系,并根据所述位姿移动量,以获得各所述三坐标数控***在对应所述设备坐标系下的位移量;其中,所述三坐标数控***上设有球窝,所述球窝用于对接所述飞机部件上的球头;包括:构建各三坐标数控***对应的设备坐标系;求解各所述三坐标数控***在所述设备坐标系下的移动量刚性变换转换关系式M,表达式如下:
式中,αt表示在t时刻各个球窝中心点沿装配坐标系X轴旋转的角度,βt表示在t时刻各个球窝中心点沿装配坐标系Y轴旋转的角度,γt表示在t时刻各个球窝中心点沿装配坐标系Z轴旋转的角度;
对所述移动量刚性变换转换关系式M进行运动学逆解,获得如下函数关系:
式中,f(x)n为所述三坐标数控***在所述设备坐标系下X方向上的第n点所对应的位移量,f(y)n为所述三坐标数控***在所述设备坐标系下Y方向上的第n点所对应的位移量,f(zn)为所述三坐标数控***在所述设备坐标系下Y方向上的第n点所对应的位移量,αn表示各个球窝中心点在第n点时沿对应装配坐标系X轴旋转的角度,βn为各个球窝中心点在第n点时沿对应装配坐标系Y轴旋转的角度,γn为各个球窝中心点在第n点时沿对应装配坐标系Z轴旋转的角度;
第一构建模块,用于在运动控制器中构建虚轴和实轴,以所述虚轴作为引导轴,以所述实轴作为跟随轴;其中,所述运动控制器用于控制各所述三坐标数控***同步运动;
第二构建模块,用于根据所述位移量,建立所述虚轴与所述实轴之间的同步关系,包括:根据所述位移量,建立所述实轴的位置与时间的关系,以重构各所述实轴的移动函数;对所有所述实轴的起始点和终止点的移动量差值进行比较运算,以获取最大移动量Q,并将所述移动量Q按照所述实轴拆分点数进行等距离拆分,建立所述虚轴的位置与时间的关系,以重构所述虚轴的移动函数;根据所述实轴的移动函数和所述虚轴的移动函数,将所述实轴和所述虚轴进行关联,以建立起所述虚轴与所述实轴之间的同步关系;
所述实轴的移动函数的表达式如下:
式中,i为程序扫描时间,Yiout为各实轴当前的位置,Yin为各实轴在第n个插补点时各实轴的位置,Yi(n+1)为各实轴在第n+1个插补点时的位置,其中Yin、Yi(n+1)由f(x)n、f(y)n、f(zn)计算得出;Xin为各实轴在第n个插补点的时间,Xi(n+1)为各实轴在第n+1个插补点的时间,Xiin为各实轴运行的当前时间;
所述虚轴的移动函数的表达式如下:
式中,YMaster_iout为虚轴当前的位置,YMaster_in为虚轴在第n个插补点时的位置,YMaster_i(n+1)为虚轴在第n+1个插补点时的位置,XMaster_in为各虚轴在第n个插补点的时间,XMaster_i(n+1)为虚轴在第n+1个插补点的时间,XMaster_iin为各实轴运行的当前时间;
协同控制模块,用于根据所述同步关系,以进行各所述三坐标数控***的协同运动控制。
3.一种计算机设备,其特征在于,该计算机设备包括存储器和处理器,所述存储器中存储有计算机程序,所述处理器执行所述计算机程序,实现如权利要求1中所述的方法。
4.一种计算机可读存储介质,其特征在于,所述计算机可读存储介质上存储有计算机程序,处理器执行所述计算机程序,实现如权利要求1中所述的方法。
CN202310713592.0A 2023-06-16 2023-06-16 一种多轴协同运动控制方法、装置、设备及介质 Active CN116449772B (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN202310713592.0A CN116449772B (zh) 2023-06-16 2023-06-16 一种多轴协同运动控制方法、装置、设备及介质

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN202310713592.0A CN116449772B (zh) 2023-06-16 2023-06-16 一种多轴协同运动控制方法、装置、设备及介质

Publications (2)

Publication Number Publication Date
CN116449772A CN116449772A (zh) 2023-07-18
CN116449772B true CN116449772B (zh) 2023-10-03

Family

ID=87127726

Family Applications (1)

Application Number Title Priority Date Filing Date
CN202310713592.0A Active CN116449772B (zh) 2023-06-16 2023-06-16 一种多轴协同运动控制方法、装置、设备及介质

Country Status (1)

Country Link
CN (1) CN116449772B (zh)

Citations (20)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN101362513A (zh) * 2008-09-19 2009-02-11 浙江大学 基于三个***的飞机部件位姿调整协同控制方法
CN101362512A (zh) * 2008-09-19 2009-02-11 浙江大学 一种基于四个***的飞机部件位姿调整***及方法
CN101850512A (zh) * 2010-04-20 2010-10-06 浙江大学 一种大行程、高刚度、高精度三坐标***
CN102313516A (zh) * 2011-08-05 2012-01-11 南京航空航天大学 随动式***顶端球心空间坐标的测量工具及其测量方法
CN102331745A (zh) * 2011-09-20 2012-01-25 中达电通股份有限公司 总线型运动控制器对制袋机的控制***及其控制方法
CN102736554A (zh) * 2012-07-05 2012-10-17 浙江大学 一种基于刚度匹配的重载三坐标数控***设计方法
CN203109951U (zh) * 2013-01-17 2013-08-07 常州先进制造技术研究所 一种上下料机械手运动控制装置
CN204151380U (zh) * 2014-10-31 2015-02-11 杭州通绿机械有限公司 一种实轴热加工退火炉
CN104602635A (zh) * 2012-06-28 2015-05-06 伊西康内外科公司 多轴线关节运动和旋转外科工具
CN104935543A (zh) * 2014-03-17 2015-09-23 斯沃奇集团研究和开发有限公司 用于相位调制信号的同步解调器电子电路
CN105182914A (zh) * 2015-09-25 2015-12-23 中国矿业大学 绳索传动的多动平台并联髋关节试验机控制***及方法
CN105242640A (zh) * 2014-07-09 2016-01-13 北京自动化控制设备研究所 一种新型的高速高精度多轴伺服运动控制器电路
CN106292545A (zh) * 2016-08-18 2017-01-04 四川泛华航空仪表电器有限公司 利用宏程序数控加工圆柱曲面的方法
CN106907389A (zh) * 2017-03-17 2017-06-30 常州大学 一种具有远程运动中心的大转角球铰结构
CN107748539A (zh) * 2017-09-25 2018-03-02 电子科技大学 基于rtcp误差特征识别的五轴机床多轴联动误差溯源方法
CN109408157A (zh) * 2018-11-01 2019-03-01 西北工业大学 一种多机器人协同任务的确定方法及装置
CN112298600A (zh) * 2020-09-18 2021-02-02 成都飞机工业(集团)有限责任公司 一种重心转动的飞机大部件多轴全主动调姿方法及装置
CN115122337A (zh) * 2022-08-16 2022-09-30 深圳市华成工业控制股份有限公司 带有地轨的多轴机器人标定方法、***、电子设备和可读存储介质
CN115493635A (zh) * 2022-10-12 2022-12-20 哈尔滨理工大学 一种面向孔位补偿与姿态检测的实验平台和调整方法
CN115933756A (zh) * 2022-11-18 2023-04-07 中航西安飞机工业集团股份有限公司 一种随位并联三坐标***组的自动联控调姿定位方法

Family Cites Families (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US7024257B2 (en) * 2001-02-09 2006-04-04 Motion Engineering, Inc. System for motion control, method of using the system for motion control, and computer-readable instructions for use with the system for motion control
US10162339B2 (en) * 2015-04-08 2018-12-25 Sciperio, Inc Automated manufacturing using modular structures and real time feedback for high precision control

Patent Citations (20)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN101362512A (zh) * 2008-09-19 2009-02-11 浙江大学 一种基于四个***的飞机部件位姿调整***及方法
CN101362513A (zh) * 2008-09-19 2009-02-11 浙江大学 基于三个***的飞机部件位姿调整协同控制方法
CN101850512A (zh) * 2010-04-20 2010-10-06 浙江大学 一种大行程、高刚度、高精度三坐标***
CN102313516A (zh) * 2011-08-05 2012-01-11 南京航空航天大学 随动式***顶端球心空间坐标的测量工具及其测量方法
CN102331745A (zh) * 2011-09-20 2012-01-25 中达电通股份有限公司 总线型运动控制器对制袋机的控制***及其控制方法
CN104602635A (zh) * 2012-06-28 2015-05-06 伊西康内外科公司 多轴线关节运动和旋转外科工具
CN102736554A (zh) * 2012-07-05 2012-10-17 浙江大学 一种基于刚度匹配的重载三坐标数控***设计方法
CN203109951U (zh) * 2013-01-17 2013-08-07 常州先进制造技术研究所 一种上下料机械手运动控制装置
CN104935543A (zh) * 2014-03-17 2015-09-23 斯沃奇集团研究和开发有限公司 用于相位调制信号的同步解调器电子电路
CN105242640A (zh) * 2014-07-09 2016-01-13 北京自动化控制设备研究所 一种新型的高速高精度多轴伺服运动控制器电路
CN204151380U (zh) * 2014-10-31 2015-02-11 杭州通绿机械有限公司 一种实轴热加工退火炉
CN105182914A (zh) * 2015-09-25 2015-12-23 中国矿业大学 绳索传动的多动平台并联髋关节试验机控制***及方法
CN106292545A (zh) * 2016-08-18 2017-01-04 四川泛华航空仪表电器有限公司 利用宏程序数控加工圆柱曲面的方法
CN106907389A (zh) * 2017-03-17 2017-06-30 常州大学 一种具有远程运动中心的大转角球铰结构
CN107748539A (zh) * 2017-09-25 2018-03-02 电子科技大学 基于rtcp误差特征识别的五轴机床多轴联动误差溯源方法
CN109408157A (zh) * 2018-11-01 2019-03-01 西北工业大学 一种多机器人协同任务的确定方法及装置
CN112298600A (zh) * 2020-09-18 2021-02-02 成都飞机工业(集团)有限责任公司 一种重心转动的飞机大部件多轴全主动调姿方法及装置
CN115122337A (zh) * 2022-08-16 2022-09-30 深圳市华成工业控制股份有限公司 带有地轨的多轴机器人标定方法、***、电子设备和可读存储介质
CN115493635A (zh) * 2022-10-12 2022-12-20 哈尔滨理工大学 一种面向孔位补偿与姿态检测的实验平台和调整方法
CN115933756A (zh) * 2022-11-18 2023-04-07 中航西安飞机工业集团股份有限公司 一种随位并联三坐标***组的自动联控调姿定位方法

Also Published As

Publication number Publication date
CN116449772A (zh) 2023-07-18

Similar Documents

Publication Publication Date Title
CN111360827A (zh) 一种视觉伺服切换控制方法及***
CN107877517B (zh) 基于CyberForce遥操作机械臂的运动映射方法
CN108241339A (zh) 仿人机械臂的运动求解和构型控制方法
JP5393461B2 (ja) 多軸機械の数値制御方法及び該方法を用いた処理システム
CN112605996B (zh) 一种面向冗余机械臂的无模型碰撞避免控制方法
CN107253191B (zh) 一种双机械臂***及其协调控制方法
Liu et al. An adaptive ball-head positioning visual servoing method for aircraft digital assembly
He et al. Kinematics analysis and numerical simulation of a manipulator based on virtual prototyping
CN112958974A (zh) 一种基于三维视觉的可交互自动化焊接***
CN114055467B (zh) 基于五自由度机器人的空间位姿在线仿真***
CN112965442B (zh) 一种用于镜像铣削加工的协同运动控制方法和***
CN116449772B (zh) 一种多轴协同运动控制方法、装置、设备及介质
CN109366486A (zh) 柔性机器人逆运动学求解方法、***、设备、存储介质
CN110026986B (zh) 多臂协同作业柔顺控制方法
CN116834009A (zh) 一种分布式虚实孪生的机器人位姿误差在线补偿***
Xie et al. A parallel machining robot and its control method for high-performance machining of curved parts
CN110434854A (zh) 一种基于数据驱动的冗余度机械臂视觉伺服控制方法与装置
CN109773581B (zh) 一种机器人应用于再现机加工的方法
Haihua et al. Cooperative motion planning of dual industrial robots via offline programming
JP2021186929A (ja) 多軸ロボットの制御方法
Wang et al. A novel 2-SUR 6-DOF parallel manipulator actuated by spherical motion generators
CN115533896B (zh) 一种递推式的机器人双臂协同作业路径规划方法
Yang et al. A web-based 3d virtual robot remote control system
Glavonjic et al. Functional simulator of 3-axis parallel kinematic milling machine
JP2000112510A (ja) ロボットの教示方法及びその装置

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