CN103778523B - 一种垂直起降无人机及其精确定位及避障方法 - Google Patents

Abstract

本发明属于无人机技术领域，具体为一种用于物流的垂直起降无人机，包括具有旋翼的机身，所述机身的左前部和右前部分别设有指向无人机前方偏下的摄像头，两摄像头间距为定值且光轴平行，摄像头与收货人配备的可调制光信号的强光源相配合；所述机身的前方设置光电传感器；所述机身的上下及四周设置距离传感器；无人机与服务器通过移动通信网络进行无线通信。并提供无人机精确定位及避障方法，尤其适合垂直起降式无人机，能自主避障，其作业精确安全。

Description

一种垂直起降无人机及其精确定位及避障方法

技术领域

本发明属于无人机技术领域，具体为一种用于物流的垂直起降无人机及其精确定位及避障方法。

背景技术

在部分偏远地区，快件带来的收益难以抹平网点建设、维持所消耗的资金，这是目前物流业内所共识的。而采用“无人机”进行运送能有效提高配送效率，减少人力、运力成本，尤其是垂直起降（VTOL，Vertical Take-Off and Landing）无人机可以满足面向收件用户的快递投递业务和面向小型快件集散点的物流业务的实际需求。因此将垂直起降无人机应用于物流配送是物流业的一个很好的发展方向。

通常，使用VTOL垂直起降无人机进行物流业务有一个难以解决的问题，即：复杂环境下物流无人机和收货对象间的定位问题和避障问题。无人机运输快件的理想情况应是由无人机将快件送入收货对象手中，这一过程需要的定位精度至少在分米级别。而卫星定位精度则通常无法达到此要求：使用差分定位***会导致终端成本上升数百倍，且由于定位信号反射，在高楼林立的城市中，无法保证定位效果；使用常规的卫星定位会导致定位精度不足（理想状态通常为2m精度），在高楼较多的地点，由于卫星信号被高楼反射，定位精度会进一步下降。受限于以上情况，为了保证无人机物流业务的安全性，其货物投放地点只能是某个开阔地带，且无法执行签收操作，不能解决无人机物流的“最后十米”的问题，增加了收货对象的收货难度，从而导致物流无人机的实用性大打折扣。另外，由于收货人的位置并不固定，所处环境也各有不同，所以在这个完整的物流过程中还需要对收货人进行精确定位并避开附近的障碍物，而使用卫星定位无法达到该要求。

发明内容

本发明的目的在于克服上述不足，提供一种用于物流的无人机的精确定位及避障方法，该方法可用于垂直起降（VTOL）物流无人机。

为实现上述技术目的，本发明提供的方案是：一种垂直起降无人机，包括具有旋翼的机身，所述机身的左前部和右前部分别设有指向无人机前方偏下的摄像头，两摄像头间距为定值且光轴平行，摄像头与收货人配备的可调制光信号的强光源相配合；所述机身的前方设置光电传感器；所述机身的上下及四周设置距离传感器；无人机与服务器通过移动通信网络进行无线通信。

本发明还提供一种用于上述垂直起降无人机的精确定位及避障方法，包括如下步骤。

步骤一、服务器获取收货地点坐标，依据此坐标获取目标空域坐标及方向参数，使该参数对应位置处于收货地点视线范围内，方向基本朝向收货地点，高度必须高于周边建筑物高度。

步骤二、服务器将目标空域坐标及方向参数添加至无人机任务计划列表并令无人机执行飞行任务。

步骤三、无人机飞抵对应空域坐标后向服务器报告已到达目标空域，并开始搜索光信号，同时开始计时，若在货品被确认签收之前计时超出预设值，则跳至步骤十二。

步骤四、服务器收到无人机到达目标空域坐标的报告后通过网络通信告知收货对象。

步骤五、收货对象使用可调制光信号不断照射空中无人机，该光信号中包括收货方身份信息、货单信息和校验信息，并可酌情对信号进行加密。

步骤六、无人机利用两个摄像头感应光点，若没有搜索到光点则持续搜索；若搜索到光点则根据搜索到的各个光点在各个摄像头画面的位置计算光点相对于摄像头的横向及纵向角度，再根据两个摄像头的间距计算出有效高亮点数量及各个有效高亮点与各个摄像头的距离及方向。

步骤七、根据上一步骤中所得信息、摄像头俯角及摄像头与光电传感器相对位置信息，无人机获取各个光点相对于光电传感器的方向数据，根据此方向数据控制光电传感器的俯仰和转向轴使光电传感器指向目标光点，并对目标光点进行信息验证，若验证成功则对这个光点保持追踪，若验证失败则对下一个光点进行信息验证。

