基于动态轨迹规划的施工设备协同控制系统

摘要: 本发明涉及智能施工装备协同控制,具体为基于动态轨迹规划的施工设备协同控制系统。背景技术:1、施工设备协同控制是指根据施工现场中多设备的作业关系、运行轨迹以及环境...
基于动态轨迹规划的施工设备协同控制系统

本发明涉及智能施工装备协同控制,具体为基于动态轨迹规划的施工设备协同控制系统。

背景技术:

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、将所述速度平滑策略应用于所述退让轨迹数据的末端节点,生成粘滞连续恢复轨迹;

35、将所述粘滞连续恢复轨迹转化为所述协同设备的驱动器控制信号,生成所述状态恢复指令。

36、可选地,所述自适应评估模块获取施工周期内的冲突化解数据,并计算局部自洽恢复率,具体包括:

37、获取预设施工周期内发生的所有动态空间干扰事件,并标记为总冲突事件集合;

38、获取所述总冲突事件集合中仅依靠所述人工粘弹性势场化解且未触发全局拓扑重规划请求的事件,并标记为局部自洽事件;

39、统计所述总冲突事件集合的总数量与所述局部自洽事件的自洽数量,并将所述总数量与所述自洽数量作为所述冲突化解数据;

40、配置为:若所述总数量大于零,则基于所述自洽数量与所述总数量评估获取所述局部自洽恢复率;若所述总数量等于零,则将所述局部自洽恢复率设定为预设满载阈值。

41、可选地,所述自适应评估模块基于所述局部自洽恢复率判断是否生成全局拓扑重规划指令,具体包括:

42、获取预设的自洽恢复阈值;

43、将所述局部自洽恢复率与所述自洽恢复阈值进行对比;

44、若所述局部自洽恢复率大于或等于所述自洽恢复阈值,则不生成所述全局拓扑重规划指令;

45、若所述局部自洽恢复率小于所述自洽恢复阈值,则生成所述全局拓扑重规划指令。

46、与现有技术相比,本发明具备以下有益效果:

47、1.本系统通过环境感知模块获取协同设备的空间状态数据,并对施工环境中的动态实体进行监测以获取动态环境干扰数据,由势场构建模块基于上述数据构建人工粘弹性势场;该机制能够将施工现场频发的动态干扰转化为连续的时空挤压状态,使得协同设备在面临干扰时,能够基于真实的运动能力与现场空间关系进行弹性退让;这克服了现有技术中感知响应不够连续精确的问题,避免了因单一距离判断引发的急停急转,有效保障了施工协同控制的安全性;

48、2.本系统通过势场构建模块计算轨迹形变势能积分,并由轨迹形变模块基于人工粘弹性势场与该积分对预设规划轨迹进行局部形变处理,生成退让轨迹数据;通过对运动惯性代价与空间形变代价建立虚拟能量消耗值进行约束,系统能够在设备物理执行边界内生成连续的弹性退让节点并进行平滑拟合,避免了轨迹为躲避局部干扰而产生过深偏折,使得设备能够以符合真实机械规律的方式顺畅执行退让动作,解决了传统方法中容易导致的轨迹拐折和控制不连续问题;

49、3.本系统通过时空恢复模块提取协同设备在协同网络中的任务时序依赖关系与加减速响应周期,计算时空同步阻尼系数,并据此对退让轨迹数据进行粘滞性平滑补偿以生成状态恢复指令;该机制将空间避让后的时间扰动纳入统一控制,限制了设备在脱离干扰区后因急于追赶进度而产生突发大加速度或动作突变;这有效防止了多设备耦合作业时产生的二次机械冲击与连锁阻塞,解决了传统避让后节拍同步不足导致的作业节拍失衡问题;

50、4.本系统通过自适应评估模块获取施工周期内的冲突化解数据,计算局部自洽恢复率,并基于该恢复率判断是否生成全局拓扑重规划指令;该机制构建了一个面向施工周期的自适应反馈评估标准,在局部柔性退让控制与全局组织重构之间确立了明确的触发边界;系统能够根据现场干扰强度的变化动态决定控制层级,既避免了因过度依赖局部机制导致的超负荷低效徘徊,也防止了不必要的高频全局重规划引发的效率下降,保障了整体施工协同的连贯运行与控制稳定性。