基于GPS定位的移动机器人导航控制方法技术

本发明专利技术公开了一种基于GPS定位的移动机器人导航控制方法，获取机器人当前定位、机器人车头方向角和目标点定位；根据机器人当前定位和目标点定位，计算两者连线与水平轴的夹角，结合机器人车头方向角，计算电机运行参数；根据电机运行参数，驱动电机在设定时间内正反转；更新电机运行参数驱动电机运作，直至机器人到达目标点阈值范围内。本发明专利技术简化了实验过程，只需要完成点到点的导航控制，事先不需要规划路径，提高了机器人导航的时效性。

Navigation Control Method of Mobile Robot Based on GPS Positioning

The invention discloses a navigation control method of mobile robot based on GPS positioning, which obtains the current positioning of the robot, the orientation angle of the robot's head and the positioning of the target point; calculates the angle between the two lines and the horizontal axis according to the current positioning and the positioning of the target point; calculates the operation parameters of the motor by combining the orientation angle of the robot's head; and drives the motor in place according to the operation parameters of the motor. Fixed time forward and backward; update motor operation parameters to drive motor operation until the robot reaches the target point threshold. The invention simplifies the experimental process, only needs to complete the point-to-point navigation control, does not need to plan the path in advance, and improves the timeliness of robot navigation.

【技术实现步骤摘要】
基于GPS定位的移动机器人导航控制方法
本专利技术涉及移动机器人控制技术，具体涉及一种基于GPS定位的移动机器人导航控制方法。
技术介绍
随着科学技术的不断进步，机器人的应用越来越广泛，几乎渗透到各个领域。在机器人控制领域中，移动机器人的导航控制是至关重要的一部分。企业产品设计和高校机器人控制实验都是以移动机器人的导航控制为基础，例如大型变电站的智能巡检机器人，智能汽车自动驾驶技术等等。现有的导航控制方法技术门槛高，实现比较困难，需要耗费大量的人力物力，而高校实验教学对导航精度要求不高，采用现有的导航控制技术会浪费资源。
技术实现思路
本专利技术的目的在于提供一种基于GPS定位的移动机器人导航控制方法，容易实现，适用于高校实验教学使用。实现本专利技术目的的技术解决方案为：一种基于GPS定位的移动机器人导航控制方法，包括如下步骤：步骤1、获取机器人当前定位、机器人车头方向角和目标点定位；步骤2、根据机器人当前定位和目标点定位，计算两者连线与水平轴的夹角，结合机器人车头方向角，计算电机运行参数；步骤3、根据电机运行参数，驱动电机在设定时间内正反转；步骤4、重复步骤2、3，直至机器人到达目标点阈值范围内。作为一种具体实施方式，步骤1中的定位信息包括经度、纬度信息。作为一种具体实施方式，步骤2中，计算电机运行参数的具体方法为：步骤2.1、将两轮差动移动机器人系统抽象成车轮、机器人体组成的系统，建立一阶连续机器人动力学模型，如下：其中，x,y分别为移动机器人的经度坐标和纬度坐标，u1为移动机器人位移的微分量，u2为机器人角度的微分量，θ为机器人车头方向角(即以正东方向为X轴正方向，机器人车头与X轴正方向夹角，陀螺仪直接测得的角度是机器人车头与正北方向的夹角，将这个测得的角度加上即为方向角)；步骤2.2、根据机器人当前定位和目标点定位连线，计算连线与水平轴的夹角，确定目标位置的状态空间与当前位置之间的关系；连线与水平轴的夹角θ*为：θ*＝atan2(y*-y，x*-x)其中，(x,y)为机器人当前定位坐标，(x*,y*)为目标点定位坐标；目标位置的状态空间与当前位置之间的关系为：(k为不为0的任意系数)其中，ql为目标位置的状态空间，表示为包含目标点的坐标即经度x1和纬度y1的列向量；设Δ1＝x1-x，Δ2＝y1-y，整理上述公式得到：此时，由上述一系列分析就可以得到u1,u2，结果如下：u1,u2经过控制器设计，分别对u1做工程正切，u2做比例运算处理后得到两个数值w1,w2：其中，k1、k2为非0的常数，根据实际情况选取数值；步骤2.3、计算左右电机的运动状态参数Ω1、Ω2：解得：作为一种具体实施方式，步骤3中，电机旋转的方向取决于电机运行参数的符号，正号时正转，负号时反转，电机转速取决于电机运行参数的数值，是电机运行参数的整数倍。作为一种具体实施方式，步骤4中，目标点阈值范围为以目标点为圆心，设定阈值为半径的圆形区域。本专利技术与现有技术相比，其显著优点为：本专利技术简化了实验过程，只需要完成点到点的导航控制，事先不需要规划路径，提高了机器人导航的时效性。附图说明图1为本专利技术移动机器人定位信息获取流程图。图2为本专利技术移动机器人导航控制算法流程图。图3为本专利技术移动机器人运行控制流程图。图4为本专利技术的实验仿真图。图5为本专利技术基于GPS定位的移动机器人导航控制方法的整体流程图。具体实施方式下面结合附图和具体实施例进一步说明本专利技术方案。如图1所示，基于GPS定位的移动机器人导航控制方法，包括如下步骤：步骤1、主控制板通过无线通信模块接收目标点的定位信息(经度、纬度)，读取定位模块发送的当前定位(精度、纬度)和机器人车头方向角，储存下来。如图1所示，具体包括以下步骤：步骤1-1、已知一个点的精确定位信息，选取它为目标点，在控制终端输入这个点信息后，通过无线通信模块发送给主控板，主控板储存下来，方便接下来使用。步骤1-2、GPS传感器使用内置的定位算法获取到移动机器人当前的定位经度和纬度，通过串口通信发送给高精度姿态测量模块。姿态测量模块用自身内置的陀螺仪测得机器人车头和水平轴的夹角(实际陀螺仪直接测得的角度是车头与正北方向的夹角，加上即方向角)，并通过编程将方向角和定位信息融合，再通过I2C通信发送给主控制板，主控制板接收，储存下来。步骤2、移动机器人主控板在接收储存上述信息后，使用导航控制算法解算得到两个电机的运行参数，储存下来，发送给下一级。如图2所示，具体包括以下步骤：步骤2-1、主控板得到目标点坐标、起始点坐标、机器人车头方向角，利用数学公式计算得到目标点与起始点连线与水平轴的夹角，储存这些数据信息。步骤2-2、以上数据经过以unicycletrackingcontrol理论为依据的导航控制算法处理，推算得出一组合适的左右两电机的运行参数Ω1、Ω2，并储存下来；如图2所示，移动机器人导航控制算法步骤如下：步骤2-2-1、首先将两轮差动移动机器人系统抽象成车轮、机器人体组成的系统，建立一个一阶连续机器人动力学模型，如下：其中，x,y分别为移动机器人的经度坐标和纬度坐标，u1为移动机器人位移的微分量，u2为机器人角度的微分量，θ为机器人车头方向角(即以正东方向为X轴正方向，机器人车头与X轴正方向夹角，陀螺仪直接测得的角度是机器人车头与正北方向的夹角，将这个测得的角度加上即为方向角)；设移动机器人的当前定位(x,y)和目标点定位(x*,y*),可得到两点连线与水平轴的夹角θ*为：θ*＝atan2(y*-y，x*-x)其中，(x,y)为机器人当前定位坐标，(x*,y*)为目标点定位坐标；目标位置的状态空间与当前位置之间的关系为：(k为不为0的系数)其中，ql表示目标位置的状态空间，即目标点的坐标，表示为包含目标点坐标即经度x1和纬度y1的列向量；设Δ1＝x1-x，Δ2＝y1-y，整理上述公式可得：此时，由上述一系列分析就可以得到u1,u2，结果如下：u1,u2经过控制器设计分别将u1做工程正切，u2做比例运算处理后得到两个数值w1,w2：其中，k1、k2是不为0的常数，根据稳定性理论和仿真调试以及现场实验多次调试可取k1＝50,k2＝50，实验者亦可根据实际情况选取合适数值；步骤2-2-3、参考论文FuzzyLogicTrackingControlforUnicycleMobileRobots提到的UnicycleTrackingControl理论，可以得到左右电机的运动状态参数Ω1、Ω2与w1、w2的关系式，如下：解得：由以上公式即可得到电机运行状态的参数值，由于上式的系数还与机器人车轮的半径，两轮之间的轮距相关，系数应为的倍数，根据使用的移动机器人的实际情况，在实验时将系数取3，这样有利于机器人导航过程中稳定运行；步骤3、所述电机驱动芯片接收主控板通过模拟信号发出的运行参数后，控制电机转向和转速，使电机运行。如图3所示，移动机器人在驱动电机时，首先判断是否获得电机运行参数，当确认电机驱动芯片被主控板写入运行参数后进行以下步骤：步骤3-1、将电机运行参数的数值分解为两部分，正负号分别代表电机正转和反转，数值绝对值代表电机转速；步骤3-2、电机驱动芯片开始控制左右电机按指定的转速和转动方向运行，移动机器人开始前进、后退、左转、本文档来自技高网...

