用于防挤压监控的方法、控制器及工程机械技术

本申请公开了一种用于防挤压监控的方法、控制器及工程机械。该方法包括：获取当前时刻重力传感器检测到的桅杆在第一方向的第一角度和桅杆在第二方向的第二角度；在第一角度小于预设值的情况下，将第二角度确定为桅杆在第二方向的实际偏移角度，以及将桅杆在第二方向的安全限制角度确定为设定值；根据实际偏移角度和安全限制角度确定第一模拟值和第二模拟值；根据第一模拟值和第二模拟值确定第一油缸和第二油缸的控制电流，以控制第一油缸和第二油缸。本申请考虑到车身偏移等干扰条件，通过重力传感器实时监控桅杆的运动和偏移角度，以实现对桅杆实际偏移角度的实时运算，并与安全限制角度进行比较输出对应的纠偏策略，硬件成本较低且精度较高。本较低且精度较高。本较低且精度较高。

【技术实现步骤摘要】
用于防挤压监控的方法、控制器及工程机械


[0001]本申请涉及工程机械控制
，具体地涉及一种用于防挤压监控的方法、控制器及工程机械。

技术介绍

[0002]防挤压监控是运用于包括旋挖钻机等工程机械的一种保护功能。目前，现有的防挤压监控技术中仅有通过限位开关解决目标控制结构运动自由度两端极限的方式，通过限位开关保证机械机构的安全性。然而，现有技术仅通过限位开关实现角度极值的限制，安全值受机械结构限制无法自行设置，控制技术简陋，往往需要精确把控限位开关安装精度，增加了硬件成本。且整体结构发偏移时没有纠偏策略，会产生限位误差，从而导致精度不高且降低安全性。因此，现有技术所采用的防挤压监控技术存在成本较高且精度较低的问题。

技术实现思路

[0003]本申请实施例的目的是提供一种用于防挤压监控的方法、控制器及工程机械，用以解决现有技术所采用的防挤压监控技术存在成本较高且精度较低的问题。
[0004]为了实现上述目的，本申请第一方面提供一种用于防挤压监控的方法，应用于工程机械，工程机械包括桅杆，第一油缸和第二油缸，第一油缸和第本文档来自技高网...

【技术保护点】

【技术特征摘要】
1.一种用于防挤压监控的方法，其特征在于，应用于工程机械，所述工程机械包括桅杆，第一油缸和第二油缸，所述第一油缸和所述第二油缸用于控制所述桅杆，所述桅杆上设置有重力传感器，所述方法包括：获取当前时刻所述重力传感器检测到的所述桅杆在第一方向的第一角度和所述桅杆在第二方向的第二角度；在所述第一角度小于预设值的情况下，将所述第二角度确定为所述桅杆在第二方向的实际偏移角度，以及将所述桅杆在第二方向的安全限制角度确定为设定值；根据所述实际偏移角度和所述安全限制角度确定第一模拟值和第二模拟值；根据所述第一模拟值和所述第二模拟值确定所述第一油缸和所述第二油缸的控制电流，以控制所述第一油缸和所述第二油缸。2.根据权利要求1所述的方法，其特征在于，所述工程机械还包括角度传感器，所述角度传感器设置于所述桅杆与所述桅杆的相邻机构的铰接处，所述方法还包括：获取所述角度传感器检测到的所述桅杆与所述相邻机构在所述第二方向的第三角度；在所述第一角度大于或等于所述预设值的情况下，将所述第三角度确定为所述桅杆在第二方向的实际偏移角度，并根据所述第一角度确定所述安全限制角度。3.根据权利要求1所述的方法，其特征在于，所述第一方向平行于所述桅杆的运动平面和水平面，所述第二方向垂直于所述桅杆的运动平面。4.根据权利要求1所述的方法，其特征在于，所述第一模拟值满足公式(1)：所述第二模拟值满足公式(2)：其中，B1为所述第一模拟值，B2为所述第二模拟值，A为所述安全限制角度，α为所述实际偏移角度，Q为设定系数。5.根据权利要求4所述的方法，其特征在于，所述第一油缸的控制电流包括第一伸展电流和第一收缩电流，所述第二油缸的控制电流包括第二伸展电流和第二收缩电流，所述根据所述第一模拟值和所述第二模拟值确定所述第一油缸和所述第二油缸的控制电流包括：获取所述桅杆当前的初始第一伸展电流、初始第一收缩电流、初始第二伸展电流和初始第二收缩电流；根据所述初始第一收缩电流、所述初始第二伸展电流和所述第一模拟值确定目标第一收缩电流和目标第二伸展电流；根据所述初始第一伸展电流、所述初始第二收缩电流和所述第二模拟值确定目标第一伸展电流和目标第二收缩电流。6.根据权利要求5所述的方法，其特征在于，所述根据所述初始第一收缩电流、所述初始第二伸展电流和所述第一模拟值确定目标第一收缩电流和目标第二伸展电流包括：判断所述第一模拟值是否处于预设范围内；在所述第一模拟值大于所述预设范围的最大值的情况下，将所述初始第一收缩电流确定为目标第...

【专利技术属性】
技术研发人员：应根美，何欢，冀永元，任礼，付存宝，
申请(专利权)人：上海中联重科桩工机械有限公司，
类型：发明
国别省市：