一种基于模糊控制的多驱动轮AGV导航方法技术

一种基于模糊控制的多驱动轮AGV导航方法，包括以下步骤：步骤1)获取车体的姿态信息并计算得出横向偏差及其变化率、角度偏差及其变化率；步骤2)将横向偏差及其变化率、角度偏差及其变化率分别输入到两个二维模糊控制器中，分别得到输出量速度偏角增量和车体绕旋转中心角速度；步骤3)选取合适的比例因子得到控制的精确量，计算得到车体的速度偏角和绕中心旋转角速度，通过结构分析和运动分解得到各驱动轮的控制量并下发给下层控制单元控制驱动轮运动。本发明专利技术利用模糊逻辑控制和色带导航传感器，结合模糊规则的推理过程，以此实现AGV小车的自动导航，提升系统鲁棒性。

【技术实现步骤摘要】
一种基于模糊控制的多驱动轮AGV导航方法
本专利技术涉及工业机器人控制领域，尤其涉及一种基于模糊控制的多驱动轮AGV导航方法。
技术介绍
AGV现在通用的导航方法有电磁引导、光条纹引导、磁带引导、惯性导航、超声定位引导、激光反射定位引导、激光扫描定位引导、视觉引导、RFID复合定位引导、GPS导航。有单舵轮驱动、差速驱动、双舵轮驱动、四轮驱动等不同的驱动方式，在不同的应用场景中，需要采用不同的驱动结构以满足工业需求，因此也需要使用不同的导航方法。其中，双舵轮和四轮驱动的控制方法由于车体结构和多驱动的相互约束问题较单舵轮驱动和双轮差速驱动显得更为复杂。
技术实现思路
为了解决现有多驱动全方位移动AGV的控制鲁棒性较差、控制不易的不足，本专利技术提供一种基于模糊控制的多驱动轮AGV导航方法，利用模糊逻辑控制和色带导航传感器，结合模糊规则的推理过程，以此实现AGV小车的自动导航，提升系统鲁棒性。为了解决上述技术问题本专利技术提供如下的技术方案：一种基于模糊控制的多驱动轮AGV导航方法，所述方法包括以下步骤：步骤1)获取小车相对于正确轨迹的横向距离偏差，计算横向距离偏差变化率，记录这两个值，获取车体相对于轨迹当前位置的斜率的角度偏差，并计算角度偏差变化率，记录角度偏差及角度偏差变化率；步骤2)将车体横向距离偏差与横向距离偏差变化率作为二维模糊控制器的输入，并得到轨迹纠偏所需的速度偏角增量，计算得出车体速度偏角；将车体相对于轨迹的角度偏差以及角度偏差变化率作为二维控制器的输入，并得到车体整体绕旋转中心的角速度；步骤3)结合两个二维模糊控制器的输出和给定的车体整体的运行速度对模糊控制器的输出量选择合适的的比例因子，得到的车体的速度偏角和绕瞬时中心旋转的角速度计算得出各个驱动轮的控制量并下发给驱动器，以此实现车体的轨迹跟踪。进一步，所述步骤2)中，二维模糊控制器设计过程如下：2.1)确定输入、输出变量将小车的横向距离偏离和横向距离偏差变化率作为一个二维模糊控制器的输入变量，车体的速度偏角的增量作为该模糊控制器的输出量，设定车体速度偏角相对于车头方向偏左为负，偏右为正；将小车与轨迹的切线方向的角度偏差和角度偏差变化率作为另一个二维模糊控制器的输入变量，车体的旋转角速度作为该模糊控制器的输出量，设定顺时针旋转为正，逆时针旋转为负；2.2)确定各变量论域以及模糊语言值小车横向距离偏离量的论域为[-6,6]，小车横向距离的偏离率论域为于[-3,3]，车体的合速度偏角增量论域范围为[-10,10]；小车角度偏差量的论域为[-6,6]，小车角度偏差变化率为[-3,3]，车体角速度论域为[-6,6]，设定所有输入输出变量的语言集为{负大(NB)，负中(NM)，负小(NS)，零(ZO)，正小(PS)，正中(PM)，正大(PB)}；2.3)确定各变量隶属度函数隶属度函数为三角形、梯形、钟形或正态分布型隶属度函数；2.4)建立模糊规则根据人类在控制车辆行走的经验和测试得出模糊规则表；2.5)进行模糊推理并解模糊接口根据输入量，由模糊控制规则完成模糊推理求解出模糊关系方程，获得模糊控制量，获得的模糊控制量经由解模糊获得精确量，由此可以建立一个模糊查询表。本专利技术的有益效果为：设计了两个模糊控制器分别用以控制车体的速度偏角大小以及角速度，将横向偏差、横向偏差变化率、角度偏差、角度偏差变化率四个变量分别作为两个模糊控制器的输入变量，可以有效降低车辆行驶过程中误差，提高系统的稳定性，提升系统的路径纠偏能力，且在路径跟随过程中能调整车体的姿态。附图说明图1为本专利技术的车体控制流程图。图2为AGV偏差信息示意图。图3为车体运动控制示意图。图4为车体速度偏角模糊控制器变量隶属曲线图，其中，(a)为横向偏差隶属函数曲线，(b)为横向偏差变化率隶属函数曲线，(c)为速度偏角隶属函数曲线。具体实施方式：下面结合附图对本专利技术作进一步详细的说明。参照图1～图4，一种基于模糊控制的多驱动轮AGV导航方法，包括以下步骤：步骤1)通过传感器反馈回来的车体位置信息，计算得出车体相对于轨迹的横向偏差ed及其变化率ecd和角度偏差ea及其变化率eca，如图2所示，车体横向偏差ed定义如下：(1)车体位于道路正中间时ed＝0；(2)车体位于道路中心的左侧时ed<0；(3)车体位于道路正中间时ed>0；(4)车体偏离轨迹的程度越大，|ed|越大如图2所示，车体角度偏差定义如下，以车头方向为零点：(1)车体车头方向与轨迹切线方向相同时ea＝0；(2)车体车头方向基于轨迹切线方向左偏时ea<0；(3)车体车头方向基于轨迹切线方向右偏时ea>0；(4)车体车头方向基于轨迹切线方向偏离程度越大时|ea|越大；步骤2)将横向偏差ed及其变化率ecd输入到车体方向模糊控制器，得到输出量车体速度偏角增量ΔA，速度偏角A定义见图3，设定基于车头方向偏右为正，偏左为负；将角度偏差ea及其变化率eca输入车体旋转角速度模糊控制器，得到输出量车体旋转角速度ω，其定义如图3所示，设定顺时针转为正，逆时针转动为负；步骤3)取车体运动速度为固定值，结合车体速度偏角模糊控制器输出变量ΔA和上一次控制周期的角度偏差计算得到本次控制周期内所需要的速度偏角A；对得到的速度偏角A和车体旋转角速度模糊控制器的输出变量ω结合对车体的运动分析和阿克曼转向定理分解得到各驱动轮的转动角度和行走速度；将其下发给下层驱动器控制驱动轮按要求运动，以此控制车体跟随轨迹行走。进一步，所述步骤2)中，车体速度偏角模糊控制器设计如下：2.1)确定横向偏差ed及其变化率ecd作为输入，输出量车体速度偏角增量ΔA作为输出量，构成二输入单输出的模糊控制系统；2.2)将横向偏差ed的模糊语言变量定义为{“负大”，“负中”，“负小”，“零”，“正小”，“正中”，“正大”}＝{“NB”，“NM”，“NS”，“ZO”，“PS”，“PM”，“PB”}，为了提高控制精度将横向偏差ed的语言变量量化为13各等级，其论域表示为：{-6，-5，-4，-3，-2，-1，0，1，2，3，4，5，6}；将另一输入变量横向偏差变化率ecd的模糊语言变量定义为{“负大”，“负中”，“负小”，“零”，“正小”，“正中”，“正大”}＝{“NB”，“NM”，“NS”，“ZO”，“PS”，“PM”，“PB”}，其离散论域表示为：{-3，-2，-1，0，1，2，3}；输出变量ΔA取其模糊语言变量为{“负大”，“负中”，“负小”，“零”，“正小”，“正中”，“正大”}＝{“NB”，“NM”，“NS”，“ZO”，“PS”，“PM”，“PB”}，其论域为[-10,10]。2.3)对于隶属度函数，隶属度函数可以采用三角形、梯形、钟形或正态分布型隶属度函数；对输本文档来自技高网...

