一种烟草料液罐清洁路径规划控制系统、方法及存储介质与流程

摘要: 本发明涉及烟草制备领域,具体涉及一种烟草料液罐清洁路径规划控制系统、方法及存储介质。背景技术: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、通过采用上述技术方案,本发明通过将烟草料液罐内壁由柱面空间展开为二维清洁地图,并依据清洁执行件的有效清洁宽度和轨迹搭接率生成覆盖栅格,使清洁路径规划具备明确的空间约束和覆盖依据;通过视觉采集单元识别料液残留区域、结垢区域、水渍反光区域及罐体边缘区域,并将污渍识别结果映射至覆盖栅格,使系统能够针对普通区域生成基础覆盖路径,针对重点污渍区域生成增强补扫路径,减少漏擦和无效重复清洁;通过虚拟安全边界、分级避障和局部重规划,使清洁机构在接近罐体边缘、凸起障碍物或不可通行区域时能够自动减速、绕行或急停,降低设备与罐体碰撞风险;通过将规划路径转换为左右驱动电机的目标速度和目标转速,提高移动路径跟踪精度;通过清洁后图像复核和残留区域补扫机制,从而提升烟草料液罐内壁自动清洁的覆盖完整性、清洁稳定性和连续生产适配性。