一种遥控液压机械臂的控制方法与流程
本申请涉及液压机械臂领域,尤其涉及一种遥控液压机械臂的控制方法。
背景技术:
1、液压机械臂因其高功率密度和重载能力而在工程、矿山、救援等领域被广泛采用。为了适应复杂危险的非结构化作业环境,部分液压机械臂配置遥控终端,以实现操作员的远距离作业。在现有的液压机械臂控制技术中,远端操作员输入的三维运动指令在转换为液压系统的执行信号时,主要面临以下技术瓶颈,导致作业的精确性与安全性难以保障:
2、第一,位姿解算偏差与传感失真难以在线实时修正。现有系统多采用出厂固定的理论几何公式计算液压缸位移与关节角的关系,难以适应油缸安装位形的多样性与装配误差;且在长期运行中,随着密封与轴承间隙变化及电气零点漂移,位姿计算会逐渐偏离真实值。现有的零位标定高度依赖人工操作、离线激光打靶或外部标定板,停机周期长,难以在运行中实时触发并完成参考修正。
3、第二,不可预测的遥控指令流与系统间存在跨速率失配。遥控指令通常以50hz左右的低频异步下发,而液压闭环控制频率通常高达1khz。现有的处理方案通常只取用最新指令,或者仅进行简单的数据包序列核对,缺乏指令间隙的插值预测算法。在遇到信号突发延迟、乱序或操作员突发的微动、急停、反向操作时,缺乏针对液压滞回死区的平滑过渡曲线,导致末端速度发生阶跃,引发管路激振与结构抖动。
4、第三,缺乏环境风险、本体状态与指令重构算法的协同降级过程。当面临末端碰撞风险、结构刚度不足或基座倾斜失稳等复杂险情时,现有技术通常仅采取单一的急停制动。机械臂处于大惯量伸展姿态时,急停本身会引发较大的冲击应力。现有的流量约束校验或刚度评估通常是孤立的,未能将其耦合形成一个统一的限幅系数。
技术实现思路
1、本申请实施例提供一种遥控液压机械臂的控制方法,以至少部分解决上述技术问题。
2、为了实现上述目的,本申请提供一种遥控液压机械臂的控制方法,包括:
3、获取遥控终端下发的原始运动指令并采集液压机械臂的环境点云与各液压缸的实时位移数据;
4、将所述实时位移数据转换为关节位姿数据以构建包含关节位姿数据与压力数据的状态信息;
5、基于所述关节位姿数据与所述环境点云计算末端执行器的空间碰撞概率;
6、基于所述状态信息与操作空间动力学模型,计算各旋转关节的等效液压刚度;
7、根据所述空间碰撞概率与所述等效液压刚度确定限幅系数;基于所述限幅系数对所述原始运动指令进行重构,生成重构运动序列;
8、将所述重构运动序列通过逆运动学解算为对应各液压缸的期望行程轨迹;
9、针对各所述期望行程轨迹执行约束校验,在校验通过或调整后生成最终控制指令并输出至对应的液压执行单元以驱动所述液压机械臂运动。
10、本申请实施例,通过上述技术方案,控制器将空间碰撞概率与等效液压刚度融合为统一的限幅系数并以该限幅系数对原始运动指令进行重构;当末端执行器面临碰撞风险或结构刚度不足时,限幅系数收窄重构运动序列的运动幅度;当作业环境安全时,限幅系数基本保持指令幅度不变;遥控作业中的碰撞风险得到抑制,液压机械臂在非结构化危险环境中的作业安全性得以提升。
11、本申请的其他特征和优点将在随后的具体实施方式部分予以详细说明。
1.一种遥控液压机械臂的控制方法,其特征在于,包括:
2.根据权利要求1所述的方法,其特征在于,计算各旋转关节的等效液压刚度,包括:
3.根据权利要求2所述的方法,其特征在于,基于所述关节位姿数据与所述环境点云计算末端执行器的空间碰撞概率,包括:
4.根据权利要求3所述的方法,其特征在于,根据所述空间碰撞概率与所述等效液压刚度确定限幅系数,包括:
5.根据权利要求4所述的方法,其特征在于,对所述原始运动指令进行重构的过程包含时序重构,具体包括:
6.根据权利要求5所述的方法,其特征在于,对所述原始运动指令进行重构的过程还包含柔顺化重构,具体包括:
7.根据权利要求6所述的方法,其特征在于,将所述重构运动序列通过逆运动学解算为对应各液压缸的期望行程轨迹,包括:
8.根据权利要求7所述的方法,其特征在于,将所述实时位移数据转换为关节位姿数据以构建包含关节位姿数据与压力数据的状态信息,包括:
9.根据权利要求8所述的方法,其特征在于,所述方法还包括:
10.根据权利要求9所述的方法,其特征在于,在判定抵接到位并记录数据后,所述方法还包含:
版权声明:本站专利文献数据主要来源于国家知识产权局等公开渠道,由 技术新讯 进行整理汇编。页面设计及数据汇编的著作权归本站所有。全部内容仅供个人学习、科研评估与技术交流参考,严禁用于任何商业用途(包括但不限于直接生产制造、技术转让、倒卖数据等)。
免责条款:专利技术具有时效性,本站不对资料的绝对准确性、完整性和可实施性提供任何明示或暗示的担保。因参考本站内容造成的直接或间接损失,本站不承担相关法律责任。若您认为本站内容有侵权问题,请及时提供权属证明与我们联系,本站将在核实后依法处理。反馈意见:yyfuon@163.com