一种用于植保无人机综合作业的挂车及无人机定位回收方法
【专利摘要】本发明公开了一种用于植保无人机综合作业的挂车，包括：底盘系统用于承重及运载无人机；起降平台，其包括设置在挂车侧面的挂车厢和车顶厢板，所述挂车厢板能够向左右展开；集成药箱及吸供水系统，其设置在挂车内部，其用于配比药液和向植保飞机携带药箱内自动填充药液；集成发电及充电系统，其设置在挂车内部；无人机引导回收装置，其设置在挂车车顶厢板位置，具有起降平台、药箱补给系统、充电系统和维修设备，能够完成多种综合作业，节约了运输成本，还提供了一种用于植保无人机的定位回收方法，能够将无人机自动回收至作业挂车。
【专利说明】
一种用于植保无人机综合作业的挂车及无人机定位回收方法
技术领域
[0001] 本发明涉及农业植保无人机领域，尤其涉及一种用于植保无人机综合作业的挂车 和一种无人机定位回收方法。
【背景技术】
[0002] 植保无人机已广泛应用于农林植物保护作业，小型无人飞机有飞行平台GPS飞控、 喷洒机构三部分组成，通过地面遥控或GPS飞控，来实现喷洒作业，可以喷洒药剂、种子、粉 剂等，但目前仍存在以下问题:一、运输不便。由于植保作业点零散，植保无人机需要频繁的 转场作业。虽然目前植保无人机大多采用折叠方式缩小了运输尺寸，但使用小型车辆仍难 以运输，如使用厢式货车运输，增加了运营成本;二、现场作业不便，植保无人机在作业现场 需要配制药水、选择起降场地、更换电池等，目前仍处于较为原始的状态，降低了作业效率； 三、充电及维护保养不便，植保无人机高度依赖电池供应，由于电池成本较高，不能靠增加 电池数量提高植保无人机飞行架次，只能立足于现场发电，快速充电提高作业效率。但另行 携带发电机、汽油等，展开不便，耗时较长。另植保无人机在作业过程中，需要检修等工作， 也造成了喷洒效率的降低，因此急需一种无人机综合喷洒作业平台，能够解决上述问题。
【发明内容】
[0003] 本发明设计开发了一种用于植保无人机综合作业的挂车，具有起降平台、药箱补 给系统、充电系统和维修设备，能够完成多种综合作业。
[0004] 本发明还有一个目的是在箱式挂车上加装设备，厢板展开作为起降平台、即解决 了运输问题，又节约了运输成本，同时降低了维护难度。
[0005] 本发明得另一个目的是提供一种植保无人机定位回收方法，基于最小二乘法的迭 代匹配定位算法，减小了无人机位置检测过程中引入的误差，实现了无人机与挂车间的精 准定位，同时环境风速和风向调整无人机的降落伞开伞位置，能够将无人机自动回收至作 业挂车。
[0006] 本发明提供的技术方案为：
[0007] -种用于植保无人机综合作业的挂车，包括：
[0008] 底盘系统，用于承重及运载无人机；
[0009] 起降平台，其包括设置在挂车侧面的挂车厢板和车顶厢板，所述挂车厢板能够向 左右展开；
[0010]集成药箱及吸供水系统，其设置在挂车内部，其用于配比药液和向植保飞机携带 药箱内自动填充药液；
[0011]集成发电及充电系统，其设置在挂车内部，用于对挂车内全车供电及植保飞机内 置电池充电；
[0012]无人机引导回收装置，其设置在挂车车顶厢板位置，用于植保无人机回收的定位 和引导。
[0013] 优选的是，所述底盘系统，包括：
[0014] 主轴，其选用普通小型汽车车轴，通用性好；
[0015] 纵向主承重梁，其为方形钢管，数量为两个，设置在所述主轴之间，用于承载车身 重量；
[0016] 牵引销，其设置在挂车前端，能够选择性连接球头牵引钩或普通环状牵引钩。
[0017] 优选的是，还包括灯光及信号系统，包括：
[0018] 车尾灯，其设置在挂车尾部，便于光照条件不良时的作业
[0019] 反光条，其设置在挂车四周，用于夜间作业时，标记挂车轮廓。
[0020] 优选的是，所述集成发电及充电系统，包括：
[0021] 发电机，其设置在挂车体前端，采用汽油发电机组，并具有电启动功能；
[0022] 供电系统，其连接所述发电机，用于启动发电机以及全车供电；
[0023]配电箱，其用于放置所述发电机及供电系统，用来分配电力能源。
[0024]优选的是，所述集成药箱及吸供水系统，包括：
[0025]药箱，其设置在挂车车体前部，容量为100L-200L;
[0026] 双向水栗，其设置在所述药箱内部，用于将外部药水吸入药箱内，并能够将药箱内 药液栗入植保无人机药箱中；
[0027] 过滤系统，其设置在所述药箱底部，用于过滤药液中杂质，防止堵塞植保无人机喷 洒系统。
[0028] 优选的是，所述无人机回收定位装置，包括：
[0029] 引降信号灯，其数量为三个以上，设置在所述车厢板的顶部，能够发射光信号，用 于标记所述无人机回收降落位置。
[0030] 优选的是，还包括光学追踪系统，其设置在所述无人机底部，用于检测无人机的位 姿信息，包括：
[0031] 扫描追踪装置，其包括多组透镜，能够绕安装轴旋转，并捕获所述引降信号灯发出 的光信号，进而测量所述引降信号灯与所述扫描追踪装置之间的距离，获得无人机的位置 信息；
[0032] 角度传感器，其设置在所述无人机底部，能够检测所述引降信号灯与无所述人机 前进方向上的夹角。
[0033] 本发明的目的还可以进一步由一种植保无人机定位回收方法实现，包括以下步 骤：
[0034] 步骤一、通过所述光学追踪系统检测无人机与预定停靠地点的位置信息和方位 角、并通过风力传感器检测环境风速及风向；
[0035]步骤二、采用基于最小二乘法的迭代匹配定位算法，修正所述步骤一中光学追踪 系统引入的误差，进而获得无人机位姿信息的优化值；
[0036] 步骤三、根据环境风速和风向和预设的无人机降落航迹，调整无人机降落伞开伞 位置。
[0037] 优选的是，所述的基于最小二乘法的迭代定位算法，包括：
[0038] 步骤A.根据检测到的位置信息和方位角列出矩阵方程，并采用最小二乘法进行求 解，求解后矩阵方程为：
[0039] χ=(Ατ · A)-1 · At · B
[0040] 其中，Α，Β为关于无人机与引降信号灯之间距离的可测常数矩阵
为对t时刻无人机横坐标校正因数，
为t时刻无人机纵坐标校正因数，
[0041 ]步骤B.将无人机初始悬停位置横坐标< =X,.,无人机初始悬停位置纵坐标=>·" 带入步骤A中矩阵方程，产生迭代，当I I (SXrt，Syrt) I I <ε时停止迭代，即可得出无人机的位 置坐标(XrtJrt);
[0042]其中，ε为常数；
[0043] 步骤C.计算无人机与预定停靠地点的方位角，即无人机的姿态
[0044]
[0045] 其中，yrt为坐标系中第i个引降信号灯位置坐标与无人机位置坐标之差(yi-yrt, X1-Xrt)同X轴所成夹角，Φ i为无人机与第i个引降信号灯的方位角。
[0046] 优选的是，所述步骤三中，所述无人机的开伞位置为：
[0047]
[0048]其中，Lth为无人机回收的预设高度，m为无人机质量，g为重力加速度，c为空气阻力 系数，P为空气密度，s为降落伞迎风面积，V为风与无人机的相对速度，ω为风向，CF为常数。
[0049] 本发明所述的有益效果
[0050] 1.本发明设计开发了一种用于植保无人机综合作业的挂车，具有起降平台、药箱 补给系统、充电系统和维修设备，能够完成多种综合作业，植保无人机在作业现场能够配制 药水、以挂车作为起降场地、充电等，提高了作业效率。
[0051] 2、本发明是在箱式挂车上加装设备，厢板展开作为起降平台、满足了植保无人机 需要频繁的转场作业的需求，同时在运输过程中无需折叠无人机，使用挂车运输，解决了运 输问题，又节约了运输成本，同时降低了维护难度。
[0052] 3、本发明得提供的一种植保无人机定位回收方法，基于最小二乘法的迭代匹配定 位算法，减小了无人机位置检测过程中引入的误差，实现了无人机与挂车间的精准定位，同 时环境风速和风向调整无人机的降落伞开伞位置，实现了无人机和作业挂车之间的自动回 收。
【附图说明】
[0053]图1为本发明所述的用于植保无人机综合作业的挂车的结构示意图。
【具体实施方式】
[0054]下面结合附图对本发明做进一步的详细说明，以令本领域技术人员参照说明书文 字能够据以实施。
[0055] 如图1所示，本发明提供的一种用于植保无人机综合作业的挂车，包括:底盘系统 100、起降平台200、集成药箱及吸供水系统300、集成发电及充电系统400和无人机引导回收 装置。
[0056] 其中，底盘系统100,用于承重及运载无人机，包括:主轴110,其选用普通小型汽车 车轴，通用性好；
[0057] 纵向主承重梁，其为方形钢管，数量为两个，设置在两个主轴110之间，能够承载车 身上500公斤以内的重量；
[0058]牵引系统130,其包括球头牵引钩和普通环状牵引钩，并能够实现二者之间的快速 更换。
[0059] 起降平台200,其包括设置在挂车侧面的挂车厢板和车顶厢板，挂车厢板能够向左 右展开，挂车厢板和车顶厢板22均采用铝合金轻质板材；
[0060] 集成药箱及吸供水系统300,其设置在挂车内部，其用于配比药液和向植保飞机携 带药箱内自动填充药液;包括：
[0061 ]药箱，其设置在挂车车体前部，容量为100L-200L;
[0062] 双向水栗，其设置在所述药箱内部，用于将外部药水吸入药箱内，并能够将药箱内 药液栗入植保无人机药箱中；
[0063] 过滤系统，其设置在所述药箱底部，用于过滤药液中杂质，防止堵塞植保无人机喷 洒系统。
[0064]集成发电及充电系统400,其设置在挂车内部，用于对挂车内全车供电及植保飞机 内置电池充电;包括：
[0065] 发电机，其设置在挂车体前端，采用汽油发电机组，并具有电启动功能；
[0066] 供电系统，其连接所述发动机，用于气动发动机以及全车供电；
[0067] 配电箱，其用于放置所述发电机及供电系统，用来分配电力能源。
[0068] 无人机引导回收装置，其设置在挂车车顶厢板位置，用于植保无人机回收的定位 和引导，包括：
[0069] 引降信号灯，其数量为三个以上，设置在车厢板的顶部，能够发射光信号，用于标 记无人机回收降落位置。
[0070] 光学追踪系统，其设置在所述无人机底部，用于检测无人机的位姿信息，包括：
[0071] 扫描追踪装置，其包括多组透镜，能够绕安装轴旋转，并捕获所述引降信号灯发出 的光信号，进而测量所述引降信号灯与所述扫描追踪装置之间的距离，获得无人机的位置 信息；
[0072] 角度传感器，其设置在所述无人机底部，能够检测所述引降信号灯与无所述人机 前进方向上的夹角。
[0073]灯光及信号系统，包括：
[0074] 车尾灯，其设置在挂车尾部，便于光照条件不良时的作业
[0075] 反光条，其设置在挂车四周，用于夜间作业时，标记挂车轮廓。
[0076] 维保系统600,包括：
[0077]工具架，其设置在挂车底部，根据维护作业中可能使用到的工具，设置工具架，所 有工具均固定于工具架的海棉内，保证运输方便。
[0078]检修台，使用车厢尾板向下打开形成，供检修使用。
[0079]植保无人机运输系统，包括：
[0080]飞机固定座，根据飞机尺寸，底部使用海棉作为飞机固定和减震座。
[0081] 飞机固定带，使用安全带固定处于折叠状态的植保无人机。
[0082] 实施以植保无人机综合作业的挂车的工作过程为例，做进一步的说明，
[0083]首先，将植保无人机综合作业的挂车通过小型车辆或拖拉机牵引到工作地点，其 中用小型车辆进行远距离牵引时，采用球头牵引钩，用拖拉机进行田间牵引时采用普通环 状牵引钩；
[0084] 然后将挂车侧面的挂车厢板和车顶厢板，展开形成无人机停降的起降平台，无人 机的药箱连接挂车内的药箱，药液通过过滤系统由双向水栗栗入药箱内，或将药液从无人 机的药箱吸入挂车内的药箱；
[0085] 无人机作业完成或需要药液补给时，首先将无人机悬停在挂车附近，通过光学追 踪系统对无人机进行定位和回收，由引降信号灯发出光信号，扫描追踪装置捕获所述引降 信号灯发出的光信号，进而测量所述引降信号灯与所述扫描追踪装置之间的距离，获得无 人机的位置信息，角度传感器，其设置在所述无人机底部，能够检测所述引降信号灯与无所 述人机前进方向上的夹角，由此确定无人机的位姿信息，环境风速和风向，修正无人机的位 置和方位角，使无人机按照预设的无人机降落航迹飞行。
[0086] -种植保无人机定位回收方法，包括：
[0087] 步骤一:令无人机在世界坐标系中的位姿(&*，5^，0^)，采用阈值匹配算法，确定 所述角度传感器观测到的多个方位角中的一个做为预定停靠地点与无人机前进方向上的 夹角;根据前一时刻位姿(Xrt-I，yrt-1，9 rt-：L)计算无人机与η个参考坐标Ii(Xi，yi) (1彡iSn) 在无人机前进方向上的夹角即方位角氏，并记录此时角度传感器观测到的方位角ai
[0088] 步骤二：当|i3j-ai I <q时，认为第i个传感器路标与第j个地图路标匹配成功，从而 得到一组有效的路标P1(Xuy 1)并且方位角为φ1;其中η为匹配阈值，其数值为0.16°
[0089] 步骤三:设相邻两路标夹角为λ?, Ki<m。令xm+i = xi，ym+i = yi，Φ??+ι= Φ ι+2π，则 有：
[0101] 式中A、B为可测常数阵，因此，可用最小二乘法求解X，得
[0102]
[0103]
[0104] 无人机初始悬停位置横坐标.<_= :?无人机初始悬停位置纵坐标= Jw带入步骤 A中矩阵方程，产生迭代。
[0105] 步骤五、当I I (Sxrt^yrt) I I <ε时停止迭代，即可得出无人机的位置坐标(Xrt，yrt);
[0106] 其中，ε为常数，根据光学追踪系统灵敏度进行设定，其数值在0.01-0.12之间。
[0107] 步骤六、计算无人机与预定停靠地点的方位角，即无人机的姿态
[0108]
[0109]其中，yrt为坐标系中第i个引降信号灯位置坐标与无人机位置坐标之差(yi-yrt, X1-Xrt)同X轴所成夹角，Φ i为无人机与第i个引降信号灯的方位角。
[0110]步骤七、确定无人机的开伞位置为：
[0111]
[0112] 其中，Lth为无人机回收的预设高度，其单位为米;m为无人机质量，其单位为千克;g 为重力加速度，其单位为m/s2; c为空气阻力系数，P为空气密度，其单位为Kg/m3; s为降落伞 迎风面积，其单位为m2v为风与无人机的相对速度，其单位为m/s，ω为风向，CJ为常数，其数 值为3.24。
[0113] 有益效果
[0114] 尽管本发明的实施方案已公开如上，但其并不仅仅限于说明书和实施方式中所列 运用，它完全可以被适用于各种适合本发明的领域，对于熟悉本领域的人员而言，可容易地 实现另外的修改，因此在不背离权利要求及等同范围所限定的一般概念下，本发明并不限 于特定的细节和这里示出与描述的图例。
【主权项】
1. 一种用于植保无人机综合作业的挂车，其特征在于，包括： 底盘系统，用于承重及运载无人机； 起降平台，其包括设置在挂车侧面的挂车厢板和车顶厢板，所述挂车厢板能够向左右 展开； 集成药箱及吸供水系统，其设置在挂车内部，其用于配比药液和向植保飞机携带药箱 内自动填充药液； 集成发电及充电系统，其设置在挂车内部，用于对挂车内全车供电及植保飞机内置电 池充电； 无人机引导回收装置，其设置在挂车车顶厢板位置，用于植保无人机回收的定位和引 导。2. 根据权利要求1所述的用于植保无人机综合作业的挂车，其特征在于，所述底盘系 统，包括： 主轴，其选用普通小型汽车车轴，通用性好； 纵向主承重梁，其为方形钢管，数量为两个，设置在所述主轴之间，用于承载车身重量； 牵引销，其设置在挂车前端，能够选择性连接球头牵引钩或普通环状牵引钩。3. 根据权利要求1或2所述的用于植保无人机综合作业的挂车，其特征在于，还包括灯 光及信号系统，包括： 车尾灯，其设置在挂车尾部，便于光照条件不良时的作业 反光条，其设置在挂车四周，用于夜间作业时，标记挂车轮廓。4. 根据权利要求3所述的用于植保无人机综合作业的挂车，其特征在于，所述集成发电 及充电系统，包括： 发电机，其设置在挂车体前端，采用汽油发电机组，并具有电启动功能； 供电系统，其连接所述发电机，用于启动发电机以及全车供电； 配电箱，其用于放置所述发电机及供电系统，用来分配电力能源。5. 根据权利要求1所述的用于植保无人机综合作业的挂车，其特征在于，所述集成药箱 及吸供水系统，包括： 药箱，其设置在挂车车体前部，容量为100L-200L; 双向水栗，其设置在所述药箱内部，用于将外部药水吸入药箱内，并能够将药箱内药液 栗入植保无人机药箱中； 过滤系统，其设置在所述药箱底部，用于过滤药液中杂质，防止堵塞植保无人机喷洒系 统。6. 根据权利要求1所述的用于植保无人机综合作业的挂车，其特征在于，所述无人机回 收定位装置，包括： 引降信号灯，其数量为三个以上，设置在所述车厢板的顶部，能够发射光信号，用于标 记所述无人机回收降落位置。7. 根据权利要求6所述的用于植保无人机综合作业的挂车，其特征在于，还包括光学追 踪系统，其设置在所述无人机底部，用于检测无人机的位姿信息，包括： 扫描追踪装置，其包括多组透镜，能够绕安装轴旋转，并捕获所述引降信号灯发出的光 信号，进而测量所述引降信号灯与所述扫描追踪装置之间的距离，获得无人机的位置信息； 角度传感器，其设置在所述无人机底部，能够检测所述引降信号灯与无所述人机前进 方向上的夹角。8. -种植保无人机定位回收方法，其特征在于，包括以下步骤： 步骤一、通过所述光学追踪系统检测无人机与预定停靠地点的位置信息和方位角、并 通过风力传感器检测环境风速及风向； 步骤二、采用基于最小二乘法的迭代匹配定位算法，修正所述步骤一中光学追踪系统 引入的误差，进而获得无人机位姿信息的优化值； 步骤三、根据环境风速和风向和预设的无人机降落航迹，调整无人机降落伞开伞位置。9. 根据权利要求8所述的植保无人机定位回收方法，其特征在于，所述的基于最小二乘 法的迭代定位算法，包括： 步骤A.根据检测到的位置信息和方位角列出矩阵方程，并采用最小二乘法进行求解， 求解后矩阵方程为：X=(AT ? A)-1 ? AT ? B 其中，A，B为关于无人机与引降信号灯之间距离的可测常数矩阵， ，心rt为对t 时刻无人机横坐标校正因数，备为t时刻无人机纵坐标校正因数， ^n=yr,-}i ； 步骤B.将无人机初始悬停位置横坐标&无人机初始悬停位置纵坐标％ = 带入 步骤A中矩阵方程，产生迭代，当| |(SXrt，Syrt)| |<e时停止迭代，即可得出无人机的位置坐 标(Xrt，yrt); 步骤C.计算无人机与预定停靠地点的方位角，即无人机的姿态其中，Y rt为坐标系中第i个引降信号灯位置坐标与无人机位置坐标之差(yi-yrt，xi-xrt)同X轴所成夹角，巾i为无人机与第i个引降信号灯的方位角。10. 根据权利要求8或9所述的植保无人机定位回收方法，其特征在于，所述步骤三中， 所述无人机的开伞位置为：其中，Lth为无人机回收的预设高度，m为无人机质量，g为重力加速度，C为空气阻力系 数，P为空气密度，s为降落伞迎风面积，v为风与无人机的相对速度，《为风向，@为常数。
【文档编号】B60P3/00GK106043086SQ201610561272
【公开日】2016年10月26日
【申请日】2016年7月15日
【发明人】贾明月, 关殿新, 代林勇, 梁东明, 段兵炜
【申请人】长春蓝天焦点科技有限公司