一种适用于多模态作业场景的升降台及控制方法

摘要: 本发明涉及特种工业机器人及自动化控制系统,具体涉及一种适用于多模态作业场景的升降台及控制方法。背景技术:1、在储油罐、船舶外壳、海上风电塔筒等大型立面钢结构的日...
一种适用于多模态作业场景的升降台及控制方法

本发明涉及特种工业机器人及自动化控制系统,具体涉及一种适用于多模态作业场景的升降台及控制方法。

背景技术:

1、在储油罐、船舶外壳、海上风电塔筒等大型立面钢结构的日常防腐维护作业中,通常需要完整经历金属表面腐蚀图像检测、打磨除锈处理以及防腐涂料滚涂修复等多个复杂工序。为实现一机多用并降低特种设备的采购与维保成本,行业内逐渐倾向于采用通用外部行走底盘和可更换前端作业模块的模块化设计思路。其中,连接底盘与前端作业模块的关键载体便是z轴升降台,其性能直接决定了作业质量与设备安全性。

2、然而,现有的模块化机器人在升降机构和底层控制体系上存在显著的技术瓶颈,难以满足复杂工况下的精细化作业需求。第一,现有的升降台通常仅被定义为单纯的机械物理搭载件,只能被动执行生硬的z轴上下盲动,无法深度参与不同作业模块的复杂工艺调度。具体的,如在打磨作业中,若升降台采用刚性进刀压紧方式,遇到焊缝凸起时极易导致打磨电机卡死,或因反作用力过大导致整机受推脱落;在滚涂作业中,简单的升降启停控制无法解决高空断电情况下泵管内涂料因重力产生的滴落污染问题;在图像检测作业中,普通的升降动作无法实现相机罩的高精度贴壁闭锁控制,影响成像质量。第二,控制系统缺乏底层硬件的自主感知能力,设备独立性差。每次更换前端作业模块后,操作人员通常需要手动重新配置底层代码、繁琐地重新分配接收机通信通道。这种控制方式不仅无法实现真正的即插即用,增加了操作复杂度,还极易因人为参数调配失误引发高空设备损毁事故。第三,控制层级缺乏由前端向后端的全局互锁机制。传统的升降台通常受控于底盘主控,当升降台处于探头伸出的高危作业状态时,若底盘仍能进行高速平移或自旋,极易导致机械臂折断损坏;且在主链路失联时,被动式的升降台无法自主收回探头,存在极大的安全隐患。

3、因此,亟需一种适用于多模态作业场景的控制方法及升降台全新的多功能升降台系统及控制方法,实现单一升降台结构在多模态作业场景下的深度工艺复用与主动安全协同。

技术实现思路

1、本发明的目的在于提供一种适用于多模态作业场景的控制方法及升降台,以解决上述背景技术中存在的现有技术问题。

2、为解决上述的技术问题,本发明提供的技术方案为:

3、本技术提供了一种适用于多模态作业场景的升降台,包括:升降台本体、作业模块、多模态连接口以及机载控制模块,所述升降台本体上设置有升降机构,所述作业模块设置在升降机构的驱动端,沿升降台本体的z轴方向往复运动,所述多模态连接口设置在升降机构上,用于作业模块与升降机构的机械锁紧和电气连接,所述机载控制模块设置在升降台本体上且与多模态连接口电信号连接,用于作业模块类型的识别以及作业模块、升降机构的驱动控制。

4、在上述技术方案基础上,所述多模态连接口的电气连接针脚至少包括供电针脚、控制信号针脚以及模拟输入针脚,所述供电针脚用于供电,所述控制信号针脚用于输入或输出控制信号,所述模拟输入针脚用于作业模块的硬件特征识别。

5、在上述技术方案基础上,所述作业模块包括打磨除锈模块、图像检测模块、滚涂修复模块,且与多模态连接口的物理接口内部均预置有硬件特征识别标识,所述硬件特征识别标识设置为跨接在模拟输入针脚与接地端之间的特定阻值的特征识别电阻,不同类型的作业模块对应内置不同阻值的特征识别电阻。

6、在上述技术方案基础上,所述机载控制系统设置为内置硬件浮点运算单元的stm32f407zgt6微控制器芯片,通过采集模拟输入针脚的电信号识别作业模块的类型,并加载与作业模块相匹配的控制方法逻辑,驱动作业模块以及升降机构的动作执行。

7、在上述技术方案基础上,所述升降台本体上还设置有限位传感器,用于作业模块的行程保护以及升降台本体的姿态感知。

8、本技术中还提供一种适用于多模态作业场景的控制方法,采用所述的升降台,包括以下步骤:

9、获取多模态接口中模拟输入针脚的电压分压值;

10、判断电压分压值所落入的预设阈值区域以及对特征识别电阻的匹配,进而判定当前的作业模块的类型;