步骤八、无人机将验证成功后的光点设定为目标点，并为该目标点建立三轴空间坐标系，该空间坐标系中一个轴垂直于水平面，然后根据步骤六和步骤七中所得目标点相对于摄像头的方位及距离、摄像头俯角、摄像头安装位置以及无人机俯仰、横滚、方向数据可得目标点与无人机相对方位。

步骤九、根据上一步骤中所得数据，无人机的水平朝向始终指向目标点，靠近目标点，并根据距离传感器数据使用侧移和上升下降来与周围的障碍物尽量保持安全距离，但不能低于极限距离，若在无人机接近目标点的过程中光信号中断，则跳至步骤十二。

步骤十、当无人机与目标点的距离小于安全距离时，利用声光电或通信的方式提示收货对象接收货品。

步骤十一、收货对象使用光信号或网络通信进行电子签收，无人机确认到签收请求后解除货品的锁定，收货对象拾取货品，无人机通过光电传感器感知货品被拾取后通过网络通信向服务器确认货品签收成功，服务器存储电子签收单据并向收货对象抄送；若签收流程未完成，且计时没有超出预设值则返回步骤四。

步骤十二、无人机根据距离传感器远离各个方向的障碍物至安全距离，然后提升高度至与目标空域坐标等高，再飞往目标空域坐标。

步骤十三、完成任务后，无人机返航至无人机基地进行维护。

而且，所述步骤十一中的电子签收是收货人通过可调制光信号的强光源向无人机发射光信号进行签收，或，收货人通过网络通信对服务器进行签收，服务器再将签收信息通过移动通信网络反馈给无人机，完成电子签收动作。

本发明的有益效果是：提供了一种无人机进行物流运输的方式，尤其适合垂直起降式无人机，能自主避障，其作业精确安全，可行性高、便于实施。

附图说明

图1是本发明中无人机的构建框图。

图2是本发明中摄像头的工作示意图。

图3是本发明的方法流程图。

具体实施方式

下面结合实施例对本发明作进一步说明。

本实施例提供的一种垂直起降无人机，如图1和图2所示，包括具有旋翼的机身，所述机身的左前部和右前部分别设有指向无人机前方偏下的摄像头，两摄像头的光轴平行且间距为定值；所述机身的前方设置光电传感器；所述机身的上下及四周设置距离传感器；收货人配备可调制光信号的强光源与无人机的摄像头相配合；无人机与服务器通过手机信号网进行无线通信。

上述收货人所配备的可调制光信号的强光源，既能帮助引导定位又能通信，且强光源易于获取，例如，具有闪光灯的智能手机即可。

本实施例还提供一种用于上述垂直起降无人机的精确定位及避障方法，为方便说明本发明的方法步骤，需要预先假设如下参量：

1.假设无人机中心为坐标原点，无人机正前水平方向为正y轴，无人机正右水平方向为正x轴，垂直于水平面向上的方向为正z轴；

2.假设无人机处于水平状态时左右两个摄像头的坐标分别为和，即间距为，指向方向为正前向下偏弧度，；

3.假设无人机处于水平状态时光电传感器安装位置为；

4.设无人机实时俯角为，实时右滚角为，，；

5.假设无人机有个距离传感器均匀分布在其周围，每个距离传感器的指向方向都用单位向量表示，可得向量数组，其中包含个单位向量，依次与各距离传感器指向方向对应；

6.假设“较远距离”、“安全距离”、“极限距离”分别为、和，其中；

7.假设计时器时间，超时时间为。

本实施例提供一种用于物流的无人机的精确定位及避障方法在应用的过程中，如图3，具体包括以下步骤。

步骤1：服务器获取收货地点信息，但不能直接让物流无人机飞往该地点，以免因卫星定位精度劣化或障碍物导致无人机出现事故。依据此坐标获取目标空域坐标及方向参数，使该参数对应位置处于收货地点视线范围内，方向基本朝向收货地点，高度必须高于周边建筑物高度。由于该参数的要求较为宽松，参数数值也较易于设置。该步骤旨在无人机切换至使用本发明提供的精确定位方法前处于一个上方开阔无遮挡的环境，以免卫星定位精度大幅下降。

步骤2：服务器将目标空域坐标及方向参数添加至无人机任务计划列表并令无人机执行任务。

步骤3：无人机到达对应空域坐标后向服务器报告已到达目标空域坐标，完成头部朝向调整，然后开始搜索光信号，同时计时器开始计时，在无人机感知货品被拾取之前，即，则跳至步骤12。

步骤4：服务器收到无人机到达目标空域坐标的报告后通过网络通信告知收货对象。

