CN101362511B - 基于四个定位器的飞机部件位姿调整协同控制方法 - Google Patents
基于四个定位器的飞机部件位姿调整协同控制方法 Download PDFInfo
- Publication number
- CN101362511B CN101362511B CN2008101616674A CN200810161667A CN101362511B CN 101362511 B CN101362511 B CN 101362511B CN 2008101616674 A CN2008101616674 A CN 2008101616674A CN 200810161667 A CN200810161667 A CN 200810161667A CN 101362511 B CN101362511 B CN 101362511B
- Authority
- CN
- China
- Prior art keywords
- adjusted
- aircraft components
- coordinate system
- pose
- steady arm
- 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
- 238000000034 method Methods 0.000 title claims abstract description 28
- 230000002195 synergetic effect Effects 0.000 title claims description 13
- 230000033001 locomotion Effects 0.000 claims abstract description 29
- 230000001360 synchronised effect Effects 0.000 abstract description 7
- 230000001133 acceleration Effects 0.000 description 7
- 238000006073 displacement reaction Methods 0.000 description 7
- 238000005516 engineering process Methods 0.000 description 6
- 230000001105 regulatory effect Effects 0.000 description 6
- 239000011159 matrix material Substances 0.000 description 5
- 238000010586 diagram Methods 0.000 description 4
- 210000001503 joint Anatomy 0.000 description 3
- 238000013459 approach Methods 0.000 description 2
- 238000004519 manufacturing process Methods 0.000 description 2
- 238000003032 molecular docking Methods 0.000 description 2
- 230000007812 deficiency Effects 0.000 description 1
- 239000000203 mixture Substances 0.000 description 1
- 238000004321 preservation Methods 0.000 description 1
- 238000006467 substitution reaction Methods 0.000 description 1
- 230000009466 transformation Effects 0.000 description 1
Images
Landscapes
- Feedback Control In General (AREA)
Abstract
本发明公开了一种基于四个定位器的飞机部件位姿调整协同控制方法。包括如下步骤:1)建立全局坐标系OXYZ,在全局坐标系下计算出飞机部件的当前位姿与目标位姿;2)生成飞机部件的自动调整路径与点动调整路径;3)根据自动调整路径与点动调整路径规划出定位器与飞机部件的球铰联结点的轨迹;4)将球铰联结点的轨迹转化为12电机轴同步控制网络的驱动参数;5)基于SynqNet总线构建12电机轴同步控制网络,单根电机轴的位置伺服采用全闭环数字控制;6)选择两个定位器,配置两者的关系为主从运动模式。本发明的优点在于:1)可以规划出飞机部件位姿调整的路径;2)可以实现定位器单轴运动的全闭环控制;3)可以实现位姿调整系统的12轴同步运动。
Description
技术领域
本发明涉及一种基于四个定位器的飞机部件位姿调整协同控制方法。
背景技术
在航空航天制造领域,为实现大部件的对接装配,需要对飞机机身等大型刚体部件的位姿进行调整。传统的基于千斤顶和装配型架的调整方式,将飞机部件上的特征点视作空间的离散点,而不是刚体上相互距离保持不变的点。采用千斤顶调整部件位姿的核心思想是使得这些特征点尽量向装配型架逼近,并且,在采用多个千斤顶进行调整时,不考虑相互之间的距离协调问题。这种基于模拟量协调的调整方法过程简单,但是对飞机部件有拉扯或挤压现象,极易引起装配应力;每个部件与一个装配型架对应,缺乏柔性;每次调整的结果带有随机性,装配质量取决于工人的经验,可靠性和精度较低。
调姿工装是实现飞机数字化装配的关键设备,也是将控制指令转化为实际运动的执行机构。国外数字化装配技术的一个主要特征就是在飞机的总装阶段越来越多地使用自动化调姿工装,基于工业现场总线,构建多轴同步运动控制网络,实现多机械装置的协调运动,准确平稳地实现大部件位姿调整和对接。采用计算机控制的自动化千斤顶、激光跟踪定位系统等组成的柔性对接平台在波音、雷神等飞机公司得到了推广应用(郭恩明.国外飞机柔性装配技术.航空制造技术,2005,(9):28-32)。与传统的对接平台相比,自动化装配系统的应用使装配质量大幅度提高,效率高,通用型强,能适应不同尺寸的机身结构(刘善国.先进飞机装配技术及其发展.航空制造技术,2006,(10):38-41)。
大型飞机部件的位姿调整路径规划一般都基于逆运动学原理,首先将飞机部件视为刚体,根据刚体的初始、目标位姿,规划刚体的位姿路径,再分解到调姿工装的各支链上,得到支链轨迹。根据此方法规划的支链轨迹可能是任意形状的空间曲线,这给控制系统的位置跟踪带来了难度,因为商用的多轴协调控制系统如西门子ProfiNet、丹纳赫SynqNet一般只能支持诸如空间直线、平面圆弧等曲线形式,因此,为保证轨迹表达式的通用性,需要将具有任意形状的支链轨迹进行后续处理,生成控制系统可以执行的位置指令。
发明内容
本发明的目的是克服现有技术不足,提供一种基于四个定位器的飞机部件位姿调整协同控制方法。
基于四个定位器的飞机部件位姿调整协同控制方法包括如下步骤:
1)建立全局坐标系OXYZ,并在飞机部件上固结一个局部坐标系O′X′Y′Z′,采用局部坐标系原点O′在全局坐标系OXYZ下的坐标表达飞机部件的位置,采用“翻转、俯仰、侧倾”表达飞机部件的姿态;
2)在全局坐标系下计算出飞机部件的当前位姿与目标位姿;
3)将飞机部件的自动调整路径处理为一次平移和一次旋转,从当前位姿到达目标位姿;
4)根据位姿的相对调整量生成飞机部件的点动调整路径;
5)根据自动调整路径与点动调整路径规划出定位器与飞机部件的球铰联结点的轨迹;
6)每个定位器有X、Y、Z三个方向运动的电机轴,共四个定位器,所以将球铰联结点的轨迹转化为12电机轴同步控制网络的驱动参数;
7)基于SynqNet总线构建12电机轴同步控制网络,单根电机轴的位置伺服采用带旋转变压器的伺服电机+直线光栅尺反馈构成全闭环数字控制;
8)选择一个定位器作为从动定位器,选择距离该从动定位器最近的定位器作为主动定位器,配置两者的关系为主从运动模式。
所述的在全局坐标系下计算出飞机部件的当前位姿与目标位姿步骤:
1)计算出当前或目标位姿下,飞机部件局部坐标系原点O′在全局坐标系OXYZ下的坐标,表达飞机部件的当前或目标位置P=[Px,Py,Pz]T;
2)令飞机部件局部坐标系的3个坐标轴从与全局坐标系各坐标轴重合的状态开始,依次绕全局坐标系X、Y、Z轴旋转a、b、c弧度到达当前或目标姿态,并以该角度序列表达飞机部件的当前或目标姿态RPY=[a,b,c]T;
3)综合当前或目标位置、当前或目标姿态,写出飞机部件的当前位姿或目标位姿L=[Px,Py,Pz,a,b,c]T。
所述的根据位姿的相对调整量生成飞机部件的点动调整路径步骤:是采用如下8种方法实现:
1)飞机部件沿全局坐标系X轴平移,相对调整量为Px;
2)飞机部件沿全局坐标系Y轴平移,相对调整量为Py;
3)飞机部件沿全局坐标系Z轴平移,相对调整量为Pz;
4)飞机部件沿全局坐标系矢量V的方向平移,相对调整量为Pv;
5)飞机部件绕全局坐标系X轴旋转,相对调整量为a度;
6)飞机部件绕全局坐标系Y轴旋转,相对调整量为b度;
7)飞机部件绕全局坐标系Z轴旋转,相对调整量为c度;
8)飞机部件绕全局坐标系矢量V旋转,相对调整量为v度。
所述的根据自动调整路径与点动调整路径规划出定位器与飞机部件的球铰联结点的轨迹步骤:
1)对于飞机部件的平移路径,采用基于时间的3~5次多项式法规划位置调整量,以使球铰联结点获得较好的动力学特性;
2)对于飞机部件的旋转路径,采用基于时间的3~5次多项式法规划角度调整量,以使球铰联结点获得较好的动力学特性。
所述的每个定位器有X、Y、Z三个方向运动的电机轴,共四个定位器,所以将球铰联结点的轨迹转化为12电机轴同步控制网络的驱动参数步骤:
1)对定位器与飞机部件的球铰联结点的连续轨迹进行分割,并以直线段将分割点连接,构成多直线段轨迹,共有4条多直线段轨迹,每个直线段的长度为0.01~0.05mm;
2)每个直线段配置的时间间隔为0.05~0.25s,每个直线段轨迹的速度为0.04~0.1mm/s。
所述的基于SynqNet总线构建12电机轴同步控制网络,单根电机轴的位置伺服采用带旋转变压器的伺服电机+直线光栅尺反馈构成全闭环数字控制步骤:使用ZMP运动控制卡,配合使用12个Danaher S200系列驱动器、AKM系列伺服电机及海德汉直线光栅尺组成的网络节点,构成12电机轴同步控制网络。
所述的选择一个定位器作为从动定位器,选择距离该从属定位器最近的定位器作为主动定位器,配置两者的关系为主从运动模式步骤:将主动定位器的X、Y、Z电机轴配置为Master,与主动定位器各电机轴对应,将从动定位器的X、Y、Z电机轴配置为Slave。从动定位器的各电机轴跟随主动定位器相应的电机轴运动。
本发明的优点在于:1)可以规划出飞机部件位姿调整的路径;2)可以实现定位器单轴运动的全闭环控制;3)可以实现位姿调整系统的12轴同步运动。
附图说明
图1是本发明的基于SynqNet总线的12轴同步运动控制网络;
图2是本发明的单轴全闭环位置伺服控制框图;
图3是本发明的从动电机轴跟随主动电机轴运动的控制框图;
图4是本发明的基于四个定位器的飞机部件位姿调整系统结构示意图;
图5是本发明的球铰联结点轨迹分割示意图。
图中:定位器1、联结点2、待调整飞机部件3。
具体实施方式
基于四个定位器的飞机部件位姿调整协同控制方法包括如下步骤:
1)建立全局坐标系OXYZ,并在待调整飞机部件3上固结一个局部坐标系O′X′Y′Z′,采用局部坐标系原点O′在全局坐标系OXYZ下的坐标表达待调整飞机部件3的位置,采用“翻转、俯仰、侧倾”表达待调整飞机部件3的姿态;
2)在全局坐标系下计算出待调整飞机部件3的当前位姿与目标位姿;
3)将待调整飞机部件3的自动调整路径处理为一次平移和一次旋转,从当前位姿到达目标位姿;
4)根据位姿的相对调整量生成待调整飞机部件3的点动调整路径;
5)根据自动调整路径与点动调整路径规划出定位器1与待调整飞机部件3的球铰联结点2的轨迹;
6)每个定位器有X、Y、Z三个方向运动的电机轴,共四个定位器,所以将球铰联结点的轨迹转化为12电机轴同步控制网络的驱动参数;
7)基于SynqNet总线构建12电机轴同步控制网络,单根电机轴的位置伺服采用带旋转变压器的伺服电机+直线光栅尺反馈构成全闭环数字控制;
8)选择一个定位器作为从动定位器,选择距离该从动定位器最近的定位器作为主动定位器,配置两者的关系为主从运动模式。
所述的在全局坐标系下计算出待调整飞机部件3的当前位姿与目标位姿步骤:
1)计算出当前或目标位姿下,待调整飞机部件3局部坐标系原点O′在全局坐标系OXYZ下的坐标,表达待调整飞机部件3的当前或目标位置P=[Px,Py,Pz]T;
2)令待调整飞机部件3局部坐标系的三个坐标轴从与全局坐标系各坐标轴重合的状态开始,依次绕全局坐标系X、Y、Z轴旋转a、b、c弧度到达当前或目标姿态,并以该角度序列表达待调整飞机部件3的当前或目标姿态RPY=[a,b,c]T;
3)综合当前或目标位置、当前或目标姿态,写出待调整飞机部件3的当前位姿或目标位姿L=[Px,Py,Pz,a,b,c]T。
所述的将待调整飞机部件3的自动调整路径处理为一次平移和一次旋转,从当前位姿到达目标位姿步骤:
设待调整飞机部件3的当前位姿为:
L0=[x0,y0,z0,a0,b0,c0]T
待调整飞机部件3的目标位姿为:
Lf=[xf,yf,zf,af,bf,cf]T
则待调整飞机部件3的平移调整量为:
P=[PxPyPz]T=[xf,yf,zf]T-[x0,y0,z0]T
待调整飞机部件3的姿态调整量为:
RPY=[abc]T=[af,bf,cf]T-[a0,b0,c0]T
再根据RPY角计算出以等效角位移矢量表达的姿态调整量w,计算过程如下:
首先根据RPY角计算待调整飞机部件3的姿态调整矩阵R,计算公式为:
其中R为3×3的姿态变换矩阵:
再根据R计算等效角位移w=dθ=θ[d1d2d3]T,其中d为等效转轴,θ为等效转角,计算公式为:
根据公式(错误!未找到引用源。),可解得:
令待调整飞机部件3完成平移调整量P和姿态调整量w,即可从当前位姿到达目标位姿。
所述的根据位姿的相对调整量生成待调整飞机部件3的点动调整路径步骤:是采用如下8种方法实现:
对于位姿的点动调整,规定待调整飞机部件3从当前位姿可以依照下述8种方法运动,每种方法都是一个功能独立的模块:
1)待调整飞机部件3沿全局坐标系X轴平移,相对调整量为Px;
2)待调整飞机部件3沿全局坐标系Y轴平移,相对调整量为Py;
3)待调整飞机部件3沿全局坐标系Z轴平移,相对调整量为Pz;
4)待调整飞机部件3沿全局坐标系矢量V的方向平移,相对调整量为Pv;
5)待调整飞机部件3绕全局坐标系X轴旋转,相对调整量为a度;
6)待调整飞机部件3绕全局坐标系Y轴旋转,相对调整量为b度;
7)待调整飞机部件3绕全局坐标系Z轴旋转,相对调整量为c度;
8)待调整飞机部件3绕全局坐标系矢量V旋转,相对调整量为v度。
待调整飞机部件3位姿的自动调整适用于初步调整,系统根据初始位姿和目标位姿自动完成,无需人工干预;而点动调整则用于精确调整或部件对接,用户需根据现场工况选择调整量,以比较小的步长向目标位姿逼近。
位姿的点动调整事实上是已知平移方向+调整量或已知旋转轴+调整量的调整。以点动调整情形1)为例,用户输入调整量p后,则系统自动生成平移调整量:
P=[p,0,0]T
姿态调整量:
RPY=[0,0,0]T
对P进行5次多项式插值,生成位置调整曲线P(t),规划方法与自动调整相同。
所述的根据自动调整路径与点动调整路径规划出定位器与飞机部件的球铰联结点的轨迹步骤:
对于位置调整量P,设在时间T1内完成,则:
P0=0,PT1=P;v0=0,vT1=0;a0=0,aT1=0
其中P、v、a分别为位移、速度和加速度,P0、PT1分别为0时刻与T1时刻的位移,v0、vT1、a0、aT1具有相似含义。
设位置调整曲线表达式为:P(t)=k0+k1t+k2t2+k3t3+k4t4+k5t5,则多项式的系数满足6个约束条件:
公式(错误!未找到引用源。)含有6个未知数,6个方程,其解为:
根据公式(错误!未找到引用源。),可解得曲线P(t)的各项系数,该曲线具有平滑变化的速度、加速度。时间T1是根据图4位姿调整系统的物理特性确定的,在该时间内,定位器1达到的最大速度和加速度都不会超过系统允许的最大值。
对于角度调整量θ,设在时间T2内完成,则:
θ0=0,θT2=θ;
ω0=0,ωT2=0;γ0=0,γT2=0
其中θ、ω、γ分别为角位移、角速度和角加速度,θ0、θT2分别为0时刻与T2时刻的角位移,ω0、ωT2、γ0、γT2具有相似含义。设角度调整曲线表达式为:θ(t)=l0+l1t+l2t2+l3t3+l4t4+l5t5,根据这些已知条件,可解得:
根据公式(错误!未找到引用源。),可解得曲线θ(t)的各项系数,该曲线具有平滑变化的角速度、角加速度。时间T2也是根据图4位姿调整系统的物理特性确定的,在该时间内,定位器1能达到的最大速度和加速度都不会超过系统允许的最大值。
根据公式:
w(t)=dθ(t) (8)
解得角位移曲线w(t),将w(t)代入公式(3)可得姿态变换矩阵函数R(t):
位置调整曲线P(t)与姿态变换矩阵函数R(t)就是待调整飞机部件3的自动位姿调整路径。
基于逆运动学原理,可将规划出的位置调整曲线P(t)与姿态变换矩阵函数R(t)转化为相关调姿点的轨迹,该轨迹具有平滑变化的速度和加速度,转化方法如下:
如图3所示,设联结点2(包括A、B、C、D)在当前位姿下具有初始坐标A0、B0、C0、D0,则联结点轨迹(包括A(t)、B(t)、C(t)、D(t))为:
A(t)=R(t)A0+P(t)
B(t)=R(t)B0+P(t)
C(t)=R(t)C0+P(t)
D(t)=R(t)D0+P(t)
(10)
位姿调整包括两个过程:首先进行平移,T1时间内完成;然后进行旋转,T2时间内完成。因此,共耗时T1+T2。
所述的每个定位器有X、Y、Z三个方向运动的电机轴,共四个定位器,所以将球铰联结点的轨迹转化为12电机轴同步控制网络的驱动参数步骤:
1)图4所示的位姿调整系统采用四个定位器2,则需要生成4条球铰联结点轨迹,将每条轨迹按照统一的时间间隔进行分割,再把分割点以空间直线段连接,构成多直线段轨迹。图5所示实线为球铰联结点原轨迹,虚线为分割后的多直线段轨迹。分割的依据为:在本次时间间隔ΔT内,4条直线段的长度不超过Slice_Max。每条轨迹在X、Y、Z上投影轨迹的最大速度不超过规定的最大速度Velocity_Max.。
2)Slice_Max是为了保证,在本次时间间隔内,4条直线段上,任意时刻2点之间的空间距离D1满足(单位mm):
D0-0.05<=D1<=D0+0.05
D0是与D1对应的调姿点之间的标准距离,例如调姿点A和调姿点B之间的距离|AB|(在调姿始末,该标准距离保持不变,表征调姿对象为刚体。),则:
|AB|-0.05<=|A′(t)B′(t)|<=|AB|+0.05
3)Velocity是根据图3位姿调整系统的物理特性确定的,以低于该速度运动的轴可以达到很好的位置伺服精度。
4)计算出分割后的多直线段轨迹4在X、Y、Z方向上的投影。将投影轨迹与相应的时间间隔配成一组,在计算机内以二维数组的格式保存下来,等待ZMP运动控制卡取用。
所述的基于SynqNet总线构建12电机轴同步控制网络,单根电机轴的位置伺服采用带旋转变压器的伺服电机+直线光栅尺反馈构成全闭环数字控制步骤:1)以S200型驱动器,驱动AKM型系列伺服电机,辅以海德汉直线光栅尺作位置反馈,构成一个单轴运动节点,如图1所示。其中AKM电机的旋转变压器反馈线接S200驱动器的第一编码器接口,直线光栅尺反馈线接S200驱动器的第二编码器接口。
2)如图1所示,位姿调整系统共有12个单轴运动节点,采用ZMP运动控制卡,配合使用SynqNet总线方式搭建12轴同步运动控制网络。
3)单根轴的位置伺服采用全闭环数字控制方式实现,如图2所示。
所述的选择一个定位器作为从动定位器,选择距离该从属定位器最近的定位器作为主动定位器,配置两者的关系为主从运动模式步骤:
1)如图4所示,选择定位器D作为主动定位器,定位器C为从动定位器;
2)将主动定位器的X、Y、Z电机轴配置为Master,与主动定位器各电机轴对应,将从动定位器的X、Y、Z电机轴配置为Slave。从动定位器的各电机轴跟随主动定位器相应的电机轴运动;
3)从动电机轴跟随主动电机轴运动的控制框图如图3所示。
Claims (7)
1.一种基于四个定位器的飞机部件位姿调整协同控制方法,其特征在于包括如下步骤:
1)建立全局坐标系OXYZ,并在待调整飞机部件(3)上固结一个局部坐标系O′X′Y′Z′,采用局部坐标系原点O′在全局坐标系OXYZ下的坐标表达待调整飞机部件(3)的位置,采用“翻转、俯仰、侧倾”表达待调整飞机部件(3)的姿态;
2)在全局坐标系下计算出待调整飞机部件(3)的当前位姿与目标位姿;
3)将待调整飞机部件(3)的自动调整路径处理为一次平移和一次旋转,从当前位姿到达目标位姿;
4)根据位姿的相对调整量生成待调整飞机部件(3)的点动调整路径;
5)根据自动调整路径与点动调整路径规划出定位器(1)与待调整飞机部件(3)的球铰联结点(2)的轨迹;
6)每个定位器有X、Y、Z三个方向运动的电机轴,共四个定位器,所以将球铰联结点的轨迹转化为12电机轴同步控制网络的驱动参数;
7)基于SynqNet总线构建12电机轴同步控制网络,单根电机轴的位置伺服采用带旋转变压器的伺服电机和直线光栅尺反馈构成全闭环数字控制;
8)选择一个定位器作为从动定位器,选择距离该从动定位器最近的定位器作为主动定位器,配置两者的关系为主从运动模式。
2.根据权利要求1所述的一种基于四个定位器的飞机部件位姿调整协同控制方法,其特征在于所述的在全局坐标系下计算出待调整飞机部件(3)的当前位姿与目标位姿步骤:
1)计算出当前或目标位姿下,待调整飞机部件(3)局部坐标系原点O′在全局坐标系OXYZ下的坐标,表达待调整飞机部件(3)的当前或目标位置P=[Px,Py,Pz]T;
2)令待调整飞机部件(3)局部坐标系的三个坐标轴从与全局坐标系各坐标轴重合的状态开始,依次绕全局坐标系X、Y、Z轴旋转a、b、c弧度到达当前或目标姿态,并以该角度序列表达待调整飞机部件(3)的当前或目标姿态RPY=[a,b,c]T;
3)综合当前或目标位置、当前或目标姿态,写出待调整飞机部件(3)的当前位姿或目标位姿L=[Px,Py,Pz,a,b,c]T。
3.根据权利要求1所述的一种基于四个定位器的飞机部件位姿调整协同控制方法,其特征在于所述的根据位姿的相对调整量生成待调整飞机部件(3)的点动调整路径步骤:是采用如下8种方法实现:
1)待调整飞机部件(3)沿全局坐标系X轴平移,相对调整量为Px;
2)待调整飞机部件(3)沿全局坐标系Y轴平移,相对调整量为Py;
3)待调整飞机部件(3)沿全局坐标系Z轴平移,相对调整量为Pz;
4)待调整飞机部件(3)沿全局坐标系矢量V的方向平移,相对调整量为Pv;
5)待调整飞机部件(3)绕全局坐标系X轴旋转,相对调整量为a度;
6)待调整飞机部件(3)绕全局坐标系Y轴旋转,相对调整量为b度;
7)待调整飞机部件(3)绕全局坐标系Z轴旋转,相对调整量为c度;
8)待调整飞机部件(3)绕全局坐标系矢量V旋转,相对调整量为v度。
4.根据权利要求1所述的一种基于四个定位器的飞机部件位姿调整协同控制方法,其特征在于所述的根据自动调整路径与点动调整路径规划出定位器(1)与待调整飞机部件(3)的球铰联结点(2)的轨迹步骤:
1)对于待调整飞机部件(3)的平移路径,采用基于时间的3~5次多项式法规划位置调整量,以使球铰联结点(2)获得较好的动力学特性;
2)对于待调整飞机部件(3)的旋转路径,采用基于时间的3~5次多项式法规划角度调整量,以使球铰联结点(2)获得较好的动力学特性。
5.根据权利要求1所述的一种基于四个定位器的飞机部件位姿调整协同控制方法,其特征在于所述的每个定位器有X、Y、Z三个方向运动的电机轴,共四个定位器,所以将球铰联结点的轨迹转化为12电机轴同步控制网络的驱动参数步骤:
1)对定位器(1)与待调整飞机部件(3)的球铰联结点(2)的连续轨迹进行分割,并以直线段将分割点连接,构成多直线段轨迹,共有4条多直线段轨迹,每个直线段的长度为0.01~0.05mm;
2)每个直线段配置的时间间隔为0.05~0.25s,每个直线段轨迹的速度为0.04~0.1mm/s。
6.根据权利要求1所述的一种基于四个定位器的飞机部件位姿调整协同控制方法,其特征在于所述的基于SynqNet总线构建12电机轴同步控制网络,单根电机轴的位置伺服采用带旋转变压器的伺服电机+直线光栅尺反馈构成全闭环数字控制步骤:使用ZMP运动控制卡,配合使用12个Danaher S200系列驱动器、AKM系列伺服电机及海德汉直线光栅尺组成的网络节点,构成12电机轴同步控制网络。
7.根据权利要求1所述的一种基于四个定位器的飞机部件位姿调整协同控制方法,其特征在于所述的选择一个定位器作为从动定位器,选择距离该从属定位器最近的定位器作为主动定位器,配置两者的关系为主从运动模式步骤:将主动定位器的X、Y、Z电机轴配置为主动轴,与主动定位器各电机轴对应,将从动定位器的X、Y、Z电机轴配置为从动轴,从动定位器的各电机轴跟随主动定位器相应的电机轴运动。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN2008101616674A CN101362511B (zh) | 2008-09-19 | 2008-09-19 | 基于四个定位器的飞机部件位姿调整协同控制方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN2008101616674A CN101362511B (zh) | 2008-09-19 | 2008-09-19 | 基于四个定位器的飞机部件位姿调整协同控制方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN101362511A CN101362511A (zh) | 2009-02-11 |
CN101362511B true CN101362511B (zh) | 2010-11-10 |
Family
ID=40389162
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN2008101616674A Expired - Fee Related CN101362511B (zh) | 2008-09-19 | 2008-09-19 | 基于四个定位器的飞机部件位姿调整协同控制方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN101362511B (zh) |
Cited By (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN102183205A (zh) * | 2011-01-19 | 2011-09-14 | 北京航空航天大学 | 一种大型零部件最佳装配位姿匹配的方法 |
CN102514724A (zh) * | 2011-12-06 | 2012-06-27 | 南京航空航天大学 | 基于3-2-1随动式定位器的飞机部件位姿调整方法 |
Families Citing this family (24)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN102001451B (zh) * | 2010-11-12 | 2013-05-29 | 浙江大学 | 基于四个数控定位器、调姿平台和移动托架的飞机部件调姿、对接系统及方法 |
CN102284859A (zh) * | 2011-05-06 | 2011-12-21 | 中国科学院上海技术物理研究所 | 一种航天遥感仪器的数字化装配方法 |
CN102730197A (zh) * | 2012-05-16 | 2012-10-17 | 中国商用飞机有限责任公司 | 一种机身定位调姿装置和方法 |
CN103112596A (zh) * | 2012-12-19 | 2013-05-22 | 江西洪都航空工业集团有限责任公司 | 一种飞机机载设备支托装置 |
CN103267210B (zh) * | 2013-05-16 | 2015-06-10 | 燕山大学 | 一种六自由度并联指向平台 |
CN103413137B (zh) * | 2013-08-05 | 2016-04-27 | 浙江大学 | 基于多规则的交互手势运动轨迹分割方法 |
CN103496449B (zh) * | 2013-08-29 | 2015-09-30 | 北京航空航天大学 | 一种飞机侧壁部件装配调姿轨迹规划方法 |
CN103921954B (zh) * | 2014-04-25 | 2016-01-20 | 浙江大学 | 基于三轴数控定位器的飞机壁板装配变形的数字化校正方法 |
CN104625720B (zh) * | 2015-01-07 | 2017-01-18 | 北京卫星环境工程研究所 | 一种基于激光跟踪仪和并联调姿平台的太阳翼自动对接方法 |
CN106275494A (zh) * | 2015-06-05 | 2017-01-04 | 陕西飞机工业(集团)有限公司 | 飞机装配工装用整体底座式标准工艺装备 |
CN105750933B (zh) * | 2016-03-02 | 2018-08-03 | 浙江日发航空数字装备有限责任公司 | 一种飞机数字化精加工台 |
CN106275501B (zh) * | 2016-08-30 | 2018-08-14 | 深圳市劲拓自动化设备股份有限公司 | 一种六自由度调姿平台的控制系统及控制方法 |
CN106403834B (zh) * | 2016-09-26 | 2019-12-13 | 中国建筑第八工程局有限公司 | 一种现浇混凝土变形测量系统及其测量方法 |
CN107512404A (zh) * | 2017-07-04 | 2017-12-26 | 西安飞机工业(集团)有限责任公司 | 一种飞机部件调姿系统空间运动精度检测系统及方法 |
CN107651045B (zh) * | 2017-08-28 | 2020-01-21 | 浙江大学 | 一种飞机翼盒转站用agv车及其车载翼盒调姿定位系统 |
CN109552663B (zh) * | 2018-11-22 | 2021-05-04 | 南京航空航天大学 | 一种柔性定位器以及应用其装配复合材料翼盒的方法 |
CN109911241B (zh) * | 2019-03-20 | 2022-06-14 | 成都飞机工业(集团)有限责任公司 | 一种基于七次多项式的多部段自动化调姿的调姿方法 |
CN112824228B (zh) * | 2019-11-20 | 2024-03-12 | 中国商用飞机有限责任公司 | 一种可变约束的飞机部件调姿对接定位方法 |
CN111912401B (zh) * | 2020-06-30 | 2021-08-03 | 成都飞机工业(集团)有限责任公司 | 一种面向飞机大部件调姿机构工作空间求解方法 |
CN112298600B (zh) * | 2020-09-18 | 2022-05-06 | 成都飞机工业(集团)有限责任公司 | 一种重心转动的飞机大部件多轴全主动调姿方法及装置 |
CN112340054B (zh) * | 2020-09-18 | 2022-05-06 | 成都飞机工业(集团)有限责任公司 | 一种飞机大部件多轴主随动调姿方法及调姿装置 |
CN112361957B (zh) * | 2020-09-30 | 2022-01-25 | 成都飞机工业(集团)有限责任公司 | 一种多个定位器空间位置关系测量与调整方法 |
CN112570987B (zh) * | 2020-10-27 | 2022-06-14 | 成都飞机工业(集团)有限责任公司 | 一种柔性调姿对合工装及其装配方法 |
CN112613130B (zh) * | 2021-03-05 | 2021-07-02 | 成都飞机工业(集团)有限责任公司 | 基于两个三坐标定位器的维型定位位姿仿真匹配方法 |
-
2008
- 2008-09-19 CN CN2008101616674A patent/CN101362511B/zh not_active Expired - Fee Related
Cited By (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN102183205A (zh) * | 2011-01-19 | 2011-09-14 | 北京航空航天大学 | 一种大型零部件最佳装配位姿匹配的方法 |
CN102514724A (zh) * | 2011-12-06 | 2012-06-27 | 南京航空航天大学 | 基于3-2-1随动式定位器的飞机部件位姿调整方法 |
Also Published As
Publication number | Publication date |
---|---|
CN101362511A (zh) | 2009-02-11 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN101362511B (zh) | 基于四个定位器的飞机部件位姿调整协同控制方法 | |
CN100565407C (zh) | 基于三个定位器的飞机部件位姿调整协同控制方法 | |
CN109605371B (zh) | 一种移动式混联机器人加工集成系统 | |
CN110497411B (zh) | 一种工业机器人协同运动控制方法 | |
DK2285537T3 (en) | Device and method for computer-assisted generation of a manipulatorbane | |
CN102001451B (zh) | 基于四个数控定位器、调姿平台和移动托架的飞机部件调姿、对接系统及方法 | |
JP3592628B2 (ja) | 数値制御方法 | |
CN105183009B (zh) | 一种冗余机械臂轨迹控制方法 | |
CN104339349A (zh) | 机器人装置及机器人控制方法 | |
WO2014061395A1 (en) | Determining trajectories of redundant actuators jointly tracking reference trajectory | |
CN105900027A (zh) | 轨迹控制装置 | |
Chalak Qazani et al. | A study on motion of machine tools’ hexapod table on freeform surfaces with circular interpolation | |
US20040054437A1 (en) | Robot control apparatus | |
Yang et al. | A tool path generation and contour error estimation method for four-axis serial machines | |
CN103513612A (zh) | 控制工业机器人与变位机协调运动的系统及方法 | |
EP2523786B1 (en) | Method of finding feasible joint trajectories for an n-dof robot with rotation invariant process (n>5) | |
CN114055467B (zh) | 基于五自由度机器人的空间位姿在线仿真系统 | |
CN114952838B (zh) | 一种基于末端测量反馈的机械臂关节轨迹规划方法 | |
CN115113582A (zh) | 一种面向零件轮廓误差的五轴位置环增益离线矫正方法 | |
CN104061888A (zh) | 机器人三维激光加工头tcp坐标修正方法及装置 | |
JP6057284B2 (ja) | 多関節ロボット及び半導体ウェハ搬送装置 | |
CN106774163B (zh) | 高精度三维轮廓控制方法及装置 | |
CN110325326B (zh) | 连杆促动装置的控制装置和控制方法 | |
CN116088425A (zh) | 一种数控加工的伺服控制方法、装置、设备和存储介质 | |
CN101362515A (zh) | 飞机部件位姿调整路径规划方法 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
C06 | Publication | ||
C41 | Transfer of patent application or patent right or utility model | ||
PB01 | Publication | ||
TA01 | Transfer of patent application right |
Effective date of registration: 20081226 Address after: No. 38, Zhejiang Road, Zhejiang, Hangzhou Applicant after: Zhejiang University Co-applicant after: Chengdu aircraft industry (Group) Co., Ltd. Address before: No. 38, Zhejiang Road, Zhejiang, Hangzhou Applicant before: Zhejiang University |
|
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: 20101110 Termination date: 20130919 |