一种多旋翼无人机的智能道路巡检控制方法
【技术领域】
[0001] 本发明涉及高速公路智能巡检控制技术领域，适用于警用高速公路智能巡检以及 道路的自主测绘，具体涉及一种多旋翼无人机的智能道路巡检控制方法。
【背景技术】
[0002] 随着城市化进程的推进，交通安全问题日趋严重，常见的交通问题很大一部分是 由驾驶员的非法变道、超速等造成，近年来的交通监控成为预防交通事故的有效手段之一。
[0003] 现有的道路巡检大部分为采用警用巡逻车辆巡检，巡检成本高，巡检范围小，只能 得到巡逻车辆周围的交通信息。与此同时，近年来多旋翼无人机得到快速发展，多旋翼无人 机由于其结构简单、灵活多变等优势无论在军事还是民用上都得到了广泛的应用。
[0004]旋翼无人机的飞行方式主要分为两类，采用遥控器控制飞行和自主导航飞行，遥 控器控制飞行稳定性相对较高，但对操作员有一定要求，同时无人机要保证在操作员的视 野范围内，不能实现远距离飞行。自主导航的无人机大部分采用GPS导航，导航误差较大，同 时，由于多旋翼无人机由于其静不稳定、强耦合、非线性等特性，现阶段的无人机只能在简 单环境中自主飞行，设计的控制器相对没有较强的抗干扰能力及自适应能力。
【发明内容】
[0005] 为解决上述问题，本发明提出了一种多旋翼无人机的智能道路巡检控制方法，实 现无人机的道路巡航自主控制。
[0006] 本发明涉及的一种多旋翼无人机的智能道路巡检控制方法，具体实现如下：
[0007] 步骤1:通过云台控制单元控制机载云台图像传感器，使图像传感器垂直向下，图 像传感器获取得到无人机正下方图像信息。
[0008] 步骤2:通过无人机搭载的图像传感器获取路面图像信息，通过图像处理提取得到 道路中心线。
[0009] 步骤3:利用提取得到的道路中心线与无人机实际位置的偏差值进行无人机的飞 行控制。同时为了降低控制的耦合性，在设计好控制底层驱动后只进行无人机的俯仰与偏 航控制。对于俯仰控制，采用定速飞行;对于偏航控制，采用双模参数自校正模糊PID控制。
[0010] 所述的步骤2中通过图像处理提取得到道路中心线的具体步骤如下：
[0011] (1)将拍摄得到的图像从RGB颜色空间转换到HSV颜色空间。
[0012] ⑵提取Η通道图像，通过颜色区间分割道路区域。
[0013] (3)对道路区域进行形态学膨胀运算，消除道路上物体造成的空洞。
[0014] (4)提取得到道路边缘，将得到的道路边缘中心线作为目标飞行轨迹。
[0015] 所述的步骤3中偏航控制所采用的双模参数自校正模糊PID的实现步骤如下：
[0016] (1)利用提取得到的道路中心线与无人机实际位置得到横向位置偏差量值e、以及 无人机当前高度信息Η作为控制器的模式识别判决量。
[0017] (2)根据模式识别判决量e，同时根据实验标定选定一模式识别判决量阈值ethr(3l， 在误差值e>ethr(3l时应用参数自校准模糊控制，在误差值e < ethw时，应用PI控制。
[0018] (3)在误差较大时，参数自校正模糊控制器设计如下：
[0019] stepl:以道路中心线与无人机实际位置的横向偏差量e和偏差量的变化率ec作为 控制器的输入，偏航控制量u作为控制器的输出。同时设置论域的大小:输入变量偏差值e以 及偏差变化率ec的论域范围分别为：[e min，emax]、[ecmin，ecmax]，输出变量偏航控制量u的论 域范围为：[u min，umax]，同时根据输入变量偏差、偏差变化率以及输出变量的论域范围的大 小设置输入语言变量E、EC以及输出语言变量U的论域分别为X、Y、Z，根据输入、输出语言变 量论域的大小选取模糊语言值，并建立起模糊语言与语言变量相对应的变量赋值表，语言 变量赋值表根据需要的控制精度以及实际控制经验进行建立(语言变量赋值表需根据实际 系统进行建立，大部分根据实际调节经验进行建立，领域内均未具体说明）。此后，进行输入 变量的模糊化，以预先设定的量化因子khb。分别乘以采样得到的横向偏差量e和偏差的变 化率 ec由此得到量化后的E和EC;
[0020] Step2:建立模糊参数调整器，调整器的输入为量化后的E以及无人机的高度值H， 由此查询自适应控制器参数调整表得到控制器的调整倍数N，并得到新的量化因子ke'=ke* 11^'=1^*财吡例因子1^'=1^/^，式中的1^为预先设定的比例因子，并由此得到新的量 化后的E和EC。自适应控制器参数调整表的建立的规则是在误差大于某一预先设定的阈值 Ethrei时降低ke和ke。，加大比例因子ku，从而降低输入量的分辨率同时加大输出变量;在误差 小于某一预先设定的阈值E thral时增大和I。，减小比例因子ku，从而提高输入量的分辨率， 可以对较小误差作出反应。
[0021 ] Step3:设计模糊控制规则库。模糊控制规则是对专家控制规则加以总结，根据总 结的结果建立控制规则表，进一步的根据论域中每一条输入经模糊控制规则库得到的输出 从而建立起模糊控制器查询表。根据模糊语句"if E and EC then U"可以得到相应的模糊 关系i;，将每条模糊关系进行归纳，从而建立起模糊控制规则表，进一步的得到总的模糊关 系/e = ，。模糊控制器查询表的建立是根据输入语言变量E和EC论域中所有元素 X、Y作 i=l 模糊运算t/=(￡x￡q ,并将论域中所有元素进行遍历，从而得到。
[0022] step4:根据量化后的控制量，查询模糊控制器查询表，得到相应的输出量Y，并乘 以比例因子ku'，得到输出的偏航控制量u。，无人机根据此偏航控制量进而实现无人机的偏 航控制，进而实现精准的道路巡检。
[0023] (4)在误差较小时，应用PI控制器，以消除稳态误差。PI控制器为比例积分控制器， 对于消除稳态误差有很好的控制效果，进一步的保证了道路的精准巡检。
[0024] 本发明的优点在于：
[0025] (1)应用无人机进行道路巡检，可以很大程度上降低现有的应用巡逻车辆进行道 路巡检的成本，同时巡检的视野范围广，不受道路交通状况的限制。
[0026] (2)应用图像处理进行道路识别，相比于传统的应用GPS进行导航，巡航的路线更 为精确，同时应用颜色空间分割道路区域，提取得到的目标轨迹更为可靠。
[0027] (3)应用图像处理得到的目标轨迹与实际轨迹的偏差量进行控制器模数选择，在 误差较大时应用模糊控制器，客服不确定因素的影响，同时加快调节，在误差较小时应用PI 控制器消除稳态误差，得到较为稳定的巡检轨迹。
[0028] (4)应用参数自校正模糊控制器，在大误差时能快速消除误差，动态性能好，同时 在受到随机干扰影响时，控制器能很好的自适应，另一方面，建立的模糊参数调整器中包含 高度信息，对于无人机飞行高度不同时图像视野大小不一而导致图像处理的结果单位不一 致进行了自适应调整。
【附图说明】
[0029] 图1为本发明无人机道路巡航控制道路识别测试示例图片；
[0030] 图2为本发明无人机道路巡航控制双模控制器系统原理图；
[0031] 图3为本发明无人机道路巡航控制参数自校正模糊控制器系统原理图；
[0032]图4是本发明的发明流程图。
【具体实施方式】
[0033]下面将结合附图和实施例对本发明作进一步的详细说明。
[0034] 为达到上述目标，本发明选用一条小路为例，实现对小路的巡航。
[0035] -种多旋翼无人机的智能道路巡航控制方法，流程如图4所示，具体包括：
[0036] 步骤1:通过控制无人机机载云台图像传感器，使之垂直朝下从而获取无人机正下 方道路信息。
[0037]步骤2::将获取的图像信息进行附图1所示的图像处理：
[0038] 2a)将拍摄得到的图像从RGB颜色空间转换到HSV颜色空间。其中Η通道表示色彩信 息，该参数用角度来度量;S通道表示饱和度，指颜色的纯度与最大纯度之比;V通道表示色 彩的明亮程度。
[0039] 2b)提取Η通道图像（图1(b))，通过颜色阈值区间分割道路区域，提取道路区域二 值图像B(x，y)。如图1(a)所示道路区域，设置为红色，预先设定Η通道阈值区间为ΤΗ=[0， 20 ] U [ 312，360 ]，则道路区域