一种基于无人机的张力放线实时协同控制方法及系统与流程

摘要: 本申请涉及输电线路张力放线施工的,尤其涉及一种基于无人机的张力放线实时协同控制方法及系统。背景技术: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、优选的,所述反馈控制量通过pid控制算法生成,包括:

23、将所述实际张力值与期望张力值的偏差作为pid控制器的输入,经比例、积分、微分三个环节的综合运算后输出所述反馈控制量,用于消除实测张力与期望张力之间的稳态误差并抑制张力波动。

24、优选的,所述前馈控制量与反馈控制量进行融合时,包括:

25、根据无人机的飞行状态动态调整前馈权重系数和反馈权重系数,将所述前馈控制量、所述反馈控制量分别乘以其对应的权重系数后求和,生成所述最终的控制指令。

26、另一方面,本公开还提供一种基于无人机的张力放线实时协同控制系统,应用于地面端,其包括:

27、通信模块,用于接收来自机载端的无人机在未来预设时间段内的预测飞行轨迹参数;

28、张力预测模块,与所述通信模块连接,内置线缆张力动态预测模型,用于根据所述预测飞行轨迹参数计算未来时刻的线缆预测张力值;

29、前馈控制器,与所述张力预测模块连接,用于根据所述线缆预测张力值与期望张力值的偏差生成前馈控制量;

30、反馈控制器,与设置于张力机出线端的张力传感器连接,用于根据实测张力值与期望张力值的偏差生成反馈控制量;

31、协同控制器,与所述前馈控制器和反馈控制器连接,用于将所述前馈控制量与反馈控制量进行融合,生成最终的控制指令;

32、张力执行机构,与所述协同控制器连接,用于根据所述最终的控制指令执行收线或放线动作。

33、本申请的有益效果为:

34、通过机载端实时截获无人机飞控模块的未来飞行指令并生成预测飞行轨迹参数,地面端基于线缆张力动态预测模型提前计算预测张力值并生成前馈控制量,在张力实际变化发生之前驱动执行机构动作,可有效克服系统固有滞后问题。其次,预测飞行轨迹参数直接来源于飞控模块内部指令,包含期望速度矢量、加速度矢量及姿态角,是无人机未来行为的真实表征,使无人机的每一个飞行动作均能被张力控制系统提前感知并预先响应,实现飞控与张力的深度协同。

1.一种基于无人机的张力放线实时协同控制方法,应用于地面端张力控制系统,其特征在于,包括:

2.根据权利要求1所述的基于无人机的张力放线实时协同控制方法,其特征在于,所述预测飞行轨迹参数至少包括无人机的期望速度矢量、期望加速度矢量及期望姿态角,所述期望姿态角包括俯仰角、滚转角及偏航角。

3.根据权利要求1所述的基于无人机的张力放线实时协同控制方法,其特征在于,所述未来预设时间段的时长根据无人机的当前飞行状态动态自适应调整:当无人机处于加速或减速机动状态时,缩短所述时长;当无人机处于匀速或悬停状态时,延长所述时长。

4.根据权利要求1所述的基于无人机的张力放线实时协同控制方法,其特征在于,所述线缆张力动态预测模型包含:

5.根据权利要求4所述的基于无人机的张力放线实时协同控制方法,其特征在于,所述动态增量张力分量在计算过程中,包括:

6.根据权利要求1所述的基于无人机的张力放线实时协同控制方法,其特征在于,所述前馈控制量根据所述线缆预测张力值与期望张力值的偏差生成,包括:

7.根据权利要求1所述的基于无人机的张力放线实时协同控制方法,其特征在于,所述反馈控制量通过pid控制算法生成,包括:

8.根据权利要求1所述的基于无人机的张力放线实时协同控制方法,其特征在于,所述前馈控制量与反馈控制量进行融合时,包括:

9.一种基于无人机的张力放线实时协同控制系统,应用于地面端,其特征在于,包括: