一种车载式无人机自主充电平台的制作方法

1.本发明属于无人机技术领域，特别涉及一种车载式无人机自主充电平台。


背景技术：

2.近年来无人机在生产生活中的应用越来越广泛，例如农药喷洒，物流派件以及军事侦查等领域；但是无人机普遍存在着续航时间短的问题，因此发展无人机自主充电技术很具有必要性。
3.现有的自主充电装置可分为无线式和接触式；无线充电方式所需的机械结构简单，但充电效率较低；接触式充电方式效率高，但需要较为复杂的机械结构，且对定位精准性要求较高。
4.同时，现有的无人机充电装置大多为固定基站充电，这类基站往往体积较大，同时受制于基站的位置，无人机往返基站的过程中浪费大量电能，因此适应性和灵活性较差。而车载式充电装置可以弥补这些缺陷，该装置体积小可以放置于车顶，因此有很强的灵活性，对于野外工作的无人机提供移动的充电平台，减少不必要的电能浪费。


技术实现要素：

5.本发明针对上述现有技术的不足，提供了一种车载式无人机自主充电平台，为无人机灵活充电，且效率高。
6.所述的车载式无人机自主充电平台，包括车顶机库、起降凸台、充电接口装置和四旋翼无人机；
7.车顶机库内部安装有起降凸台和蓄电池，蓄电池为起降凸台提供电源；起降凸台顶部和无人机底部分别布置充电接口装置的公头和母头，当四旋翼无人机停靠在起降凸台上进行自主充电；充电接口装置采取倒锥形，锥尖处安装有橡胶缓冲垫；
8.同时，充电接口还采取了分区导电设计；正极区和负极区对称分布，且各自有导电和绝缘区域；其中母头的正(负)极区有135
°
导电、45
°
绝缘，公头的导电(绝缘)区域与之互补。
9.起降凸台顶部具有图像识别的特征标志物，用于四旋翼无人机末端的视觉定位；
10.起降凸台的外形与四旋翼无人机支腿的内轮廓一致，没有缝隙，保证无人机能牢固停靠在凸台上。
11.起降凸台底部设有环形凹槽，用于固定四旋翼无人机支腿的位置；环形凹槽中布置有电磁铁阵列，用于吸附带有铁片的无人机支腿，使得充电装置的公母头充分接触，保证充电效率。
12.所述四旋翼无人机包括控制器，控制器分为位置控制器和姿态控制器；
13.位置控制器为：
14.f为四旋翼无人机产生的合外力大小，用于实现位置镇定；k
x
为位置跟踪误差的反馈系数；e
x
为位置跟踪误差；k
v
为速度跟踪误差的反馈系数；e
v
为速度跟踪误差；k
i
为跟踪误
差的反馈系数；e
i
为跟踪误差的积分项；sat
σ
为饱和函数；为地面惯性坐标系中的第三条轴；为理想位置信号的二次导数；r为四旋翼无人机的旋转矩阵，是单位正交矩阵；
15.姿态控制器为：
[0016][0017]
m为四旋翼无人机产生的合外力矩；k
r
为姿态跟踪误差的反馈系数；e
r
为姿态跟踪误差；k
ω
为角速度跟踪误差的反馈系数；e
ω
为角速度跟踪误差；k
i
为姿态跟踪误差的反馈系数；e
i
为姿态跟踪误差的积分项；r
c
为期望的姿态矩阵；ω
c
为期望的角速度；j为四旋翼无人机的转动惯量矩阵。
[0018]
所述的车载式无人机自主充电平台的电路系统包括电源模块、通信模块、电磁铁阵列模块、控制模块和无人机
‑
锂电池负载；
[0019]
通信模块是控制模块和四旋翼无人机的通信中介；控制模块根据四旋翼无人机的充电情况，控制电磁铁阵列模块的通断。
[0020]
所述控制模块以arduino uno为主控板，uno的引脚gnd接电源模块5v直流电压的负极、引脚vin接5v直流电压的正极；模拟引脚a0和a1分别接在小电阻r1的两端；数字引脚d0接电磁铁阵列模块的输入正极，引脚d1接通信模块的输入端口，引脚d2接通信模块的输出端口，且uno与电磁铁阵列模块和通信模块共地。
[0021]
四旋翼无人机充电时，控制器每隔0.1s测量电压，间接获得充电电路的通断信息，如果充电电路断开，控制器控制无人机重新调整位姿，直至充电线路重新闭合继续充电。
[0022]
具体工作过程为：
[0023]
首先，当四旋翼无人机停靠在起降凸台上进行自主充电时，通信模块输出“请求充电”的高电平信号，通过数字引脚d2传输到控制模块的主控板uno；
[0024]
然后，主控板uno计算从引脚a0和a1读入的小电阻r1两端的电压差值，判断该值是否为0，如果是，说明母头和公头接触不良或是反接，则从数字引脚d1口向通信模块发送“无接触”的低电平信号，指示无人机重新调整位姿；否则，电压差值不为0，说明母头和公头接触良好且无反接，即无人机的锂电池已经接入充电电路中，则开始充电；同时，uno通过引脚d0向电磁铁阵列模块发送“通电”信号，电磁铁阵列牢牢吸附无人机。
[0025]
当无人机充电完成或是人为中断充电，通信模块发送“停止充电”低电平信号，通过数字引脚d2传输到主控板uno；uno通过引脚d0向电磁铁阵列模块发送“断电”信号，电磁铁阵列停止工作。等待电磁铁阵列模块去磁后，主控板uno通过引脚d1向通信模块发送“可以起飞”信号，则无人机自由起降。
[0026]
本发明具有以下优点：
[0027]
1)、一种车载式无人机自主充电平台，车顶机库以车载行李箱为基础，具有模块化特点，可搭载于多种车型，通用性强，可实现快速机动部署。
[0028]
2)、一种车载式无人机自主充电平台，充电接口装置具有特殊的外形和电极分区设计，降低了对无人机位姿精准度的要求，降低了充电装置对接条件的苛刻性，提高了自主降落的鲁棒性和成功率。
[0029]
3)、一种车载式无人机自主充电平台，充电装置相比于无线式而言充电效率更高；
相比于接触插拔式而言体积小，避免了复杂机构，对接动作简单，可靠性高，使用寿命长。
[0030]
4)、一种车载式无人机自主充电平台，充电电路的设计可以防止正负极反接，提高了充电过程的安全性。
[0031]
5)、一种车载式无人机自主充电平台，充电电路的设计可实现对充电状态的实时监测，可自主判断充电异常并使无人机重新调整位姿，直至充电线路重新闭合，提高了自主充电的成功率和智能化水平。
[0032]
6)、一种车载式无人机自主充电平台，采用的无人机控制算法基于四旋翼系统的非线性模型，避免了常规方法局部线性近似化带来的误差，解决了大姿态角的控制问题。
[0033]
7)、一种车载式无人机自主充电平台，无人机控制算法充分引入了外界的干扰外力和干扰外力矩，具有较强的抗干扰能力，使得无人机能适应降落时的复杂外界环境。
附图说明
[0034]
图1为本发明一种车载式无人机自主充电平台的结构示意图；
[0035]
图2为本发明车载式无人机自主充电平台采用的起降凸台示意图；
[0036]
图3为本发明车载式无人机自主充电平台采用的起降凸台的俯视图；
[0037]
图4为本发明车载式无人机自主充电平台采用的充电装置公头的示意图；
[0038]
图5为本发明车载式无人机自主充电平台采用的充电装置母头的示意图；
[0039]
图6为本发明车载式自主充电平台采用的电路系统原理图；
[0040]
图7为本发明车载式自主充电平台的电路中控制模块的工作流程图；
[0041]
图8为本发明搭建的四旋翼的动力学模型示意图。
具体实施方式
[0042]
下面将结合附图和实施示例对本发明作进一步的详细说明。
[0043]
本发明为一种车载式无人机自主充电平台，如图1所示，包括车顶机库1、起降凸台4、充电接口装置5和四旋翼无人机3；
[0044]
车顶机库1内部安装有起降凸台4和蓄电池2，蓄电池2为起降凸台4提供电源；起降凸台4顶部和无人机3底部分别布置充电接口装置的公头5
‑
1和母头5
‑
2，且公母头外形轮廓完全匹配，使得二者可以紧密接触，保证四旋翼无人机3停靠在起降凸台4上进行自主充电的可靠性。车顶机库底板1
‑
3中布置有电气和数据线路，并配有相应接口与车内连接。
[0045]
该车顶机库1以车顶行李箱为基础，其顶盖分为前1
‑
2和后1
‑
1两个部分，分别采用“旋转式”和“拉滑式”启闭，如图1所示。前顶盖1
‑
2采用“旋转式”开启，直至与底板1
‑
3垂直，为无人机阻挡车顶紊乱的气流，改善气动环境，减小风场对无人机的干扰。后顶盖1
‑
1采用“拉滑式”开启，不遮挡无人机飞行空间和摄像头视线，有利于无人机的飞行和降落时的视觉识别。
[0046]
该车顶机库1可安装在各种车辆顶部，在不使用时可拆卸，具有模块化的特点。车顶机库分为关闭和开启两种状态，当无人机在停放在其中充电时，机库关闭；当无人机起降时，机库开启。
[0047]
当四旋翼无人机3停靠在起降凸台4上进行自主充电；充电接口装置5采取倒锥形，当无人机3自主降落时，若位置稍偏离起降凸台4正上方，无人机3上的公头5
‑
1也能依靠重
力沿着母头5
‑
2的锥壁滑入正中心，降低了对位置精准度的要求，提高了容错性。充电接口装置5的锥尖处安装有橡胶缓冲垫，降低公母头对接时的冲撞力。
[0048]
如图2所示，起降凸台4的外轮廓与无人机支腿3
‑
1的内轮廓一致，没有缝隙，保证无人机3能牢固停靠在起降凸台4上。起降凸台4底部设有环形凹槽4
‑
1，使得无人机支腿3
‑
1能够在其中卡住，进一步固定无人机支腿的位置。
[0049]
如图3所示，环形凹槽4
‑
1下布置有电磁铁阵列4
‑
2(图3中只标出了一个)，可以与无人机支腿3
‑
1上的铁片牢靠贴合，保证了公母头5
‑
1、5
‑
2充分接触。防止由于车辆颠簸，无人机3脱离起降凸台4。电磁铁4
‑
2采用断电有磁型，当无人机停靠时无需通电便有磁性，当无人机起飞时通电磁性消失，减少了功耗损失。
[0050]
如图3所示，起降凸台4顶部布置有图像识别的特征标志物4
‑
3，用于引导无人机末端视觉导航定位。无人机的机载摄像头拍摄到特征标志物后，经过机器视觉算法判断与起降凸台的相对位置和姿态，引导其对准正中心降落。
[0051]
如图4和图5所示，充电接口采取了特殊的分区导电设计；正极区和负极区对称分布，且各自有导电和绝缘区域；其中公头的正(负)极区有45
°
导电，其余部分绝缘，母头的导电(绝缘)区域与之互补。母头的正(负)极区有135
°
导电、45
°
绝缘，公头的导电(绝缘)区域与之互补。公头的正(负)极和母头的正(负)极只要存在接触区域便可充电，这使得当无人机具有了顺逆90
°
的角度冗余，降低了对接条件的苛刻性，大大提高了容错性。
[0052]
为提高自主充电过程的安全性和智能化水平，设计了电路系统，如图6所示，包括电源模块、通信模块、电磁铁阵列模块、控制模块和无人机
‑
锂电池负载；
[0053]
电源模块提供4.2v直流电压为无人机锂电池充电，同时提供5v直流电压为控制模块、通信模块和电磁阵列模块供电。电源模块输入端为12v蓄电池，首先经过lm2596 dc
‑
dc变压模块，输出 5v直流电压；然后经过tp4560锂电池充电模块，输出4.2v直流电压、最大1a的充电电流。
[0054]
通信模块是控制模块和四旋翼无人机的通信中介；
[0055]
控制模块根据四旋翼无人机的充电情况，控制电磁阵列(电磁铁额定电压 5v)的通断。无人机在起降平台上充电时，电磁阵列模块通电；无人机从起降平台起飞时，电磁阵列模块断电。
[0056]
为防止正负极反接，在锂电池的正极充电支路接入一个二极管。当锂电池与充电装置正确连接时，此时二极管正偏，锂电池正常充电；当锂电池与充电装置反接时，此时二极管反偏，充电电路断开，避免正负反接。
[0057]
如图6所示，所述控制模块以arduino uno为主控板，uno的引脚gnd接电源模块5v直流电压的负极、引脚vin接5v直流电压的正极；模拟引脚a0和a1分别接在小电阻r1(阻值0.1ω)的两端；数字引脚d0接电磁铁阵列模块的输入正极，引脚d1接通信模块的输入端口，引脚d2接通信模块的输出端口，且uno与电磁铁阵列模块和通信模块共地。
[0058]
控制模块的工作流程如图7所示：首先，当四旋翼无人机停靠在起降凸台上进行自主充电时，通信模块输出“请求充电”的高电平信号，通过数字引脚d2传输到控制模块的主控板uno；
[0059]
然后，主控板uno计算从引脚a0和a1读入的小电阻r1两端的电压差值，判断该值是否小于10mv，如果是，说明母头和公头接触不良或是反接，则从数字引脚d1口向通信模块发
送“无接触”的低电平信号，指示无人机重新调整位姿；否则，说明母头和公头接触良好且无反接，即无人机的锂电池已经接入充电电路中，则开始充电；同时，uno通过引脚d0向电磁铁阵列模块发送“通电”信号，电磁铁阵列开始工作，牢牢吸附无人机。
[0060]
当无人机充电完成或是人为中断充电，通信模块发送“停止充电”低电平信号，通过数字引脚d2传输到主控板uno；uno通过引脚d0向电磁铁阵列模块发送“断电”信号，电磁铁阵列停止工作。延时5s，等待电磁铁阵列模块去磁后，主控板uno通过引脚d1向通信模块发送“可以起飞”信号，则无人机自由起降。
[0061]
该电路可实现对充电状态的实时监测：四旋翼无人机充电时，控制器每隔0.1s测量小电阻两端的电压，间接获得充电电路的通断信息，如果充电电路断开(比如充电装置接触不良、反接)，控制器控制通信模块指示无人机重新调整位姿，直至充电线路重新闭合，无人机继续充电。
[0062]
对于四旋翼无人机而言，其控制器设计多基于动力学模型的局部线性近似化。而在四旋翼无人机追踪移动平台时，其姿态变化较大，不再满足线性化的条件，传统的控制器设计会带来很大误差。另外，无人机在户外飞行时会受到不规则风场的干扰，以及在降落充电的过程中可能会与充电装置产生碰撞，因此对控制器的鲁棒性和抗干扰能力提出了更高的要求。针对以上问题，本发明设计了相应的控制算法。
[0063]
(1)四旋翼的动力学建模:
[0064]
如图8所示，设定固定在地面上的惯性系为同时以四旋翼质心为坐标原点构建机体系第一条和第二条机体轴位于四个旋翼所构成的平面内，而第三条机体轴与该平面垂直，并指向下方。
[0065]
定义四旋翼的单位正交矩阵r，实现向量坐标从机体系到惯性系的变换。记四旋翼的质量和转动惯量矩阵分别为m和j，四旋翼在惯性系中的位置和速度分别是x和v，在机体系中的角速度为ω，四旋翼质心到电机的距离为d。第i个电机产生的升力大小为f
i
，产生的反作用扭矩为τ
i
且τ
i
沿着的方向，电机转速为ω
i
。四旋翼产生的合外力大小为f，合外力矩为m，其中m＝[τ
x τ
y τ
z
]
t
。四旋翼布局选取“x”型，根据四旋翼的控制分配矩阵可以得到如下关系：
[0066][0067]
其中c
t
和c
m
分别是四旋翼的升力系数和扭转系数。
[0068]
为了后面设计控制器方便，定义叉乘矩阵符号^，对于两个向量x,y，叉乘矩阵符号满足：
[0069]
[0070]
其中若x＝[x
1 x
2 x3]
t
，则
[0071]
下面给出四旋翼的动力学模型并且为了保证控制律的抗干扰性，引入外界的干扰力δ
x
和干扰力矩δ
r
。
[0072][0073][0074][0075][0076]
(2)控制器设计
[0077]
根据四旋翼动力学模型设计控制器，被控量为合外力大小f和合外力矩m。为了避免在平衡点处近似线性化带来的误差，控制器直接处理含干扰信号的非线性模型。同时整个控制器设计均在惯性系完成且不涉及欧拉角表述，可以规避大机动性情况下欧拉角带来的奇异问题；综上控制器为非线性几何控制器。
[0078]
控制器可以分为两部分，一是设计合外力矩m达到姿态镇定，二是设计合外力大小f实现位置镇定。具体如下：
[0079]
①
位置控制器设计
[0080]
设给定的光滑的理想位置信号为x
d
(t)，定义位置和速度跟踪误差为：
[0081]
e
x
＝x
‑
x
d
，
[0082]
同时定义跟踪误差的积分项
[0083][0084]
其中，c1为选取的正常数。
[0085]
定义饱和函数sat
σ
[0086][0087]
定义期望姿态以及期望角速度：
[0088]
其中，各项反馈系数均为正数；k
x
为位置跟踪误差的反馈系数；e
x
为位置跟踪误差；k
v
为速度跟踪误差的反馈系数；e
v
为速度跟踪误差；k
i
为跟踪误差的反馈系数；e
i
为跟踪误差的积分项；为理想位置信号的二阶导数；
[0089]
对于b
1c
，为了保证期望姿态的朝向和期望运动轨迹方向相同，取
[0090]
设计位置控制器
[0091]
下面为参数选取部分：
[0092]
记ψ(r(0),r
c
(0))＜ψ1＜1,||e
x
(0)||＜e
max
，||δ
x
||≤δ
x
。
[0093]
参数选取满足以下条件即可：
[0094]
(1)k
i
σ＞δ
x
[0095]
记记
[0096]
参数需满足其中λ
m
表示矩阵特征值的最小值。
[0097]
②
姿态控制器
[0098]
首先定义姿态跟踪误差如下：
[0099][0100][0101]
其中，∨是叉乘矩阵符号∧的逆变换：
[0102]
e
ω
＝ω
‑
r
t
r
d
ω
d
[0103]
定义姿态跟踪误差的积分项：
[0104][0105]
设计姿态控制器：
[0106][0107]
其中各控制参数均为正数，且满足一下条件：
[0108]
记||(2j
‑
tr[j]i)||||ω
d
||＜b2[0109]
则参数满足：
[0110]
其中λ
m
表示矩阵特征值的最小值,λ
m
表示矩阵特征值的最大值。
[0111]
该车载式无人机自主充电平台的具体工作流程如下：
[0112]
(1)跟踪阶段
[0113]
在跟踪阶段，无人机距离起降凸台较远，采用gps导航。无人机与充电平台所在车
辆建立通讯，告知驾驶员适当降低车速并保持匀速直线行驶；同时获取车辆的gps信息，结合自身的gps信息计算出相对速度和方位，并控制速度差，向充电平台靠近。
[0114]
(2)视觉搜索阶段
[0115]
当无人机抵达充电平台附近时，车顶机库打开，机载摄像头进入视觉搜索状态，搜索起降凸台上的特征图案。当无人机识别到特征图案后，通过机器视觉算法调整与起降凸台的相对位置和姿态，对准其正中央。
[0116]
(3)降落阶段
[0117]
最后，无人机开始缓慢下降，并不断根据机器视觉算法调节姿态，使得充电接口公母头的正负极对准。同时，环形凹槽中的电磁铁也进一步拖拽引导无人机支腿至正确位置。降落成功后，无人机开始充电，车顶机库顶盖关闭。