步骤5： 收货对象使用光信号不断照射空中无人机，光信号中包括但不仅限于收货方身份信息、货单信息和校验信息，并可酌情对信号进行加密。

步骤6： 无人机利用两个摄像头感应光点，若没有搜索到高亮点则持续搜索；若搜索到光点则根据搜索到的各个光点在各个摄像头画面的位置计算光点相对于摄像头的横向及纵向角度，再根据两个摄像头的间距计算出有效高亮点数量及各个有效高亮点与各个摄像头的距离及方向。

摄像头像素坐标为正中心为原点，正x轴向右，正y轴向上，正z轴为正前方，建立基于摄像头的坐标系，左右两个摄像头对应的坐标系分别为和。根据摄像头厂家数据，每个像素都有与其对应的相对于摄像头的横向及纵向角度，设定横向偏右为正，设定纵向偏上为正，有像素点与像素点对应单位方向向量的映射函数（该映射函数也可自行测取）：

，

满足条件：

，

由于摄像头只能从前方进光，还满足条件：

。

可得像素点对应的方向向量为（专用于表述方向参数的单位向量）：

其中，光点判定可通过RGB阈值检测像素颜色来简单判定，有摄像头实时画面各像素色彩成分为：

RGB阈值分别为：、、。

当同时满足：

则判定为光点的像素点。

符合条件的像素如果相邻则可合并为一个光点处理，光点坐标采用其所包含的像素点坐标的加权平均值，可得左摄像头获取的光点坐标数组：

… …

，右摄像头获取的光点坐标数组：

… …

。

然后将光点坐标代入：

，

可得左摄像头中光点相对于左摄像头方位向量数组：

… …

，

右摄像头中光点相对于左摄像头方位向量数组：

… …

。

实际的光点会分别在左右两个摄像头中成像，将左右两摄像头中光点配对可得实际光点、实际光点在左摄像头中的成像、实际光点在右摄像头中的成像的对应关系。中每个元素均与中每个元素尝试匹配，假设被匹配的左右摄像头对应的两个元素依次为和，匹配条件为：

且：。

再设常量和，存在：

，

即：

，

有：

，可得实际光点与左右两个摄像头的距离及方向表述为向量分别为：

和

步骤7：以无人机右方为正x轴，前方为正y轴，上方为正z轴建立基于无人机的坐标系。将步骤6中最后得到的实际光点分别与左右两个摄像头的方位向量由和坐标系变换至坐标系，变换方程为：

即：

。

光电传感器至左（右）摄像头的方位向量为（），左（右）摄像头至实际光点的基于（）坐标系的方位向量经上方变换方程可转换为基于坐标系的向量值，两者相加可得光电传感器至实际光点的方位向量，进而可获得各个实际光点相对于光电传感器的方位向量，设所得方位向量集合为方位向量数组：

… …

根据向量表示的方向控制光电传感器的俯仰和转向轴使光电传感器依次指向实际光点并对光点进行信息验证，若验证成功则对这个光点保持追踪，若验证失败则对下一个实际光点进行信息验证，直至获取目标光点。

步骤8： 无人机验证光点信息成功后将此光点设定为目标点（即步骤7中向量数组中的一个元素，设其为），建立三轴空间坐标系，无人机中心作为坐标系原点，坐标系x、y轴与地平面平行，正y轴与无人机正前方向对应。将与无人机俯仰、横滚角度数据结合运算可得目标光点与无人机相对方位向量（基于水平面的立体坐标系），具体方法为对依次进行俯仰和横滚坐标变换（坐标变换顺序可颠倒）。俯仰变换方程：

即：

和横滚变换方程：

即：

，

将代入俯仰变换方程，所得结果再代入横滚变换方程就可得到。

步骤9：根据步骤8中（在此步骤中数据被不断实时更新），使无人机的水平朝向始终指向目标点，然后靠近目标点，并根据距离传感器数据使用侧移和上升下降来与周围的障碍物尽量保持安全距离，但不能低于极限距离。

设数组，含：

… …

，

依次对应各距离传感器所测障碍物距离的实时值。

设无人机移动向量，，指向方位表示无人机移动方向，与无人机移动力度相关，的计算方法如下：

当数组中所有元素均大于时有：

，

当数组中存在元素小于，且所有元素均大于时有：

当数组中存在小于的元素时有：

另外，在无人机接近目标点的过程中如果光信号中断，则立即进入步骤12。

步骤10：当无人机与目标点的距离小于安全距离时，即，利用声光电或通信的方式提示收货对象接收货品。

