一种空间中支杆的快速对接控制方法及系统
本申请涉及对接控制,具体涉及一种空间中支杆的快速对接控制方法及系统。
背景技术:
1、随着航空航天、重型装备制造等领域向大型化、模块化方向快速发展,大型结构件的高精度对接装配已成为制约制造效率与质量的关键环节。目前,大型构件对接装配的调姿定位机构主要有导轨托架式、数控定位器、并联机构式和工业机械臂四类,数字化测量技术如双目视觉测量、激光跟踪仪等也已在对接场景中得到应用。然而,现有自动化调姿定位技术和测量手段主要面向大型舱段类或壁板类构件的对接装配,对于空间中细长支杆类构件与孔轴的高精度快速对接这一特定场景,尚未形成成熟的技术方案。
2、发明人发现,在空间支杆与孔轴对接的实际工程作业中,传统方式完全依赖人工操作,通过行车吊装、手拉葫芦粗调、人工目视对准的方式进行。一次对接需投入钳工3名、对接技术员1名、行车操作员1名,耗时约5小时,不仅人力投入大、效率低,而且对接精度严重依赖操作人员的技术水平,支杆与孔轴之间易发生刮擦、拉伤。现有自动化调姿平台在承载特性、控制策略及安全协同机制等方面均难以直接适配支杆-孔轴对接的工艺需求,缺乏能够同时满足高效率、高精度、低损伤要求的专用控制系统及方法。
技术实现思路
1、有鉴于此,本申请提供了一种空间中支杆的快速对接控制方法及系统,以解决现有技术中支杆孔轴对接依赖人工导致效率低、精度差、易损伤,且自动化平台缺乏专用控制策略及安全协同机制的技术问题。
2、第一方面,本申请提供了一种空间中支杆的快速对接控制方法,包括:
3、s1、检查对接孔轴内部及对接支杆配合面是否存在异物或拉痕,清理后于配合面均匀喷涂wd-40防锈润滑剂;
4、s2、地面准备平台一键运动至设备中线高度,双目视觉系统启动并实时解算对接孔轴的空间倾角误差,运动控制器根据该倾角误差判定前后两台升降伺服电机的工作模式:当时,两台电机切换至解耦独立控制模式独立调整孔轴两端高度;当时,两台电机切换至同步耦合控制模式协同运动,实现孔轴在二维平面内的精确摆角调节;为预设的倾角误差阈值;
5、s3、模型安装车运输对接支杆至对接工位,通过四台舵轮独立驱动调整车体停放位置使车体趋近于对接孔轴,调整结束后执行多轮刹车锁定;
6、s4、双目相机持续拍摄地面准备平台上的高精度二维码标定板,工控机运行视觉算法解算对接孔轴当前空间六自由度位姿,通过tcp/ip协议下发至模型安装车运动控制器,运动控制器比较对接支杆与对接孔轴的姿态偏差,驱动六自由度并联调姿机构进行一次或多次调姿,直至姿态偏差在允许范围内;
7、s5、并联调姿机构携带对接支杆沿轴向向孔轴方向运动至第一预设安全距离后暂停,视觉系统再次复核位姿,确认无误后继续运动至第二预设安全距离并停止,实现软着陆;
8、s6、使用定制检测工装检测当前支杆与孔轴之间的姿态状态,检测通过后使用内置轴向力传感器的手摇夹具将支杆插入孔轴,当轴向插入阻力超过预设阈值时触发机械锁死保护并报警;
9、s7、当检测不通过时,使用并联调姿机构手持器以最低速度尺度进行手动微调,直至达到对接要求后使用手摇夹具将支杆插入孔轴。
10、第二方面,本申请提供了一种空间中支杆的快速对接控制系统,包括:
11、地面准备平台系统,用于承载并调节对接孔轴的空间位置与姿态,包括运动控制器、旋转伺服电机、前后各一台升降伺服电机、外部旋转编码器、拉绳传感器、倾角传感器、示教器和限位开关;所述升降伺服电机具备同步耦合控制与解耦独立控制两种工作模式;
12、模型安装车系统,用于运输并调节对接支杆的空间位置与姿态,包括运动控制器、四台独立驱动舵轮、电池包、区扫雷达、六自由度并联调姿机构和手持器;所述四台舵轮实现车体的前后平移、左右横移和原地旋转运动;所述六自由度并联调姿机构采用stewart平台构型,实现对接支杆在空间中的六自由度姿态调节;
13、视觉系统,用于实时获取对接孔轴与对接支杆的位姿信息,包括smart200 plc、工控机、安装于并联调姿平台上的双目相机以及分别安装于地面准备平台上对应笛卡尔坐标系x轴、y轴、z轴方向的三片高精度二维码标定板;所述工控机通过tcp/ip协议经smart200plc将调姿信息发送至模型安装车系统;
14、所述地面准备平台系统、模型安装车系统和视觉系统三者协同工作,完成对接支杆与对接孔轴的姿态调整与对接。
15、本申请提供的空间中支杆的快速对接控制方法及系统,至少具有如下有益效果:有效缩短了对接时间,提升对接效率,由1~2个操作员即可完成对接,大大降低人力成本。采用“视觉误差驱动的双电机模式切换”机制,实现了从“粗调”到“精调”的自动平滑过渡,无需人工判断和手动切换,提升了调姿过程的智能化水平和响应速度。通过“暂停-复核-再趋近”的三段式运动模式,为视觉数据的稳定性和通信链路的可靠性提供了冗余校验,两级安全趋近策略有效防止碰撞事故,显著降低了设备损伤风险。半自动化设计兼顾自动化效率与人工操作灵活性:自动完成粗调姿和安全趋近后,由人工完成最终的检测确认和插入操作,既发挥了机器在重复性、高精度定位方面的优势,又保留了人类在复杂判断和临场应变方面的能力。
1.一种空间中支杆的快速对接控制方法,其特征在于,包括:
2.根据权利要求1所述的空间中支杆的快速对接控制方法,其特征在于,步骤s3中,四台舵轮采用四轮独立驱动、四轮独立转向架构,通过运动控制器解算各舵轮转速与转角,实现车体的前后平移、左右横移和原地旋转运动;车体移动过程中区扫雷达持续扫描行进路径,当检测到障碍物时触发停止信号及声光报警。
3.根据权利要求1所述的空间中支杆的快速对接控制方法,其特征在于,步骤s4中,运动控制器采用基于位姿误差的视觉伺服控制律,定义当前位姿与目标位姿之间的误差向量为,控制律为:
4.根据权利要求2所述的空间中支杆的快速对接控制方法,其特征在于,步骤s2中,前后两台升降伺服电机的同步耦合控制模式采用自适应交叉耦合控制策略,定义第台电机的跟踪误差为,其中为第台电机的目标位置指令,为第台电机的实际位置反馈;定义两台电机之间的同步误差为,定义视觉系统反馈的倾角误差为;
5.根据权利要求3所述的空间中支杆的快速对接控制方法,其特征在于:
6.根据权利要求1所述的空间中支杆的快速对接控制方法,其特征在于,所述地面准备平台上设置有倾角传感器,倾角传感器实时采集对接孔轴的实际姿态角度,与运动控制器根据电机编码器反馈解算的理论姿态角进行对比,采用残差驱动的自适应加权融合策略,定义时刻的融合姿态角估计值为:
7.根据权利要求3所述的空间中支杆的快速对接控制方法,其特征在于,所述六自由度并联调姿机构的雅可比矩阵通过对逆运动学方程两边对时间求导获得,驱动支腿速度与动平台速度之间的映射关系为雅可比矩阵的第行元素为:
8.根据权利要求1所述的空间中支杆的快速对接控制方法,其特征在于,视觉算法的输出信息包括:支杆与对接孔轴的六自由度姿态调整信息,包括位置偏差、、和角度偏差俯仰角、滚转角、偏航角;以及支杆定位块与对接孔轴定位孔的位置偏差及角度偏差信息,用于二次精确定位。
9.根据权利要求1所述的空间中支杆的快速对接控制方法,其特征在于,六自由度并联调姿机构的逆运动学解算采用实时手眼标定补偿方法,定义视觉坐标系到并联机构基座坐标系的齐次变换矩阵为,通过手眼标定获得并在运行过程中通过实时采集二维码位姿进行动态更新;
10.一种空间中支杆的快速对接控制系统,其特征在于,采用如权利要求1至9中任一项所述的空间中支杆的快速对接控制方法实现支杆与孔轴的对接,所述系统包括:
版权声明:本站专利文献数据主要来源于国家知识产权局等公开渠道,由 技术新讯 进行整理汇编。页面设计及数据汇编的著作权归本站所有。全部内容仅供个人学习、科研评估与技术交流参考,严禁用于任何商业用途(包括但不限于直接生产制造、技术转让、倒卖数据等)。
免责条款:专利技术具有时效性,本站不对资料的绝对准确性、完整性和可实施性提供任何明示或暗示的担保。因参考本站内容造成的直接或间接损失,本站不承担相关法律责任。若您认为本站内容有侵权问题,请及时提供权属证明与我们联系,本站将在核实后依法处理。反馈意见:yyfuon@163.com