【技术保护点】
1.一种基于模糊控制的多驱动轮AGV导航方法，其特征在于，所述方法包括以下步骤：/n步骤1)获取小车相对于正确轨迹的横向距离偏差，计算横向距离偏差变化率，记录这两个值，获取车体相对于轨迹当前位置的斜率的角度偏差，并计算角度偏差变化率，记录角度偏差及角度偏差变化率；/n步骤2)将车体横向距离偏差与横向距离偏差变化率作为二维模糊控制器的输入，并得到轨迹纠偏所需的速度偏角增量，计算得出车体速度偏角；将车体相对于轨迹的角度偏差以及角度偏差变化率作为二维控制器的输入，并得到车体整体绕旋转中心的角速度；/n步骤3)结合两个二维模糊控制器的输出和给定的车体整体的运行速度对模糊控制器的输出量选择合适的的比例因子，得到的车体的速度偏角和绕瞬时中心旋转的角速度计算得出各个驱动轮的控制量并下发给驱动器，以此实现车体的轨迹跟踪。/n

【技术特征摘要】
1.一种基于模糊控制的多驱动轮AGV导航方法，其特征在于，所述方法包括以下步骤：
步骤1)获取小车相对于正确轨迹的横向距离偏差，计算横向距离偏差变化率，记录这两个值，获取车体相对于轨迹当前位置的斜率的角度偏差，并计算角度偏差变化率，记录角度偏差及角度偏差变化率；
步骤2)将车体横向距离偏差与横向距离偏差变化率作为二维模糊控制器的输入，并得到轨迹纠偏所需的速度偏角增量，计算得出车体速度偏角；将车体相对于轨迹的角度偏差以及角度偏差变化率作为二维控制器的输入，并得到车体整体绕旋转中心的角速度；
步骤3)结合两个二维模糊控制器的输出和给定的车体整体的运行速度对模糊控制器的输出量选择合适的的比例因子，得到的车体的速度偏角和绕瞬时中心旋转的角速度计算得出各个驱动轮的控制量并下发给驱动器，以此实现车体的轨迹跟踪。


2.如权利要求1所述的一种基于模糊控制的多驱动轮AGV导航方法，其特征在于，所述步骤2中，二维模糊控制器设计过程如下：
2.1)确定输入、输出变量
将小车的横向距离偏离和横向距离偏差变化率作为一个二维模糊控制器的输入变量，车体的速度偏角的增量作为该模...

【专利技术属性】
技术研发人员：邢科新，邢明，林叶贵，张兴盛，
申请(专利权)人：浙江工业大学，
类型：发明
国别省市：浙江;33