步骤11：收货对象使用光信号或网络通信进行电子签收，无人机确认到签收请求并解除货品的锁定，收货对象拾取货品，无人机感知货品被拾取后通过网络通信向服务器确认货品签收成功，服务器存储电子签收单据并向收货对象抄送；也可以由收货人通过网络通信对服务器进行签收，服务器再将签收信息通过移动通信网络反馈给无人机，完成电子签收动作。若签收流程未完成，且计时没有超出预设值则返回步骤4。

步骤12：无人机根据距离传感器远离各个方向的障碍物至较远距离，参考步骤9中内容有：

当：

时，有：

否则有：

。待无人机高度约等于下一个目标空域坐标高度，再飞往下一个目标空域坐标。

步骤13：完成所有任务后，无人机返航至无人机基地进行维护。

以上所述仅是本发明的优选实施方式，应当指出，对于本技术领域的普通技术人员来说，在不脱离本发明原理的前提下，还可以做出若干改进或变形，这些改进或变形也应视为本发明的保护范围。

Claims (3)

1.一种垂直起降无人机的精确定位及避障方法，包括如下步骤：

步骤一、服务器获取收货地点坐标，依据此坐标获取目标空域坐标及方向参数，使该参数对应位置处于收货地点视线范围内，方向朝向收货地点，高度必须高于周边建筑物高度；

步骤二、服务器将目标空域坐标及方向参数添加至无人机任务计划列表并令无人机执行飞行任务；

步骤三、无人机飞抵对应空域坐标后向服务器报告已到达目标空域，并开始搜索光信号，同时开始计时，若在货品被确认签收之前计时超出预设值，则跳至步骤十二；

步骤四、服务器收到无人机到达目标空域坐标的报告后通过网络通信告知收货对象；

步骤五、收货对象使用可调制光信号不断照射空中无人机，该光信号中包括收货方身份信息、货单信息和校验信息；

步骤六、无人机利用两个摄像头感应光点，若没有搜索到光点则持续搜索；若搜索到光点则根据搜索到的各个光点在各个摄像头画面的位置计算光点相对于摄像头的横向及纵向角度，再根据两个摄像头的间距计算出有效高亮点数量及各个有效高亮点与各个摄像头的距离及方向；

步骤七、根据步骤六得到各个有效高亮点与各个摄像头的距离及方向信息、摄像头俯角及摄像头与光电传感器相对位置信息，无人机获取各个光点相对于光电传感器的方向数据，根据此方向数据控制光电传感器的俯仰和转向轴使光电传感器指向目标光点，并对目标光点进行信息验证，若验证成功则对这个光点保持追踪，若验证失败则对下一个光点进行信息验证；

步骤八、无人机将验证成功后的光点设定为目标点，并为该目标点建立三轴空间坐标系，该空间坐标系中一个轴垂直于水平面，然后根据步骤六和步骤七中所得目标点相对于摄像头的方位及距离、摄像头俯角、摄像头安装位置以及无人机俯仰、横滚、方向数据可得目标点与无人机相对方位；

步骤九、根据上一步骤中所得数据，无人机的水平朝向始终指向目标点，靠近目标点，并根据距离传感器数据使用侧移和上升下降来与周围的障碍物尽量保持安全距离，但不能低于极限距离，若在无人机接近目标点的过程中光信号中断，则跳至步骤十二；

步骤十、当无人机与目标点的距离小于安全距离时，利用声光电或通信的方式提示收货对象接收货品；

步骤十一、收货对象使用光信号或网络通信进行电子签收，无人机确认到签收请求后解除货品的锁定，收货对象拾取货品，无人机通过光电传感器感知货品被拾取后通过网络通信向服务器确认货品签收成功，服务器存储电子签收单据并向收货对象抄送；若签收流程未完成，且计时没有超出预设值则返回步骤四；

步骤十二、无人机根据距离传感器远离各个方向的障碍物至安全距离，然后提升高度至与目标空域坐标等高，再飞往目标空域坐标；

步骤十三、完成任务后，无人机返航至无人机基地进行维护。

2.根据权利要求1所述的垂直起降无人机的精确定位及避障方法，其特征在于：所述步骤十一中的电子签收是收货人通过可调制光信号的强光源向无人机发射光信号进行签收，或，收货人通过网络通信对服务器进行签收，服务器再将签收信息通过移动通信网络反馈给无人机，完成电子签收动作。

3.根据权利要求1所述的垂直起降无人机的精确定位及避障方法，其特征在于：所述垂直起降无人机包括具有旋翼的机身，所述机身的左前部和右前部分别设有指向无人机前方偏下的摄像头，两摄像头间距为定值且光轴平行，摄像头与收货人配备的可调制光信号的强光源相配合；所述机身的前方设置光电传感器；所述机身的上下及四周设置距离传感器；无人机与服务器通过移动通信网络进行无线通信。