11、根据作业模块的类型,加载相应的控制方法,实现对作业模块以及升降机构的控制驱动。

12、在上述技术方案基础上,当作业模块的类型为打磨除锈模块时,采用基于电流反馈的模糊pid柔性力位复合控制方法,包括以下步骤:

13、接收打磨除锈指令,

14、触发打磨除锈作业,

15、采集打磨除锈作业中供电回路中的瞬态工作电流,设置预设目标电流、电流允许偏差以及安全电流阈值,其中大于 ();

16、判断瞬态工作电流与预设目标电流之间的关系,并计算电流误差以及误差变化率,计算公式为:式中,为电流采样周期,模糊pid控制器基于电流误差和误差变化率输出运动控制量;

17、若瞬时工作电流小于-,则判定打磨除锈作业中打磨头与作业壁面之间的接触压力不足,控制升降机构带动打磨除锈模块下降进刀打磨,并根据模糊pid控制器输出的运动控制量调节下降速度和/或下降位移;

18、若瞬时工作电流位于(-) 至 (+) 的目标工作区间内时,则判定打磨头与作业壁面之间的接触压力满足预设要求,控制升降机构保持当前位置进行作业或根据模糊pid控制器输出的运动控制量进行动态补偿;

19、若瞬时工作电流大于 (+) 且小于安全电流阈值时,则判定打磨头与作业壁面之间的接触压力过大,控制升降机构带动打磨除锈模块反向上升,并根据模糊pid控制器输出的运动控制量调节上升速度和/或上升位移;

20、当瞬态工作电流达到或超过安全电流阈值时,则判定打磨除锈作业过程中存在异常阻碍物,控制升降机构带动打磨除锈模块反向上升退刀缓冲。

21、在上述技术方案基础上,当作业模块的类型为图像检测模块时,采用密闭暗室构建与光电时序协同控制方法,包括以下步骤:

22、接收图像检测指令,

23、触发图像检测作业,

24、控制图像检测模块中的隔光遮光罩下降至作业壁面并锁定隔光遮光罩的位置,形成图像检测所需的密闭暗室,

25、在密闭暗室内开启罩内补光光源,

26、接收对焦触发脉冲和曝光触发脉冲信号,

27、图像检测模块中的图像采集设备进行图像采集;

28、图像采集完成后,依次执行罩内补光光源的关闭以及隔光遮光罩的复位。

29、在上述技术方案基础上,当作业模块的类型为滚涂修复模块时,采用非对称时序停机补偿控制方法,包括以下步骤:

30、接收涂装作业停止指令,

31、触发滚涂修复作业,

32、切断供料泵的正向供料信号;

33、向供料泵输出反向运转信号并维持第一预设时间,利用管路负压回吸管内涂料残留;

34、控制涂装电机保持当前转速并延迟第二预设时间,利用涂装电机驱动滚涂毛刷余转涂匀作业壁面表面残漆;

35、完成管内涂料残留回收以及作业壁面表面残漆涂匀后,驱动滚涂修复模块离开作业壁面。

36、在上述技术方案基础上,还包括全局安全互锁与反向干预机制,包括以下过程:

37、当检测到外部搭载设备的通信链路的中断标志位置位或发生失联时,则强制切断当前作业模块的大功率负载电源,并抢占最高控制权限强制驱动升降机构反向运行直至触发升降台本体上设置的限位传感器并进行位置锁定,实现全局安全互锁;

38、当监测到升降台本体脱离限位传感器且处于向下伸出的探头作业姿态时,则机载控制系统主动向外部搭载设备输出限速干预信号,用于反向限制外部搭载设备的最高机动速度,防止碰撞,实现反向干预。

39、本发明提供的技术方案产生的有益效果在于:

40、本技术中提供了一种适用于多模态作业场景的升降台及控制方法,改变了传统升降台仅作为单纯位移构件的局限,通过设置有多模态连接口,可以连接不同类型的作业模块并进行自动识别,并同步加载相应作业模块的控制工艺,消除了人工配网以及修改代码的繁琐操作,同时在不同作业模块的控制工艺中兼顾了打磨除锈的恒力避让、图像检测的暗室闭锁和涂装修复的防滴漏时序协同,提升了升降台的使用价值和使用率。同时本技术中还引入了内置fpu算力的stm32f407zgt6芯片,改变了因计算延迟导致震荡的模糊pid力控算法,提供了强劲的本地硬件解算支撑,确保了毫秒级的工艺执行稳定性。

41、此外,本技术中还提出了全局安全互锁与反向干预机制,使得升降台不仅可以独立处理各个作业模块的作业过程,还可以对其搭载的外部搭载设备进行反向约束和安全互锁,实现了由传统的前端执行构件主动反向保护全局载体机体设备的安全逻辑重构,极大保障了高空特种机器人的操作安全性以及作业生存率。