基于空间几何分析的作业车防倾翻优化方法及系统与流程
本发明涉及工程机械智能控制,特别是基于空间几何分析的作业车防倾翻优化方法及系统。
背景技术:
1、目前,起重机、高空作业车等各类工程作业车的防倾翻保护主要依赖于力矩限制器与姿态传感监测系统。利用安装的倾角传感器、压力传感器及编码器采集底盘倾角、支腿压力及臂架位姿,并将其与控制器中预设的离散安全作业包络线进行实时比对。当实时参数接近或超过设定阈值时,则进行预警和应急维护工作。
2、而随着现代作业车作业环境的复杂化,使用传统模型基于准静态假设,就会忽略多维变幅、复杂变频回转及非平整地面条件下,力矩限制器难以捕捉动态惯性力带来的瞬时失稳风险的问题。传统的控制策略滞后于危险的发生,缺乏对系统全局空间几何稳定裕度的前瞻性预测与动态调控,导致防倾翻系统难以实现全工况下的最优动态防倾翻控制。
技术实现思路
1、鉴于上述现有存在的问题,提出了本发明。
2、因此,本发明提供了一种基于空间几何分析的作业车防倾翻优化方法解决传统防倾翻控制方法在动态工况下预测精度低、响应滞后以及无法进行多目标自适应调节问题。
3、为解决上述技术问题,本发明提供如下技术方案:
4、第一方面,本发明提供了一种基于空间几何分析的作业车防倾翻优化方法,其包括,获取作业车的多维空间状态参数,构建几何空间运动学模型;
5、对作业车质心空间坐标进行等效几何偏移补偿,获取有效动态质心投影点;
6、根据有效动态质心投影点计算实时稳定裕度,基于实时稳定裕度的时空衰减特征判定作业车的倾翻风险状态,构建几何安全约束子空间;
7、在所述几何安全约束子空间内,以满足实时稳定裕度安全阈值为硬约束,利用受几何梯度引导的群体启发式优化算法进行动作指令空间的寻优,生成最优防倾翻动作指令序列。
8、作为本发明所述基于空间几何分析的作业车防倾翻优化方法的一种优选方案,其中:所述构建几何空间运动学模型包括,以作业车回转机构的旋转中心为坐标原点,建立空间直角坐标系;
9、实时获取作业车的位姿状态数据及控制输入参数;通过高精度倾角传感器采集底盘的实时俯仰角与侧倾角;通过编码器实时读取变幅角和回转角;提取作业车的结构参数,将作业车离散化为多刚体模型;分别对车体基座、配重模块、运动臂架及末端负载建立质量点集;
10、基于获取的位姿数据,通过坐标空间变换矩阵,实时解算各质量点在坐标系下的三维空间坐标;根据多刚体质量分布,计算当前时刻作业车的静态质心三维空间坐标。
11、作为本发明所述基于空间几何分析的作业车防倾翻优化方法的一种优选方案,其中:所述对作业车质心空间坐标进行等效几何偏移补偿包括,根据作业车当前的底盘姿态与履带的实际伸展状态动态生成几何安全边界;提取各支撑点的局部坐标,利用坐标空间变换矩阵映射至全局地理坐标系中;
12、将三维空间坐标沿重力方向正交投影至水平参考面上,形成二维离散投影点集;采用凸包搜索算法对投影点集进行包络检测,剔除内部无效点,生成由最外围支撑点构成的有序凸多边形;将有序凸多边形的边缘定义为在当前工况下的几何支撑边界;
13、将计算出的静态质心三维空间坐标正交投影至有序凸多边形的水平面上,得到静态质心投影点;
14、引入零矩点原理进行几何补偿,通过实时采集的回转与变幅角速度、角加速度,计算出总质心在水平方向上的瞬时合成加速度;将因加减速产生的惯性力矩等效转化为质心投影点在水平面上的几何位移向量;通过将静态投影点与偏移向量进行向量叠加,得到反映动力学倾翻趋势的有效动态质心投影点。
15、作为本发明所述基于空间几何分析的作业车防倾翻优化方法的一种优选方案,其中:所述根据有效动态质心投影点计算实时稳定裕度包括,通过计算点与多边形的几何支撑边界的相对几何关系来量化稳定性;将多边形的每一条边定义为有向边界线段,采用向量叉乘法依次计算有效动态质心点到各条边界线段的带符号正交距离;
16、若距离为正,则质心处于有序凸多边形内部,作业车处于安全状态;若距离为负,则表示作业车质心已越过边界;
17、遍历所有边界线段,提取其中的最小距离作为当前的实时稳定裕度指标。
18、作为本发明所述基于空间几何分析的作业车防倾翻优化方法的一种优选方案,其中:所述构建几何安全约束子空间包括,提取相邻两个采样周期内的有效动态质心投影点对应的实时稳定裕度差值,结合采样时间,计算出当前质心逼近多边形支撑边界的法向侵入速度;当法向侵入速度表现为质心加速向外侧移动时,将当前的稳定裕度距离除以该侵入速度的绝对值,推算出预测碰撞时间;
19、将采集的外部环境数据作为干扰因子计算实时安全阈值和危险临界阈值;
20、建立并行的时空双重判定逻辑:一方面监测空间越限,判断实时稳定裕度是否低于危险临界阈值;另一方面监测时间越限,即判断预测碰撞时间是否小于液压执行机构固有的机械滞后时间与算法寻优耗时之和;
21、若高于危险临界阈值或者大于寻优耗时之和,则判定存在倾翻风险状态,触发后,在当前的有序凸多边形中,锁定距离质心最近的边界线段作为激活约束边界,并计算出与边界垂直且指向多边形内部几何中心的安全法向量。
22、作为本发明所述基于空间几何分析的作业车防倾翻优化方法的一种优选方案,其中:所述受几何梯度引导的群体启发式优化算法包括,启动群体启发式优化算法,将包含变幅调整量、回转速度调节量以及支腿高度补偿量的动作指令组合定义为算法的寻优粒子;
23、在初始化阶段,利用作业车当前的物理运动学逆解矩阵,将提取的安全法向量,反向映射为三维物理关节上的基准梯度向量;将初始动作策略生成在基准梯度向量的极小邻域内,基于物理先验定向初始化,剔除无效的搜索空间;
24、在算法迭代中,在内部控制器中进行正向预测,设执行了某一组动作指令,推演计算出下一周期的预期有效动态质心及其对应的预期稳定裕度;构建多目标适应度函数,综合评估预期裕度的提升量与机械动作带来的冲击能耗;若执行时间出现了时间越限,或者预期裕度仍未达到安全阈值,将在适应度函数中施加极大的惩罚值。
25、作为本发明所述基于空间几何分析的作业车防倾翻优化方法的一种优选方案,其中:所述生成最优防倾翻动作指令序列包括,将算法的搜索惯性权重与几何深度进行动态耦合,提取有序凸多边形支撑域的最大内切圆半径作为安全腹地基准;
26、随着寻优迭代,当预期质心逐渐远离危险边界并向该内切圆中心靠拢时,作业车的惯性权重呈非线性急剧衰减;在脱离极度危险区后,自动缩小搜索步长,进行指令的精细微调,迫使算法在安全区进行极小步长的微调寻优,最终平滑收敛,输出防倾翻全局最优指令序列;
27、在计算出全局最优指令序列后,根据作业车各执行机构物理响应频率的快慢,进行拆分与分级下发。
28、第二方面,本发明提供了一种基于空间几何分析的作业车防倾翻优化系统,包括,状态映射模块,由各类高精度传感器及前端数据融合单元构成;采集车体姿态、各关节运动数据以及负载重量,计算出整车的静态质心空间坐标;
29、动态几何分析模块,将动力学问题降维为几何图形问题,在基准平面上生成凸多边形支撑边界,输出实时稳定裕度;
30、决策模块,监测当前的稳定裕度,结合质心侵入速度推算预测碰撞时间,启动内部的群体启发式寻优算法,迭代出最优动作指令组合;
31、底层伺服执行模块,将决策模块输出的纯数学最优解转化为底层液压机械的实际动作。
32、第三方面,本发明提供了一种计算机设备,包括存储器和处理器,所述存储器存储有计算机程序,其中:所述计算机程序被处理器执行时实现如本发明第一方面所述的基于空间几何分析的作业车防倾翻优化方法的任一步骤。
33、第四方面,本发明提供了一种计算机可读存储介质,其上存储有计算机程序,其中:所述计算机程序被处理器执行时实现如本发明第一方面所述的基于空间几何分析的作业车防倾翻优化方法的任一步骤。
34、本发明有益效果为:将复杂的倾翻力学问题重构为二维支撑域内的几何点到面距离求解问题,引入动态惯性几何补偿机制,并结合改进的群体启发式优化算法实现执行机构的最优解耦控制,从而解决了传统防倾翻控制方法在动态工况下预测精度低、响应滞后以及无法进行多目标自适应调节的技术难题,实现了作业车作业过程中的主动防倾翻与工况实时优化。
版权声明:本站专利文献数据主要来源于国家知识产权局等公开渠道,由 技术新讯 进行整理汇编。页面设计及数据汇编的著作权归本站所有。全部内容仅供个人学习、科研评估与技术交流参考,严禁用于任何商业用途(包括但不限于直接生产制造、技术转让、倒卖数据等)。
免责条款:专利技术具有时效性,本站不对资料的绝对准确性、完整性和可实施性提供任何明示或暗示的担保。因参考本站内容造成的直接或间接损失,本站不承担相关法律责任。若您认为本站内容有侵权问题,请及时提供权属证明与我们联系,本站将在核实后依法处理。反馈意见:yyfuon@163.com