一种光伏导轨轨迹偏移自校正方法与流程

摘要: 本发明涉及光伏清洁机器人控制,更具体地说,它涉及一种光伏导轨轨迹偏移自校正方法。背景技术:1、光伏电站通常具有较大的组件铺设面积,光伏组件表面易积聚灰尘、鸟粪、...
一种光伏导轨轨迹偏移自校正方法与流程

本发明涉及光伏清洁机器人控制,更具体地说,它涉及一种光伏导轨轨迹偏移自校正方法。

背景技术:

1、光伏电站通常具有较大的组件铺设面积,光伏组件表面易积聚灰尘、鸟粪、砂砾等附着物,影响组件受光效率。为降低人工清洁成本并提升清洁作业连续性,沿光伏导轨运行的光伏清洁机器人逐渐得到应用。该类光伏清洁机器人通常依靠横向第一侧和横向第二侧的驱动部件提供行进动力,并通过对应设置的导向轮与光伏导轨配合,以维持机体沿导轨方向稳定移动。

2、在实际光伏场站中,受组件排布间隔、支架连接结构、检修通道以及导轨分段安装方式影响,相邻光伏导轨之间常设置桥接轨区域。桥接轨区域承担导轨过渡连接作用,使光伏清洁机器人能够由前导轨段跨越至后导轨段。由于安装公差、支架沉降、热胀冷缩、风载变形、导轨局部磨损或桥接轨装配偏差等因素,前导轨、桥接轨与后导轨之间可能存在方向不连续、横向错位或局部高度变化,光伏清洁机器人在通过该区域时更容易产生轨迹偏移。

3、现有光伏清洁机器人通常能够根据导轨观测信息或机体航向信息进行差速纠偏,例如通过调节横向第一侧与横向第二侧驱动部件之间的速度差,使机体回到预期行进方向。该类方式在连续直线导轨或偏差变化较缓的导轨段中具有较好的适用性。然而,在桥接轨区域内,前导轨观测量与后导轨观测量可能同时存在且相互不一致,单独依据某一侧导轨观测量进行纠偏时,容易出现纠偏方向突变或纠偏幅度过大的情况。

4、此外,光伏清洁机器人跨越桥接轨区域时,导向轮不仅承担导向作用,还与光伏导轨的侧向限位结构形成约束关系。当横向第一侧与横向第二侧受到的侧向约束载荷差异较大时,某一侧导向轮可能处于明显受压状态。若此时候选差速纠偏量继续驱使机体向受压侧偏转,受压侧导向轮与光伏导轨之间的压紧程度可能进一步增加,导致导向轮出现楔紧、摩擦增大或短暂卡滞现象,影响桥接轨区域通过的平顺性和可靠性。

5、因此,本技术提出了一种光伏导轨轨迹偏移自校正方法。

技术实现思路

1、针对现有技术存在的不足,本发明的目的在于提供一种光伏导轨轨迹偏移自校正方法。

2、为实现上述目的,本发明提供了如下技术方案:

3、一种光伏导轨轨迹偏移自校正方法,由沿光伏导轨运行并跨越桥接轨区域的光伏清洁机器人的控制器执行,光伏清洁机器人具有横向第一侧、横向第二侧、分别对应于横向第一侧和横向第二侧的导向轮、分别对应于横向第一侧和横向第二侧的驱动部件,以及用于调节导向轮压紧力的导向轮压紧调节机构,包括:

4、步骤一,获取跨桥运行参数,并根据跨桥运行参数确定导轨方向断裂角;

5、跨桥运行参数包括前导轨观测量、后导轨观测量、机体航向向量、桥接轨通过进程参数和侧向约束状态量;

6、步骤二,根据跨桥运行参数和导轨方向断裂角,生成当前桥接控制参数;

7、步骤三,根据前导轨观测量、后导轨观测量、机体航向向量和当前桥接控制参数,生成虚拟过渡轨迹偏差量和候选差速纠偏量;

8、步骤四,根据导轨方向断裂角、虚拟过渡轨迹偏差量、当前桥接控制参数、侧向约束状态量和候选差速纠偏量,确定受压侧、支撑侧、受压侧导向轮和支撑侧导向轮,并生成当前楔入风险指数;

9、步骤五,根据当前楔入风险指数,对由候选差速纠偏量确定的驱动速度差和受压侧导向轮的压紧力进行调节,以执行桥接轨区域内的轨迹偏移自校正。

10、在其中一个实施例中,光伏清洁机器人设有分别位于横向第一侧和横向第二侧的第一侧导向轮和第二侧导向轮、分别位于横向第一侧和横向第二侧的第一侧驱动轮和第二侧驱动轮,导向轮压紧调节机构用于调节第一侧导向轮和第二侧导向轮对光伏导轨的侧向限位部的压紧力。