【技术保护点】
1.一种基于GPS定位的移动机器人导航控制方法，其特征在于，包括如下步骤：步骤1、获取机器人当前定位、机器人车头方向角和目标点定位；步骤2、根据机器人当前定位和目标点定位，计算两者连线与水平轴的夹角，结合机器人车头方向角，计算电机运行参数；步骤3、根据电机运行参数，驱动电机在设定时间内正反转；步骤4、重复步骤2、3，直至机器人到达目标点阈值范围内。

【技术特征摘要】
1.一种基于GPS定位的移动机器人导航控制方法，其特征在于，包括如下步骤：步骤1、获取机器人当前定位、机器人车头方向角和目标点定位；步骤2、根据机器人当前定位和目标点定位，计算两者连线与水平轴的夹角，结合机器人车头方向角，计算电机运行参数；步骤3、根据电机运行参数，驱动电机在设定时间内正反转；步骤4、重复步骤2、3，直至机器人到达目标点阈值范围内。2.根据权利要求1所述的基于GPS定位的移动机器人导航控制方法，其特征在于，步骤1中的定位信息包括经度、纬度信息，机器人方向角。3.根据权利要求1所述的基于GPS定位的移动机器人导航控制方法，其特征在于，步骤2中，计算电机运行参数的具体方法为：步骤2.1、将两轮差动移动机器人系统抽象成车轮、机器人体组成的系统，建立一阶连续机器人动力学模型，如下：其中，x,y分别为移动机器人的经度坐标和纬度坐标，u1为移动机器人位移的微分量，u2为机器人角度的微分量，θ为机器人车头方向角(即以正东方向为X轴正方向，机器人车头与X轴正方向夹角，陀螺仪直接测得的角度是机器人车头与正北方向的夹角，将这个测得的角度加上即为方向角)；步骤2.2、根据机器人当前定...

【专利技术属性】
技术研发人员：洪磊，解军，韩凯，孙金生，
申请(专利权)人：南京理工大学，
类型：发明
国别省市：江苏,32