一种挖掘机的遥操作主端机械臂控制系统、方法及挖掘机与流程
本技术涉及挖掘机,尤其涉及一种挖掘机的遥操作主端机械臂控制系统、方法及挖掘机。
背景技术:
1、随着工程机械智能化和无人化进程的发展,挖掘机等重型装备越来越多地应用于抢险救援、矿山开采、污染区清理等高危或非结构化作业环境。为降低人员登机作业风险,远程遥操作技术被广泛用于使操作者在安全位置控制从端挖掘设备。遥操作主端设备通常用于采集操作者手部动作、手柄输入或机械臂姿态,并将其转换为从端回转、动臂、斗杆、铲斗等工作装置的控制指令,因此主端设备的多机型适配能力、操作直观性和控制安全性成为该领域的重要需求。
2、现有遥操作主端装置主要包括异构型操纵手柄和主从同构型微缩机械臂两类。异构型手柄结构简单,但操作者输入动作与挖掘机工作装置在空间中的运动轨迹缺乏直观对应关系。主从同构型微缩机械臂通过设置与从端挖掘机相似的回转基座、动臂、斗杆及铲斗连杆,使操作者能够在物理空间中直接摆动主端各关节来输入期望姿态,从而降低逆运动学理解负担,提高精细作业的直观性。然而,现有主从同构型微缩机械臂的遥操作主端中的动臂、斗杆及铲斗连杆等结构段通常采用固定长度和固定比例的刚性结构。该类结构在匹配特定从端机型时能够获得较好的主从对应关系,但不同品牌、不同吨位的挖掘机在动臂长度、斗杆尺寸、铲斗连杆比例以及外接属具规格方面差异显著,当一套固定比例的主端操作设备用于控制几何参数不同的从端挖掘机时,原有的主从同构映射条件容易被破坏,形成硬件尺度失配,导致每种机型都需要单独定制主端操作臂,硬件通用性不足。
技术实现思路
1、有鉴于此,本技术提供了一种挖掘机的遥操作主端机械臂控制系统、方法及挖掘机,旨在实现挖掘机遥操作的主端可动态调节连杆比例,以匹配不同从端挖掘设备的几何参数。
2、第一方面,本技术提供了一种挖掘机的遥操作主端机械臂控制系统,包括:
3、主端机械臂,与目标挖掘机的从端机械臂同构,包括多个连杆段且至少一个连杆段设置有伸缩机构,所述伸缩机构用于调节所在连杆段的等效长度,所述伸缩机构对应配置用于采集所述伸缩机构实际长度的长度检测传感器;
4、主端控制器,被配置为获取所述从端机械臂的几何参数;根据所述几何参数和主从缩放系数,确定并输出各所述伸缩机构的推荐长度;通过长度检测传感器获取根据推荐长度调整后的各伸缩机构的实际长度;将各伸缩机构的实际长度作为所述主端机械臂的运动学模型中对应连杆段的长度参数,基于所述运动学模型将输入的主端姿态映射为所述目标挖掘机的控制指令,以使所述主端机械臂通过调节各伸缩机构的长度匹配不同几何参数的挖掘机。
5、可选的,对于所述根据所述几何参数和主从缩放系数,确定并输出各所述伸缩机构的推荐长度,所述主端控制器,具体被配置为:
6、根据所述几何参数和主从缩放系数,确定各伸缩机构的初始长度;判断各伸缩机构的初始长度是否超出对应的伸缩机构的机械行程范围;若未超出,则确定所述初始长度为对应的伸缩机构的推荐长度并输出;若超出,则将所述初始长度限定在对应的机械行程范围内,得到推荐长度并输出;
7、在所述通过长度检测传感器获取根据推荐长度调整后的各伸缩机构的实际长度之后,所述主端控制器,还被配置为:
8、将各所述伸缩机构的实际长度与对应的所述推荐长度进行比对,得到比对结果;在所述比对结果满足预设条件的情况下,允许进入映射模式;在所述比对结果不满足预设条件的情况下,输出提示信号,并锁定所述映射模式。
9、可选的,所述伸缩机构还对应配置有锁止定位组件,所述锁止定位组件包括可调整的相对限位和位置固定的绝对限位;
10、所述主端控制器,还被配置为实时检测各伸缩机构的锁紧状态或实际长度;当检测到锁紧状态异常或实际长度异常时,停止向所述目标挖掘机输出动作指令并停机;所述实际长度异常指实际长度与推荐长度之间的误差超出预设允许阈值,或实际长度超出对应的伸缩机构的机械行程范围。
11、可选的,所述多个连杆段包括动臂段、斗杆段和铲斗段,所述主端机械臂还包括回转底座、握持部、连接所述回转底座和所述动臂段的肩部关节、连接所述多个连杆端中相邻两段的中部关节、以及连接铲斗段和握持部的末端关节;
12、各关节配置有角度软限位和角度传感器;
13、所述中部关节处设置有角度检测组件,所述主端控制器还被配置为:通过所述角度检测组件校验所述中部关节的角度反馈是否连续、以及是否超出允许范围。
14、握持部,用于输入所述主端机械臂的末端姿态,所述握持部设置有末端限位组件,所述末端限位组件用于限制操作者的操作范围。
15、可选的,所述从端机械臂的几何参数包括所述目标挖掘机的动臂段等效长度d1、斗杆段等效长度d2、铲斗段等效长度d3及属具修正系数ρ;
16、对于根据所述几何参数和主从缩放系数,确定各伸缩机构的初始长度,所述主端控制器,被配置为:动臂段等效长度与所述主从缩放系数的乘积得到动臂段初始长度;斗杆段等效长度与所述主从缩放系数的乘积得到斗杆段初始长度;铲斗段等效长度、属具修正系数和主从缩放系数三者的乘积得到铲斗段初始长度;所述主从缩放系数是结合主端的工作半径和从端的工作半径确定的系数。
17、可选的,所述映射包括末端空间位置映射、关节角映射、行程量映射和趋势开关量映射中的至少一种;其中,在趋势开关量映射中,所述主端控制器,被配置为根据主端姿态计算主端末端位移,并将所述主端末端位移与预设死区比较,生成抬升、下降、伸出、收回、开斗、闭斗中的至少一种的趋势开关量;所述主端姿态包括所述主端机械臂各关节的角度和各伸缩机构的实际长度。
18、可选的,对于所述基于所述运动学模型将输入的主端姿态映射为所述目标挖掘机的控制指令,所述主端控制器还被配置为:
19、基于各伸缩机构的实际长度进行主端正运动学计算得到主端末端位姿;
20、对所述主端末端位姿进行主从坐标系变换得到从端的目标末端位姿;
21、基于所述目标末端位姿,进行从端逆运动学计算,得到所述目标挖掘机的目标关节角;
22、按照与所述目标挖掘机的接口类型对应的指令模式输出控制指令;其中,所述指令模式为pose模式时,输出的控制指令为所述目标关节角;所述指令模式为position模式时,将所述目标关节角经关节角与执行器行程转换关系换算为执行器的目标长度,输出的控制指令为所述目标长度;所述指令模式为pwm模式时,输出的控制指令为由所述目标长度与所述执行器的反馈长度之间的误差经pid计算得到的占空比。
23、可选的,所述主端控制器还被配置为:将各伸缩机构的实际长度、主端运动学参数、从端的连杆尺寸、执行器行程范围、关节安全边界和映射函数绑定至所述目标挖掘机的设备编号进行存档,形成设备画像;在再次接入同一设备编号的挖掘机时,加载所述设备编号对应的设备画像并提示将各伸缩机构恢复至存档的实际长度,并通过所述长度检测传感器校验各伸缩机构的实际长度是否与所述设备画像匹配。
24、第二方面,本技术提供了一种挖掘机的遥操作主端机械臂控制方法,主端机械臂与目标挖掘机的从端机械臂同构,包括多个连杆段且至少一个连杆段设置有伸缩机构,所述伸缩机构用于调节所在连杆段的等效长度,所述伸缩机构对应配置有用于采集所述伸缩机构实际长度的长度检测传感器;所述方法包括:
25、获取所述从端机械臂的几何参数;根据所述几何参数和主从缩放系数,确定并输出各所述伸缩机构的推荐长度;
26、通过所述长度检测传感器获取根据所述推荐长度调整后的各所述伸缩机构的实际长度;
27、将各所述伸缩机构的实际长度作为所述主端机械臂的运动学模型中对应连杆段的长度参数,基于所述运动学模型将输入的主端姿态映射为所述目标挖掘机的控制指令,以使所述主端机械臂通过调节各所述伸缩机构的长度匹配不同几何参数的挖掘机。
28、第三方面,本技术提供了一种挖掘机,采用上述任意一项所述的一种挖掘机的遥操作主端机械臂控制系统。
29、本技术提供的一种挖掘机的遥操作主端机械臂控制系统、方法及挖掘机,通过在主端机械臂的至少一个连杆段设置伸缩机构,并配置长度检测传感器,使主端机械臂的连杆等效长度可在硬件层面调节。主端控制器根据目标挖掘机的从端机械臂的几何参数和主从缩放系数,自动确定并输出各伸缩机构的推荐长度;在按推荐长度调整后,通过长度检测传感器获取实际长度,并将其作为主端运动学模型中对应连杆段的长度参数,进而基于更新后的运动学模型将操作者输入的主端姿态映射为目标挖掘机的控制指令。由此,同一套主端机械臂无需更换硬件即可适配不同吨位、不同臂长和不同属具的从端挖掘机,显著提高硬件通用性,减少为每种机型单独定制主端操作臂的需求。同时,由于主端连杆比例与从端几何参数在硬件层面先行匹配,运动学模型能够更真实地反映主从对应关系,降低纯软件补偿带来的轨迹失真、传感器噪声放大和关节行程分辨率不足等问题,使操作者的动作幅度与从端运动趋势更加一致,改善操作手感与映射精度。此外,该方案便于与现有遥操作控制模式集成,降低多机型适配的标定与维护成本,为挖掘机遥操作主端的多机型通用化提供有效硬件基础。
版权声明:本站专利文献数据主要来源于国家知识产权局等公开渠道,由 技术新讯 进行整理汇编。页面设计及数据汇编的著作权归本站所有。全部内容仅供个人学习、科研评估与技术交流参考,严禁用于任何商业用途(包括但不限于直接生产制造、技术转让、倒卖数据等)。
免责条款:专利技术具有时效性,本站不对资料的绝对准确性、完整性和可实施性提供任何明示或暗示的担保。因参考本站内容造成的直接或间接损失,本站不承担相关法律责任。若您认为本站内容有侵权问题,请及时提供权属证明与我们联系,本站将在核实后依法处理。反馈意见:yyfuon@163.com