11、在其中一个实施例中,前导轨观测量包括前导轨方向向量、前导轨横向偏移量和前导轨观测质量;后导轨观测量包括后导轨方向向量、后导轨横向偏移量和后导轨观测质量;侧向约束状态量包括第一侧约束载荷和第二侧约束载荷。

12、在其中一个实施例中,当前桥接控制参数包括跨桥一致性约束量和当前桥接信任系数。

13、在其中一个实施例中,根据导轨方向断裂角、前导轨横向偏移量与后导轨横向偏移量的偏移差以及第一侧约束载荷与第二侧约束载荷的载荷差,生成跨桥一致性约束量;对前导轨观测质量、后导轨观测质量、桥接轨通过进程参数和跨桥一致性约束量进行归一化融合,得到当前桥接信任系数。

14、在其中一个实施例中,根据当前桥接信任系数确定前导轨观测量和后导轨观测量的融合权重,并按融合权重融合得到虚拟过渡观测量;将虚拟过渡观测量相对机体航向向量的位置偏差和方向偏差,作为虚拟过渡轨迹偏差量。

15、在其中一个实施例中,以位置偏差确定横向纠偏项,以方向偏差确定航向纠偏项;对横向纠偏项和航向纠偏项按当前桥接信任系数加权叠加并限幅,得到候选差速纠偏量。

16、在其中一个实施例中,步骤四中,确定受压侧、支撑侧、受压侧导向轮和支撑侧导向轮,包括:将第一侧约束载荷和第二侧约束载荷中数值较大的一侧确定为受压侧,将另一侧确定为支撑侧,并将位于受压侧的导向轮确定为受压侧导向轮,将位于支撑侧的导向轮确定为支撑侧导向轮。

17、在其中一个实施例中,当前楔入风险指数的生成方式如下:根据导轨方向断裂角和虚拟过渡轨迹偏差量生成几何风险量;根据第一侧约束载荷与第二侧约束载荷的载荷差生成载荷风险量;根据候选差速纠偏量是否驱使光伏清洁机器人向受压侧偏转生成动作风险量;按跨桥一致性约束量对几何风险量、载荷风险量以及动作风险量加权融合,得到当前楔入风险指数。

18、在其中一个实施例中,步骤五包括:根据当前楔入风险指数,在正常纠偏状态、压力释放状态和再贴合状态之间进行滞回切换;在正常纠偏状态下,根据候选差速纠偏量调节横向第一侧与横向第二侧之间的驱动速度差;在压力释放状态下,限制光伏清洁机器人向受压侧偏转,降低受压侧导向轮的压紧力,并维持支撑侧导向轮对光伏导轨的支撑;在再贴合状态下,逐步恢复受压侧导向轮的压紧力,并对横向第一侧与横向第二侧之间的驱动速度差进行限幅;当满足预设切换完成条件时,结束桥接轨区域内的轨迹偏移自校正。

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

20、本发明通过获取包括前导轨观测量、后导轨观测量、机体航向向量、桥接轨通过进程参数和侧向约束状态量在内的跨桥运行参数,并根据跨桥运行参数确定导轨方向断裂角,使光伏清洁机器人在跨越桥接轨区域时能够综合识别前导轨、后导轨与机体行进方向之间的相对关系,提高对桥接轨区域导轨方向不连续、过渡错位及轨迹偏移趋势的判断准确性,避免仅依据单一观测量进行纠偏而导致控制依据不足;

21、根据跨桥运行参数和导轨方向断裂角生成当前桥接控制参数,并进一步结合前导轨观测量、后导轨观测量和机体航向向量生成虚拟过渡轨迹偏差量及候选差速纠偏量,使光伏清洁机器人在桥接轨区域内能够形成与前后导轨过渡关系相匹配的纠偏依据,提升横向第一侧与横向第二侧驱动部件之间驱动速度差调节的连续性和平顺性,有利于降低跨桥过程中因导轨方向变化引起的轨迹突变;

22、根据导轨方向断裂角、虚拟过渡轨迹偏差量、当前桥接控制参数、侧向约束状态量和候选差速纠偏量确定受压侧、支撑侧、受压侧导向轮和支撑侧导向轮,并生成当前楔入风险指数,进而对由候选差速纠偏量确定的驱动速度差和受压侧导向轮的压紧力进行协同调节,使轨迹偏移自校正过程兼顾差速纠偏和导向轮受力状态,降低受压侧导向轮在桥接轨区域内发生过度压紧、摩擦增大或楔入卡滞的风险,提高光伏清洁机器人跨越桥接轨区域的通过稳定性和运行可靠性。