CN111745369B - 面向实时监控的大型舱段对接方法 - Google Patents
面向实时监控的大型舱段对接方法 Download PDFInfo
- Publication number
- CN111745369B CN111745369B CN202010644725.XA CN202010644725A CN111745369B CN 111745369 B CN111745369 B CN 111745369B CN 202010644725 A CN202010644725 A CN 202010644725A CN 111745369 B CN111745369 B CN 111745369B
- Authority
- CN
- China
- Prior art keywords
- real
- butt joint
- cabin
- pose
- docking
- 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
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B23—MACHINE TOOLS; METAL-WORKING NOT OTHERWISE PROVIDED FOR
- B23P—METAL-WORKING NOT OTHERWISE PROVIDED FOR; COMBINED OPERATIONS; UNIVERSAL MACHINE TOOLS
- B23P19/00—Machines for simply fitting together or separating metal parts or objects, or metal and non-metal parts, whether or not involving some deformation; Tools or devices therefor so far as not provided for in other classes
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
- B25B—TOOLS OR BENCH DEVICES NOT OTHERWISE PROVIDED FOR, FOR FASTENING, CONNECTING, DISENGAGING OR HOLDING
- B25B27/00—Hand tools, specially adapted for fitting together or separating parts or objects whether or not involving some deformation, not otherwise provided for
Landscapes
- Engineering & Computer Science (AREA)
- Mechanical Engineering (AREA)
- Toys (AREA)
- Automatic Assembly (AREA)
Abstract
一种面向实时监控的大型舱段对接方法,首先在准备阶段依次进行:定义实***姿信息、输入精度信息、建立销体与孔面的碰撞检测模型;完成对接准备后进行入对接流程,流程中根据实时传感器、设备运动数据更新实***姿,基于实时的位姿信息寻找对接的轨道段、销孔外调姿、销孔对接。本发明采用对接车间常见的轨道转运串联托架式架车,配合大尺寸数字测量技术,通过在线监控实现闭环控制,按照寻找对接轨道段、销孔外调姿、销孔对接的流程完成对接,明显提升大型舱段对接效率与质量一致性。
Description
技术领域
本发明涉及的是一种航天器制造领域的技术,具体是一种面向实时监控的大型舱段对接方法。
背景技术
舱段对接过程如图1所示:舱段为圆筒状结构,产品由多段组成,各段间通过定位销进行定位,完成对接后通过螺栓或螺柱实现最终的连接。对接过程中舱段安装在调姿设备上,调姿设备调整舱段姿态使定位销配合定位孔到达装配设计要求位置。
目前火箭总装采用“多型号并行、单件小批量”的生产模式,整个总装流程在一个工位上进行。舱段对接作为火箭总装过程中的一个核心环节,过程复杂、精度要求高。传统车间内铺设轨道,调姿架车通过轨道转运到对接位置,后通过人工协调、手动调整架车完成对接,效率低下、质量一致性低。现有的解决方案常为设计复杂高精度并联调姿设备实现自动化对接,但并联调姿设备体型较大,在上述场景下进行多次对接时对接时间减短,但舱段转运、准备时间较长。
发明内容
本发明针对现有技术存在的上述不足,提出一种面向实时监控的大型舱段对接方法,采用对接车间常见的轨道转运串联托架式架车,配合大尺寸数字测量技术,通过在线监控实现闭环控制,按照寻找对接轨道段、销孔外调姿、销孔对接的流程完成对接,明显提升大型舱段对接效率与质量一致性。
本发明是通过以下技术方案实现的:
本发明涉及一种面向实时监控的大型舱段对接方法,首先在准备阶段依次进行:①定义实***姿信息、②输入精度信息、③建立销体与孔面的碰撞检测模型;完成对接准备后进行入对接流程,流程中根据实时传感器、设备运动数据④更新实***姿,基于实时的位姿信息进行⑤寻找对接的轨道段、⑥销孔外调姿、⑦销孔对接。
所述的定义实***姿信息是指:输入位置传感器在测量工装坐标系的坐标,根据三点法获得;输入测量工装安装在舱段上时,舱段在测量传感器坐标系下的位姿;根据轨道、架车、工装环组成的调姿结构,得到运动关节量到轨道、架车行走构件、架车横移构件、架车升降构件、工装环位姿的映射;
所述的输入精度信息是指:输入对接允许位置误差和角度误差;输入架车控制精度。
所述的建立销体与孔面的碰撞检测模型是指:输入对接对应销、孔在舱段上的位姿,以及销半径、销长、孔半径、孔深,建立销体、孔面的参数方程;并以参数方程进行空间八叉树分割建立碰撞检测模型;
所述的更新实***姿是指:架车安装完舱段、舱段安装完测量工装后,架车控制***、测量***分别实时发送四台架车各自四个关节运动数据、测量传感器位置数据,对接过程中根据数据解算测量工装、舱段、架车行走构件、架车横移构件、架车升降构件和工装环的位姿,实时更新。
所述的寻找对接的轨道段是指:根据历史调姿结果位置误差和角度误差最大值、架车控制精度以及对接允许位置误差和角度误差,计算余量,作为对接过程中允许轨道因素带来的影响;通过架车移动第一舱段,利用实时反馈的舱段位姿变化,寻找一段轨道,该段轨道带来的位置和角度偏差小于误差余量。
所述的销孔外调姿是指:第二舱段移动到找到的轨道段内,以第一舱段的实时欧拉角作为反馈,理想对接位置为输入,架车在轨道方向不动,通过控制架车运动副速度调整第一舱段位姿。
所述的销孔对接是指:第一舱段沿轨道运动,更新销体与孔面的碰撞检测模型中建立的空间八叉树,做碰撞检测,在销孔碰撞时报警。
本发明涉及一种实现上述方法的***,包括:通信接口模块、位姿解算模块、3D可视化模块、碰撞检测模块、流程控制模块。通信接口模块采集控制***运动数据、测量***位置数据转发到位姿解算模块,转发流程控制模块的控制指令到控制***;位姿解算模块与通信接口模型相连,根据实时数据计算实***姿;3D可视化模块根据位姿信息更新3D模型,显示实时信息;碰撞检测模块根据实***姿更新碰撞检测模型,输出碰撞检测结果;流程控制模块根据实***姿和碰撞检测结果控制寻找对接轨道段、销孔外调姿以及销孔对接的流程,输出控制指令。
技术效果
本发明整体解决现有技术通过轨道、串联托架调姿设备、工装环进行调姿时依赖人工调整姿态,装配效率低下、质量一致性不足,销孔对接时胁迫变形过大的问题。
与现有技术相比,本发明利用大尺度定位技术,测量舱段位姿,基于实时位姿信息形成闭环控制,实现自动调姿;将对接流程分解为,寻找对接轨道段、舱段外调姿、销孔对接,保证流程的自动进行;基于实时监控舱段位姿、设备运动,计算轨道不平整因素对对接带来的影响,寻找合适的轨道段完成对接过程;以圆柱体代替销、圆柱面代替孔面,根据参数方程建立空间八叉树,进行实时碰撞检测,出现碰撞即胁迫变形时报警;***应用3D建模技术,对对接***各实物建立3D模型,并进行贴图处理,场景逼真,实时更新下有利于人员掌握对接细节。
附图说明
图1为舱段对接过程示意图;
图2为面向实时监控的大型舱段对接***图;
图3为本发明面向实时监控的对接流程图;
图4为调姿机构结构图;
图5为对接现场示意图。
具体实施方式
如图2所示,本实施例具体包括以下步骤:
步骤1、定义实***姿信息,包括测量工装在测点坐标系下的位姿、舱段在测量工装下的位姿、调姿设备运动模型、理想对接第一舱段相对第二舱段位姿,具体为:
1.1)设位置传感器在各测量工装固连坐标系{Ak}下的坐标下的坐标为: {A1}为第一舱段测量工装固连坐标系,{A2}为第二舱段测量工装固连坐标系。以为X轴、为Z轴、为原点的测点坐标系{Sk}在{Ak}中的位姿为设则: 测量工装{Ak}在测点坐标系{Sk}下的位姿为
1.3)根据轨道和调姿设备、工装环组成的调姿结构如图4所示,得到运动模型:设轨道、行走构件、横移构件、升降构件、工装环,各自固连坐标系为{0}{1}{2}{3}{4},依次形成平移副X、平移副Y、平移副Z、旋转副A。各构件坐标轴方向均与{L}相同,图中l1=0,根据厂房布局得到{0}在全局坐标系下位姿为则各构件位姿矩阵与关节量的关系满足: 其中:sθi=sinθi,cθi=cosθi。
步骤2)输入精度信息:根据装配要求确定对接允许位置误差Ed和角度误差Eθ,输入调姿机构移动副控制精度ε。
步骤3)根据孔销参数建立八叉树碰撞检测模型:输入法兰盘上孔Hi的孔径、孔深、在舱段上的位姿对应销Pi销半径、长度、在舱段上的位姿建立孔面,销圆柱体面的参数方程,以此对孔面、销圆柱体面进行八叉树空间分割,得到对应的八叉树空间模型,最小单元的边长为
输入1)对接现场将第一舱段、第二舱段分别通过工装环安装在主动、从动架车上,架车位于同一轨道,舱段安装测量工装,现场示意如图5所示。安装完成后开始对接流程转入步骤5),架车控制***、位姿测量***实时将架车XYZA四个运动副关节量、位置传感器在全局坐标系下的位置发送到接口,频率为30Hz,步骤4)根据实时数据更新实***姿。
步骤4)更新实***姿:各实***姿更新具体方式如下:
4.1)测量工装位姿更新:根据接口获得位置传感器在全局坐标系{W}的实时位置数据:Wpki,i=1,2,3,k=1,2。设{Sk}在{W}中的位姿为则:得到测量工装{Ak}在全局坐标系{W}下的位姿:其中:为工装{Ak}在测点坐标系{Sk}下的位姿。
步骤5)寻找对接轨道段:具体步骤如下
5.1)计算轨道段要求:考虑销孔外调姿误差Ea和销孔对接轨道误差Er对对接流程的影响,将装配允许误差分解为CEθ=Eθa+Eθr,其中:C为裕度系数,小于1;Eda与Eθa为历史调姿结果位置误差和角度误差最大值,根据上述公式计算获得销孔对接轨道容许误差Edr和Eθr。
得到所述的轨道段AB要求为:
1)YZ方向最大差值小于Edr;
2)角度最大差值小于Eθr;
3)AB距离大于等于6倍销长L。
5.2)寻找满足要求的轨道段:
①设置两个序列Sp={pi,…pj},Sθ={θi,…θj},pi=(xi,yi,zi),θi=(αi,βi,γi)变量Sp、Sθ初始化为空,第一舱段位姿为求逆获得第一舱段的主动、从动架车同步沿轨道向低速运动。
步骤6)销孔外调姿,具体包括:
6.1)第一舱段的主动、从动架车同步沿轨道回退到舱段坐标为x=xA+L位置,
6.2)计算第二舱段的主动、从动架车同步沿轨道运动,直到第二舱段位置X分量与paim2相同,并以第二舱段当前位姿作为对接目标,求得理想对接时第一舱段位姿为:将分解为(Xa,Ya,Za,αa,βa,γa),其中:αa,βa,βa为X-Y-Z欧拉角计算所得。
6.3)以第一舱段实时欧拉角(α,β,γ)为反馈,按照主动、从动架车同步调整转动副A角速度控制α,相反调整移动副速度Z控制β,相反调整移动副Y速度控制γ,同步调整移动副Y速度控制y,同步调整移动副Z速度控制z,调整架车姿态。
步骤7)销孔对接:第一舱段的主动、从动架车,同步沿轨道低速运动,实时更新运动方的孔销八叉树模型。对对应的孔销利用其八叉树进行实时的碰撞检测,检测到碰撞后,停止对接并报警,由操作人员介入解决。
综上,本实施例在正式对接前,根据历史姿态调整精度和对接要求精度,计算轨道对接段要求,然后在架车慢速运动中通过监控舱段实时位姿数据变化寻找满足要求的轨道段,防止对接舱段在完成调姿、销孔完全对接后由于轨道因素误差变大,也防止轨道不平整导致销孔最后对接时胁迫装配应力增加。本实施例通过以销体和孔面参数方程建立空间八叉树碰撞模型,对接过程中进行实时的碰撞检测,在发生碰撞时报警,工作人员可根据装配变形情况选择后续措施。
与现有技术相比,本方法基于车间原有的方式改造,单次对接时间从一小时缩减到十分种内;在单工位总装对接生产场景下对接可在原地进行,不需要来回转运。
上述具体实施可由本领域技术人员在不背离本发明原理和宗旨的前提下以不同的方式对其进行局部调整,本发明的保护范围以权利要求书为准且不由上述具体实施所限,在其范围内的各个实现方案均受本发明之约束。
Claims (9)
1.一种面向实时监控的大型舱段对接方法,其特征在于,首先在准备阶段依次进行:定义实***姿信息、输入精度信息、建立销体与孔面的碰撞检测模型;完成对接准备后进行入对接流程,流程中根据实时传感器、设备运动数据更新实***姿,基于实时的位姿信息寻找对接的轨道段、销孔外调姿、销孔对接;
所述大型舱段对接方法采用对接车间常见的轨道转运串联托架式架车,配合大尺寸数字测量技术,通过在线监控实现闭环控制,按照寻找对接轨道段、销孔外调姿、销孔对接的流程完成对接,明显提升大型舱段对接效率与质量一致性。
2.根据权利要求1所述的面向实时监控的大型舱段对接方法,其特征是,所述的定义实***姿信息是指:输入位置传感器在测量工装坐标系的坐标,根据三点法获得;输入测量工装安装在舱段上时,舱段在测量传感器坐标系下的位姿;根据轨道、架车、工装环组成的调姿结构,得到运动关节量到轨道、架车行走构件、架车横移构件、架车升降构件、工装环位姿的映射。
3.根据权利要求1所述的面向实时监控的大型舱段对接方法,其特征是,所述的输入精度信息是指:输入对接允许位置误差和角度误差;输入架车控制精度。
4.根据权利要求1所述的面向实时监控的大型舱段对接方法,其特征是,所述的建立销体与孔面的碰撞检测模型是指:输入对接对应销、孔在舱段上的位姿,以及销半径、销长、孔半径、孔深,建立销体、孔面的参数方程;并以参数方程进行空间八叉树分割建立碰撞检测模型。
5.根据权利要求1所述的面向实时监控的大型舱段对接方法,其特征是,所述的更新实***姿是指:架车安装完舱段、舱段安装完测量工装后,架车控制***、测量***分别实时将四台架车各自四个关节运动数据、位置数据,对接过程中根据数据解算测量工装、舱段、架车行走构件、架车横移构件、架车升降构件和工装环的位姿,并实时更新。
6.根据权利要求1所述的面向实时监控的大型舱段对接方法,其特征是,所述的寻找对接的轨道段是指:根据历史调姿结果位置误差和角度误差最大值以及对接允许位置误差和角度误差,计算余量,作为对接过程中允许轨道因素带来的影响;通过架车移动第一舱段,利用实时反馈的舱段位姿变化,寻找一段轨道,该段轨道带来的位置和角度偏差小于误差余量。
7.根据权利要求1所述的面向实时监控的大型舱段对接方法,其特征是,所述的销孔外调姿是指:第二舱段移动到找到的轨道段内,以舱段的实时欧拉角作为反馈,理想对接位置为输入,架车在轨道方向不动,通过控制架车运动副速度调整第一舱段位姿。
8.根据权利要求1所述的面向实时监控的大型舱段对接方法,其特征是,所述的销孔对接是指:第一舱段沿轨道运动,更新销体与孔面的碰撞检测模型中建立的空间八叉树,做碰撞检测,在销孔碰撞时报警。
9.一种实现上述任一权利要求所述方法的***,其特征在于,包括:通信接口模块、位姿解算模块、3D可视化模块、碰撞检测模块、流程控制模块,通信接口模块采集控制***运动数据、测量***位置数据转发到位姿解算模块,转发流程控制模块的控制指令到控制***;位姿解算模块与通信接口模型相连,根据实时数据计算实***姿;3D可视化模块根据位姿信息更新3D模型,显示实时信息;碰撞检测模块根据实***姿更新碰撞检测模型,输出检测结果;流程控制模块根据实***姿和碰撞检测结果控制寻找对接的轨道段、销孔外调姿以及销孔对接的流程,输出控制指令。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202010644725.XA CN111745369B (zh) | 2020-07-07 | 2020-07-07 | 面向实时监控的大型舱段对接方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202010644725.XA CN111745369B (zh) | 2020-07-07 | 2020-07-07 | 面向实时监控的大型舱段对接方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN111745369A CN111745369A (zh) | 2020-10-09 |
CN111745369B true CN111745369B (zh) | 2021-02-09 |
Family
ID=72679713
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202010644725.XA Expired - Fee Related CN111745369B (zh) | 2020-07-07 | 2020-07-07 | 面向实时监控的大型舱段对接方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN111745369B (zh) |
Families Citing this family (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN112799326B (zh) * | 2020-12-31 | 2022-02-18 | 南京晨光集团有限责任公司 | 用于舱段自动对接的联动调节控制***及控制方法 |
CN113798842A (zh) * | 2021-09-06 | 2021-12-17 | 上海航天设备制造总厂有限公司 | 一种筒形大部件斜向自动对接装配*** |
CN114393382B (zh) * | 2021-12-22 | 2024-05-14 | 上海智能制造功能平台有限公司 | 一种视觉引导装配对接装置和方法 |
CN116245944B (zh) * | 2022-12-29 | 2024-01-05 | 南京航空航天大学 | 一种基于实测数据的舱段自动化对接方法及*** |
CN116203974B (zh) * | 2023-05-06 | 2023-07-21 | 北京理工大学 | 一种控制移动机器人与设备对接的方法和装置 |
Family Cites Families (12)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPS58206329A (ja) * | 1982-05-26 | 1983-12-01 | Nippon Kokan Kk <Nkk> | I型構造物の組立装置 |
CN102091933B (zh) * | 2010-12-31 | 2012-07-25 | 大连理工大学 | 船体分段装配快速对位装置及其方法 |
CN204123035U (zh) * | 2014-09-25 | 2015-01-28 | 湖北三江航天红阳机电有限公司 | 一种舱段整修及对接转运装置 |
CN105081719A (zh) * | 2015-07-31 | 2015-11-25 | 北京星航机电装备有限公司 | 基于视觉测量的航天器舱段自动装配***及其装配方法 |
CN105629944B (zh) * | 2016-03-16 | 2018-01-23 | 西安电子科技大学 | 一种圆柱形舱段柔性对接装置的控制***及方法 |
CN105787200B (zh) * | 2016-03-22 | 2018-08-17 | 上海交通大学 | 大型部件自动对接装配方法及*** |
CN106447781B (zh) * | 2016-09-14 | 2019-05-28 | 燕山大学 | 一种基于Minkowski和面向自动装配的碰撞检测方法 |
CN108274231B (zh) * | 2017-12-05 | 2020-04-21 | 上海航天精密机械研究所 | 舱段类零件自动对接装置及控制方法 |
CN108917723B (zh) * | 2018-05-14 | 2020-08-07 | 西北工业大学 | 一种用于圆柱形舱段对接的位姿在线测量***及方法 |
CN109352663B (zh) * | 2018-09-28 | 2020-11-20 | 航天材料及工艺研究所 | 一种面向复合材料舱段的机器人自动精确定位制孔装置及方法 |
CN109367825B (zh) * | 2018-11-07 | 2020-06-09 | 北京特种机械研究所 | 一种舱段自动对接方法 |
CN110733617B (zh) * | 2019-09-11 | 2020-10-27 | 中国科学院自动化研究所 | 一种舱段装配平台及舱段装配方法 |
-
2020
- 2020-07-07 CN CN202010644725.XA patent/CN111745369B/zh not_active Expired - Fee Related
Also Published As
Publication number | Publication date |
---|---|
CN111745369A (zh) | 2020-10-09 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN111745369B (zh) | 面向实时监控的大型舱段对接方法 | |
CN108801142B (zh) | 一种特大尺寸工件双移动测量机器人***及方法 | |
CN108871209B (zh) | 一种大尺寸工件移动测量机器人***及方法 | |
CN102001451B (zh) | 基于四个数控***、调姿平台和移动托架的飞机部件调姿、对接***及方法 | |
Wang et al. | A mobile robotic measurement system for large-scale complex components based on optical scanning and visual tracking | |
US9740191B2 (en) | Location calibration for automated production manufacturing | |
CN102458779B (zh) | 机械手校正装置及其方法 | |
CN108151660B (zh) | 一种飞机部件对接间隙和阶差的测量装备、方法及*** | |
CN112833786B (zh) | 一种舱段位姿测量及对准***、控制方法及应用 | |
US9435633B2 (en) | Quasi-virtual locate/drill/shim process | |
CN108827155B (zh) | 一种机器人视觉测量***及方法 | |
CN111238375B (zh) | 基于激光跟踪仪的移动检测机器人大型构件外形重构方法 | |
CN108917723B (zh) | 一种用于圆柱形舱段对接的位姿在线测量***及方法 | |
CN103792885B (zh) | 一种数控弯管加工仿真方法及装置 | |
CN114161425B (zh) | 一种工业机器人的误差补偿方法 | |
CN110001998B (zh) | 一种基于激光测距的飞机大部件框式结构对接引导装置与方法 | |
CN110039548B (zh) | 一种拼装机控制方法、装置及设备 | |
CN115338869A (zh) | 一种主从异构型遥操作***的主从控制方法及*** | |
CN109291051B (zh) | 一种基于角度传感器的串并联机器人末端姿态闭环控制方法 | |
CN110470223B (zh) | 一种基于1d位移传感器的三维空间坐标测量方法 | |
CN112959364A (zh) | 一种工业机器人装配误差补偿***及方法 | |
CN115179323A (zh) | 基于远心视觉约束的机器末位姿测量装置及精度提升方法 | |
CN114239170A (zh) | 一种飞机装配的误差补偿方法 | |
CN116374191B (zh) | 一种直升机尾梁自动安装方法及*** | |
CN114842079A (zh) | 盾构隧道内对预制中隔墙进行位姿测量的设备及方法 |
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 | ||
CF01 | Termination of patent right due to non-payment of annual fee | ||
CF01 | Termination of patent right due to non-payment of annual fee |
Granted publication date: 20210209 Termination date: 20210707 |