牵引绳的张力的获取方法及牵引无人机与流程

摘要: 本技术涉及无人机,特别是涉及一种牵引绳的张力的获取方法及牵引无人机。背景技术:1、随着无人机的发展,无人机应用于牵引滑翔伞,无人机通过牵引绳拖拽滑翔伞运动员加速...
牵引绳的张力的获取方法及牵引无人机与流程

本技术涉及无人机,特别是涉及一种牵引绳的张力的获取方法及牵引无人机。

背景技术:

1、随着无人机的发展,无人机应用于牵引滑翔伞,无人机通过牵引绳拖拽滑翔伞运动员加速起飞。为了确保无人机拖拽过程的安全和平稳,需要实时获取牵引绳的张力。现有技术通过在无人机上设置张力传感器获取牵引绳的张力,需要额外增加张力传感器,导致无人机的成本增加,增加无人机的负载。

技术实现思路

1、为解决上述技术问题,本技术提供了一种牵引绳的张力的获取方法及牵引无人机。

2、第一方面,本技术提供了一种牵引绳的张力的获取方法,应用于牵引无人机,所述牵引绳安装在所述牵引无人机上,所述牵引无人机包括多个姿态调节电机、多个牵引动力电机、角度传感器、惯性测量单元以及控制单元,所述控制单元分别与多个所述姿态调节电机、多个所述牵引动力电机、所述角度传感器以及所述惯性测量单元连接,所述获取方法包括:

3、建立所述牵引无人机的机体坐标系;

4、获取所述姿态调节电机的旋翼总升力、所述牵引动力电机的推力以及所述牵引无人机的重力;

5、通过所述角度传感器获取所述牵引绳的高低角以及所述牵引绳的方位角,通过所述惯性测量单元获取三轴加速度以及当前姿态角,获取所述牵引无人机的飞行空速以及安装角度;

6、基于所述飞行空速得到气动阻力,基于所述旋翼总升力、所述推力、所述重力、所述牵引绳的高低角、所述牵引绳的方位角、所述三轴加速度、所述当前姿态角、所述气动阻力以及所述安装角度得到所述牵引绳的原始张力;

7、对所述原始张力进行滤波处理得到所述牵引绳的张力。

8、在一些实施例中,所述基于所述旋翼总升力、所述推力、所述重力、所述牵引绳的高低角、所述牵引绳的方位角、所述三轴加速度、所述当前姿态角、所述气动阻力以及所述安装角度得到所述牵引绳的原始张力的步骤,包括:

9、所述当前姿态角包括俯仰角和滚转角,所述原始张力满足以下公式:

10、

g

11、

12、其中,

g为所述重力,为所述原始张力,

l为所述旋翼总升力,

t为所述推力,为所述牵引绳的高低角,为所述牵引绳的方位角,为所述俯仰角,为所述滚转角,

d为所述气动阻力,为所述安装角度,为所述牵引无人机的质量,为所述三轴加速度中的

z轴加速度,为所述三轴加速度中的

x轴加速度。

13、在一些实施例中,所述牵引无人机包括四个姿态调节电机,所述旋翼总升力满足以下公式:

14、

l=k_thrust*(thr1+thr2+thr3+thr4)

15、

l为所述旋翼总升力,k_thrust为推力系数,thr1、thr2、thr3以及thr4分别为所述四个姿态调节电机的油门指令。

16、在一些实施例中,所述牵引无人机包括两个牵引动力电机,所述牵引动力电机的推力满足以下公式:

17、

t=k_tow*(thr5+thr6)

18、

t为所述推力,k_tow为拉力系数,thr5、thr6分别为所述两个牵引动力电机的油门指令。

19、在一些实施例中,所述气动阻力满足以下公式:

20、

21、

d为所述气动阻力,为空气密度,为所述飞行空速,为阻力系数,为参考面积。

22、在一些实施例中,所述获取方法还包括:

23、基于所述牵引绳的高低角和所述牵引绳的方位角得到所述牵引绳的方向。

24、在一些实施例中,所述牵引绳的方向的单位矢量满足以下公式:

25、

26、为所述单位矢量,为所述牵引绳的高低角,为所述牵引绳的方位角。

27、在一些实施例中,所述获取方法还包括:

28、在所述牵引无人机进行恒拉力牵引控制时,基于所述牵引绳的张力得到第一牵引控制率,所述第一牵引控制率满足以下公式:

29、

30、为第一牵引控制率,为预设的张力,,且为控制参数。

31、在一些实施例中,所述获取方法还包括:

32、在所述牵引无人机进行恒爬升率控制时,获取所述牵引无人机的垂直速度,基于所述垂直速度得到第二牵引控制率,所述第二牵引控制率满足以下公式:

33、

34、为所述第二牵引控制率,为所述垂直速度,为预设的垂直速度,,且为控制参数。

35、第二方面,本技术提供一种牵引无人机,牵引绳安装在所述牵引无人机上,所述牵引无人机包括多个姿态调节电机、多个牵引动力电机、角度传感器、惯性测量单元以及控制单元,所述控制单元分别与多个所述姿态调节电机、多个所述牵引动力电机、所述角度传感器以及所述惯性测量单元连接,所述控制单元用于:

36、建立所述牵引无人机的机体坐标系;

37、获取所述姿态调节电机的旋翼总升力、所述牵引动力电机的推力以及所述牵引无人机的重力;

38、通过所述角度传感器获取牵引绳的高低角以及牵引绳的方位角,通过所述惯性测量单元获取三轴加速度以及当前姿态角,获取所述牵引无人机的飞行空速以及安装角度;

39、基于所述飞行空速得到气动阻力,基于所述旋翼总升力、所述推力、所述重力、所述牵引绳的高低角、所述牵引绳的方位角、所述三轴加速度、所述当前姿态角、所述气动阻力以及所述安装角度得到所述牵引绳的原始张力;

40、对所述原始张力进行滤波处理得到所述牵引绳的张力。

41、本技术提供的牵引无人机包括多个姿态调节电机、多个牵引动力电机、角度传感器、惯性测量单元以及控制单元,控制单元分别与多个姿态调节电机、多个牵引动力电机、角度传感器以及惯性测量单元连接;获取方法包括:建立牵引无人机的机体坐标系;获取姿态调节电机的旋翼总升力、牵引动力电机的推力以及牵引无人机的重力;通过角度传感器获取牵引绳的高低角以及牵引绳的方位角,通过惯性测量单元获取三轴加速度以及当前姿态角,获取牵引无人机的飞行空速以及安装角度;基于飞行空速得到气动阻力,基于旋翼总升力、推力、重力、牵引绳的高低角、牵引绳的方位角、三轴加速度、当前姿态角、气动阻力以及安装角度得到牵引绳的原始张力;对原始张力进行滤波处理得到牵引绳的张力。通过多个姿态调节电机、多个牵引动力电机、角度传感器、惯性测量单元以及控制单元得到牵引绳的张力,无需额外安装张力传感器,无需增加牵引无人机的成本,无需增加牵引无人机的负载,能够降低牵引无人机的复杂度,提高牵引无人机的可靠性。另外,通过旋翼总升力、推力、重力、牵引绳的高低角、牵引绳的方位角、三轴加速度、当前姿态角、气动阻力以及安装角度得到牵引绳的原始张力,三轴加速度为牵引无人机的高频数据,能够满足原始张力的快速变化,实现原始张力的实时性。此外,通过原始张力能够检测牵引绳过载或者松绳状态,能够提高安全预警。