基于模糊算法和二维码自矫正的室内移动机器人协作系统技术方案

本发明专利技术公开了一种基于模糊算法和二维码自矫正的室内多移动机器人协作系统，包括若干机器人本体及分布于室内不同位置的若干二维码，每个二维码内含QR编码，代表在室内二维坐标系中各二维码的位置坐标，在每台机器人本体上设有单片机、加速度计模块、陀螺仪模块、二维码识别模块、通讯模块以及超声波传感器；该系统定位成本低，可实现高效路径规划，使得多机器人协同作业、避免冲突，工作效率高。

【技术实现步骤摘要】

本专利技术涉及一种多移动机器人协作系统，尤其涉及一种基于模糊算法和二维码自矫正的室内移动机器人协作系统，是基于模糊算法和超声波模块进行路径规划，通过二维码信息进行坐标获取和根据对二维码的图像处理结果进行运动位置矫正，根据陀螺仪模块和加速度计模块进行惯性运动矫正的多机器人协作系统。
技术介绍
当下移动机器人的应用越来越广泛,几乎渗透到了所有领域，尤其是室内移动机器人，越来越能够取代人们完成一些室内的工作。其中，当面临复杂或者工作量庞大的工作任务时，多机器人协作系统则更有帮助，也因此受到越来越多的关注。但同时，室内移动机器人的协作系统面临着定位成本高、路径规划难的问题，而当下控制方法中，模糊控制可以很方便的解决这一问题。所以本专利技术提出了一种可实现低成本定位且高效路径规划的室内移动机器人协作系统，该系统是基于模糊算法配合超声波传感器进行路径规划，通过二维码进行低成本坐标获取，且利用对二维码的图像处理结果进行运动位置矫正，根据陀螺仪模块和加速度计模块进行惯性运动矫正。
技术实现思路
本专利技术的目的在于针对现有技术的不足，提供一种基于模糊算法和二维码自矫正的室内多移动机器人协作系统，该系统定位成本低，可实现高效路径规划，使得多机器人协同作业、避免冲突，工作效率高。本专利技术的基于模糊算法和二维码自矫正的室内多移动机器人协作系统，包括若干机器人本体及分布于室内的若干二维码，每个二维码内含QR编码，代表在室内二维坐标系中各二维码的位置坐标，在每台机器人本体上设有单片机、加速度计模块、陀螺仪模块、二维码识别模块、通讯模块以及超声波传感器。在机器人运行平面内，定义垂直于其行进方向为横向，加速度计模块包括加速度计传感器，用于测量机器人的横向移动加速度并将测量数据传输至单片机。陀螺仪模块包括陀螺仪传感器，用于检测机器人的横向角速度并将检测数据传输至单片机。其中陀螺仪测得移动机器人横向角速度，并积分得到机器人每时每刻的偏离直线的角度后，结合此时的横向移动加速度值，对电机进行控制达到运动路线矫正的目的。二维码识别模块包括二维码识别装置、摄像头、串口装置，摄像头用于在二维码识别装置识别出二维码处拍照，并将照片通过串口装置传输至单片机。通讯模块用于与其他机器人之间进行互相通讯，传递各自下一目的地信息。超声波传感器共三个，分别设置于机器人正前侧、左侧及右侧，用于检测机器人附近障碍物距离，并传输至单片机。在每个二维码上设置三个定位点，所有二维码定位点一致，当单片机获取二维码处照片后根据照片中定位点进行角度矫正。单片机根据模糊算法进行路径规划并根据接收的横向移动加速度及横向角速度判断机器人的移动是否偏离直线惯性运动，若偏离，则通过偏离数值对机器人的惯性运动路线进行补偿矫正，使得机器人的行进路线为直线。上述技术方案中，根据模糊算法进行路径规划的方法具体为：1)构建模糊控制器：将以下因素作为模糊控制器的输入：超声波传感器得到的障碍物的距离位置信息、终点位置坐标、当前位置坐标、机器人优先级、是否有其他移动机器人下一个目的地坐标一致；以当前运动目标方向及左右轮加速度作为模糊控制器的输出；2)确定输入输出的隶属度函数，采用三角形隶属度函数，或者梯形隶属度函数；3)建立模糊规则。建立用于路径规划的模糊规则如下：1.当没有其他机器人下一个目的地坐标与自己一致的时候，且没有靠近的障碍物时，无论机器人优先级，都根据最终终点坐标和当前位置坐标得到此刻的运动目标方向。2.当有靠近的障碍物时，规则是输出与输入的模糊的障碍物方位相反。3.当没有障碍物，但是有机器人下一个目的地坐标与自己一致的时候，通过模糊控制选择一个机器人先走，另一个停止，选择规则是优先级大的先走，左、右轮加速度根据方向而定，另一个停止等候，左、右轮加速度均为零，直到没有机器人下一个目的地坐标与其一致。本专利技术根据模糊算法配合超声波传感器和通讯模块进行路径规划和运动控制，通过二维码进行低成本的坐标获取，且利用对二维码的图像处理结果进行运动位置矫正，根据陀螺仪模块和加速度计模块进行惯性运动路线矫正，该系统实现了低成本定位且高效路径规划，使得多台机器人之间协同作业、避免冲突，提高工作效率。附图说明图1是本专利技术的坐标系构件示意图。图2是定位点示意图。图3是超声波传感器位置示意图。图4是实例中路径规划的示意图。具体实施方式下面结合具体实施例对本专利技术作进一步说明。本实施方式中，协作系统包括若干机器人本体及分布于室内的若干二维码，机器人本体上设有单片机、加速度计模块、陀螺仪模块、二维码识别模块、通讯模块以及超声波传感器。单片机使用STM32，加速度计和陀螺仪模块可以选用：GY-521MPU6050模块，二维码识别模块为：Honeywell的N5680，其可以获取二维码，且拥有一个补光装置和摄像头拍照功能。坐标的获取：本系统通过在室内特定地点放置特定的二维码，并在室内建立二维坐标系，将室内的位置坐标利用QR编码表示，通过二维码识别模块获取各个位置的坐标实现机器人位置获取，如图1所示。二维码识别模块设置在移动机器人底盘下面，补光装置，保证二维码的成功获取，防止光线暗而导致二维码获取不到。利用二维码周围的三个定位点作为之后图像处理所用的特征点(也就是二维码常用的定位点，如图2)。在获得位置信息时，摄像头进行拍照，并把照片传给单片机，通过图像处理的方法，矫正运动位置。比如，在移动机器人行进到二维码附近，在获取二维码信息后，停止行进并拍摄一张二维码的照片传给单片机，在单片机进行路径规划后，移动机器人完成左转、右转、直行这三个运动方向切换后，会结合单片机通过图像处理的方法进行运动位置矫正，以防止左转，右转方向有微小误差影响后面运动不到二维码上。如：对图像先进行灰度值的二值化处理，然后对图像各个方向进行积分，根据结果值大小的结果来判断定位点是否在应该在的地方(不同情况下，定位点应该在不同方向的各绝对坐标处)。当要直行时，在移动机器人拍摄的照片中，定位点就应该在左上角、右上角、左下角三个绝对位置处，如果不在，则通过计算结果进行微调移动机器人的位置。微调后，则按照路径规划，沿着惯性直行，直到到达下一个二维码，再进行路径规划，并根据路径规划的结果判断左拐还是直行还是右拐。当左右转或者直行的情况下，移动机器人会选择向左、右转九十度或者直行后，通过图像处理的方法判断定位点是否在该运动方向的特定的位置，并进行判断和微调，最终实现移动机器人在各个二维码处运动位置精准，为下次运动做好准备。路径规划：机器人装备有三个超声波传感器如图3，分别为：左方传感器、正前方传感器、右方传感器。超声波传感器可以通过这三个超声波传感器算出各个障碍物离移动机器人的距离和方位，并将其传给单片机，单片机在面临障碍物距离小于一定值如0.5米的时候，判定障碍物方位是否在移动机器人轨道上，如果在轨道上，则返回并等待重新规划路径，以此达到避障的效果。机器人的下一个目的地是根据最终目的地和此时所在的二维码位置按照靠近原则随机生成的，是路径规划的第一步，此后根据模糊算法进行运动控制和路径规划。各机器人先根据最终目的地坐标，比对自己此时所在的二维码坐标，然后以坐标靠近的原则，随机生成下一个目的地坐标(可随机将横坐标或者纵坐标靠近最终坐标，如最终目的地为(3，3)，此时坐标(本文档来自技高网...

【技术保护点】
基于模糊算法和二维码自矫正的室内多移动机器人协作系统，其特征在于，包括若干机器人本体及分布于室内不同位置的若干二维码，每个二维码内含QR编码，代表在室内二维坐标系中各二维码的位置坐标，在每台机器人本体上设有单片机、加速度计模块、陀螺仪模块、二维码识别模块、通讯模块以及超声波传感器；在机器人运行平面中，定义垂直于其行进方向为横向，所述的加速度计模块包括加速度计传感器，加速计模块用于测量机器人的横向移动加速度并将测量数据传输至单片机；陀螺仪模块包括陀螺仪传感器，用于检测机器人的横向角速度并将检测数据传输至单片机；二维码识别模块包括二维码识别装置、摄像头、串口装置，摄像头用于在二维码识别装置识别出二维码处拍照，并将照片通过串口装置传输至单片机；通讯模块用于与其他机器人之间进行互相通讯，传递各自机器人的下一目的地信息；超声波传感器共三个，分别设置于机器人正前侧、左侧及右侧，用于检测机器人附近障碍物距离，并传输至单片机；在每个二维码上设置三个定位点，所有二维码定位点一致，当单片机获取二维码处照片后根据照片中定位点进行角度矫正。单片机根据模糊算法进行路径规划并根据接收的横向移动加速度及横向角速度算出的角度判断机器人的移动是否偏离直线惯性运动，若偏离，则利用偏离角度和加速度值对机器人的惯性运动路线进行补偿矫正，使得机器人的行进路线为直线。...

【技术特征摘要】
1.基于模糊算法和二维码自矫正的室内多移动机器人协作系统，其特征在于，包括若干机器人本体及分布于室内不同位置的若干二维码，每个二维码内含QR编码，代表在室内二维坐标系中各二维码的位置坐标，在每台机器人本体上设有单片机、加速度计模块、陀螺仪模块、二维码识别模块、通讯模块以及超声波传感器；在机器人运行平面中，定义垂直于其行进方向为横向，所述的加速度计模块包括加速度计传感器，加速计模块用于测量机器人的横向移动加速度并将测量数据传输至单片机；陀螺仪模块包括陀螺仪传感器，用于检测机器人的横向角速度并将检测数据传输至单片机；二维码识别模块包括二维码识别装置、摄像头、串口装置，摄像头用于在二维码识别装置识别出二维码处拍照，并将照片通过串口装置传输至单片机；通讯模块用于与其他机器人之间进行互相通讯，传递各自机器人的下一目的地信息；超声波传感器共三个，分别设置于机器人正前侧、左侧及右侧，用于检测机器人附近障碍物距离，并传输至单片机；在每个二维码上设置三个定位点，所有二维码定位点一致，当单片机获取二维码处照片后根据照片中定位点进行角度矫正。单片机根据模糊算法进行路径规划并根据接收的横向移动加速度及横向角速度算出的角度判断机器人的移动是否偏离直线惯性运动，若偏离，则利用偏离角度和加速度值对机器人的惯性运动路线进行补偿矫正，使得机器人的行进路线为直线。2.根据权...

【专利技术属性】
技术研发人员：吴昊天，刘凯鉴，张天晨，
申请(专利权)人：浙江大学，
类型：发明
国别省市：浙江;33