一种机器人的控制系统技术方案

本实用新型专利技术公开了一种机器人的控制系统，涉及机器人领域，解决现有技术中，机器人在斜坡上工作的过程中容易跑偏的技术问题，本实用新型专利技术提供一种机器人的控制系统包括主控模块、行走机构和与主控模块连接用于采集机器人方向信息的方向采集模块，方向采集模块包括采集地磁场数据的磁场感应传感器，方向采集模块还包括采集重力加速度数据的重力加速度传感器，主控模块根据磁场感应传感器的地磁场数据和重力加速度传感器的重力加速度数据获取机器人方向信息并通过行走机构控制机器人稳定的直线运动。本实用新型专利技术应用于对机器人的运动控制。

【技术实现步骤摘要】
一种机器人的控制系统【
】本技术涉及机器人领域。【
技术介绍
】草坪是城市绿化的重要组成部分，通过割草机器人，在一定程度上提高了割草效率，降低劳动强度，节省大量劳动资源，割草机器人自主运动控制的运动路径一般根据现场草坪的规格及形状而定，通常可采用的有螺旋形运动路径控制、轮廓跟踪形运动路径控制、无规则的随机路径控制以及平行往复式运动路径控制，割草机器人沿多条平行的直线往复运动割草，平行往复式运动路径控制是其中最为理想的机器人高效运动控制方式。现有技术中的智能割草机通过感应地磁场来确定方向，确保机器人直线运动时始终向着一个固定的方向，但是，该方法仅在地面比较平整的情况下才取得较好效果，在地面坡度较大或者不平的情况下，机器人的机身产生倾斜，机器人采集的磁场坐标也产生倾斜，因此采集的磁场数据与实际的地磁场不同，根据采集的磁场数据计算出的运动方向存在误差，导致方向判断错误，引起走偏，影响割草的效果。
技术实现思路
本技术解决的技术问题是提供一种机器人的控制系统，提高机器人运动轨迹的直线性。为解决上述技术问题，本技术采用如下技术方案:一种机器人的控制系统，包括主控模块、行走机构和与主控模块连接用于采集机器人方向信息的方向采集模块，所述方向采集模块包括采集地磁场数据的磁场感应传感器，所述方向采集模块还包括采集重力加速度数据的重力加速度传感器，所述主控模块根据磁场感应传感器的地磁场数据和重力加速度传感器的重力加速度数据获取机器人方向信息并通过行走机构控制机器人稳定的直线运动。进一步的，所述控制系统还包括采集机器人工作区域边界信息的边界信息采集模块，所述主控模块根据边界信息采集模块的反馈信号控制机器人的平移运动。进一步的，所述控制系统还包括用于感应障碍物的障碍物感应模块，所述主控模块根据障碍物感应模块的反馈信号控制机器人的平移运动。进一步的，所述行走机构包括行走电机组合及行走电机驱动模块。进一步的，所述行走电机组合包括左行走电机和右行走电机。本技术的有益效果:本技术，通过结合地磁场感应传感器和重力加速度传感器，计算出机器人的方向，通过重力加速度传感器和地磁场感应传感器的结合，克服了现有机器人只用地磁场数据计算方向的方法在非水平面上容易出现较大误差的缺点，保证了计算方向的准确性，并可保证运动直线间的平行。实现机器人按平行往复方式的自主运动，除了在平地外，在坡地、起伏不平的地面下仍能稳定机器人的运动方向，消除机身倾斜的干扰，防止运动过程发生跑偏。本技术的这些特点和优点将会在下面的【具体实施方式】、附图中详细的揭露。【【附图说明】】下面结合附图对本技术做进一步的说明:图1为本技术的结构示意图；图2为本技术的工作流程图；图3为机器人的行走路线图；图4为机器人方向信息的坐标示意图。【【具体实施方式】】下面结合本技术实施例的附图对本技术实施例的技术方案进行解释和说明，但下述实施例仅仅为本技术的优选实施例，并非全部。基于实施方式中的实施例，本领域技术人员在没有做出创造性劳动的前提下所获得其它实施例，都属于本技术的保护范围。参考图1，一种机器人的控制系统，包括主控模块1、行走机构3和与主控模块连接信息米集机构2,信息米集机构2包括用于米集机器人方向信息的方向米集模块21,方向米集模块21包括采集地磁场数据的磁场感应传感器，方向采集模块还包括采集重力加速度数据的重力加速度传感器，主控模块I根据磁场感应传感器的地磁场数据和重力加速度传感器的重力加速度数据获取机器人方向信息，磁场感应传感器的地磁场数据和重力加速度传感器的重力加速度数据可以通过主控模块计算出方向信息，或者也可以在方向采集模块中计算得出，主控模块根据方向信息通过控制行走机构的运动状态，使得当前运动方向与设定的直线运动方向一致。磁场感应传感器采集地磁场数据，重力加速度传感器采集重力加速度数据，当前运动方向的计算原理如下:参考图4，Xb、Yb、Zb为描述机器人机身姿态的相互垂直的三维坐标轴，XA、\、Za分别为传感器感应重力加速度的三个坐标轴，Xa> Ya> Za分别为重力加速度在这三个轴上的分量(单位为g)，xm、ym、zm分别为传感器感应磁场强度的三个坐标轴，xm、Ym、Zm分别为磁场在这三个轴上的分量。设Yb与水平面的夹角为Roll，Xb与水平面的夹角为Pitch，Xb在水平面投影与地球磁北的夹角为机器人与地磁北极的夹角Heading。假设传感器固定在机器人上，XA,M与Xb平行，YA,M与Yb平行，则XA,M、YA,M决定的平面、xb、Yb决定的平面相互平行。假设机器人处于水平状态下，则XA,M、YA,M决定的平面、Xb、Yb决定的平面、水平面三者相互平行，地磁场在Zm坐标上的分量Zm为0，加速度在XA、YA上的分量Xa、Ya为0，根据地磁场在XM、YM上的分量Xm、Ym,可通过公式:Heading = arctan (Ym/Xm)计算出机器人运动方向Heading。机器人在斜坡运动时，机身产生倾斜，因此磁场在Zm的分量Zm不为0，在XM、YM上的分量Xm、Ym与水平的情况不一致，通过公式:Heading = arctan (Ym/Xm)计算出机器人运动方向Heading存在偏差，但通过测得的重力加速度在XA、Ya上的分量Xa、Ya来计算出机器的倾斜角度Pitch和Roll，再结合地磁场在XM、YM、Zm上的分量Xm、Ym、Zm,通过如下公式，可计算出机器人与地磁北极的夹角Heading:Pitch = arcsin (_Xa)Roll = arcsin (Ya/ cosPitch)X = Xm*cosPitch+Zm*sinPitchY = Xm氺sinroll氺sinPitch+Ymcosroll_Zm氺sinroll氺cosPitchHeading = arctan(Y/X)直线行走过程中保持Heading不变，从而保证机器人运动的直线性及运动直线间的平行。采用的行走机构3包括行走电机组合32以及行走电机驱动模块31。行走电机组合包括左行走电机和右行走电机，通过行走电机驱动模块控制左行走电机和右行走电机的动作来控制机器人的运动方向稳定在目标运动方向上，同时也由左行走电机和右行走电机实现机器人的平移运动。控制系统还包括采集机器人工作区域边界信息的边界信息采集模块22，机器人直线运动达到工作区域边界时，边界信息采集模块感应边界状态发出边界信号，主控模块根据边界信号通过电机驱动模块控制行走电机组合的运动状态完成机器人的平移运动。本技术中边界信息采集模块22包括感应边界信息的感应电路、转换边界信息的信号处理电路和处理边界信息的单片机，单片机连接所述主控模块。还可以在信息采集机构中设置记录行走时间的时钟模块、记录行走行程的行程采集模块以及用于检测障碍物的障碍物检测模块，障碍物检测模块可为触碰开关，障碍物检测模块感应到障碍物时，主控模块控制机器人平移运动避开障碍物；行程采集模块可采用霍尔传感器感应行走电机的运动状态。参考图2和图3，采用上述控制系统的机器人的控制方法，包括以下步骤:I)直线运动方向设定:将机器人摆放在工作区域中并启动，主控模块将方向采集模块获取的机器人启动时的方向信息设定本文档来自技高网...

【技术保护点】
一种机器人的控制系统，包括主控模块、行走机构和与主控模块连接用于采集机器人方向信息的方向采集模块，所述方向采集模块包括采集地磁场数据的磁场感应传感器，其特征在于：所述方向采集模块还包括采集重力加速度数据的重力加速度传感器，所述主控模块根据磁场感应传感器的地磁场数据和重力加速度传感器的重力加速度数据获取机器人方向信息并通过行走机构控制机器人稳定的直线运动。

【技术特征摘要】
1.一种机器人的控制系统，包括主控模块、行走机构和与主控模块连接用于采集机器人方向信息的方向采集模块，所述方向采集模块包括采集地磁场数据的磁场感应传感器，其特征在于:所述方向采集模块还包括采集重力加速度数据的重力加速度传感器，所述主控模块根据磁场感应传感器的地磁场数据和重力加速度传感器的重力加速度数据获取机器人方向信息并通过行走机构控制机器人稳定的直线运动。2.根据权利要求1所述的一种机器人的控制系统，其特征在于:所述控制系统还包括采集机器人工作区域边界信息的边...

【专利技术属性】
技术研发人员：陈凤梧，
申请(专利权)人：浙江亚特电器有限公司，
类型：新型
国别省市：浙江;33