[发明专利]一种基于高精度磁导航传感器的磁条偏差角度的测量方法

说明书

技术领域

本发明属于AGV车寻磁导航技术领域。特别对可原地旋转的AGV车有更好的作用。

背景技术

随着电子和霍尔传感器技术的发展，AGV磁导航技术也在不断地进步，正在朝着性能更优越、精度更高的方向发展。为了提高AGV车在寻磁导航的横向及地标位置偏移检测精度、获得偏移角度，对于可原地旋转AGV获得旋转角度，而使得此技术得以设计并应用。

现AGV行业中的磁导航传感器一般采用长条6霍尔、8霍尔或更多至16霍尔的传感器，其检测精度受两个霍尔间距离影响，通常在1～2cm误差，因此使得AGV车最小也要用1～2cm甚至更大的横向寻磁误差而使得行走过程中左右晃动。并且不知道车当前行走偏差角度，使得行走过程中增加调整次数。并且该类型传感器对于磁条方式地标检测定位精度不高。对于可原地旋转的AGV车不能准确测量旋转角度。因此通常要增加其它传感器或设备来弥补，使得成本增加。

发明内容

本发明是为了解决现有的长条形霍尔传感器检在寻磁行走过程中稳定性差，对于磁条方式的地标检测定位精度低，并且缺少对磁条偏差角度测量的问题。现提供一种基于高精度磁导航传感器的磁条偏差角度的测量方法。

一种基于高精度磁导航传感器的磁条偏差角度的测量方法，它包括以下内容：

采用m个霍尔传感器组成一个闭环的圆形，m为正整数，检测一字磁条或十字磁条的磁场位置，每8个霍尔传感器将检测的数据经过一个数据锁存器进行锁存，MCU控制器以定时或不定时方式从个数据锁存器中获取磁条磁场数据，并经过计算及处理，通过CAN总线数据收发器以CAN总线将数据发送出去，AGV车的主控单元实时通过CAN总线获取一字磁条和十字磁条的角度偏差θ、AGV车与一字磁条的横向位置偏差DX和AGV车与十字磁条的横向位置偏差DX及纵向位置偏差DX，实现磁条偏差角度的测量。

本发明的有益效果为：采用m个霍尔传感器组成一个闭环的圆形，检测一字磁条或十字磁条的磁场位置，使得带有霍尔传感器的AGV车在磁条行走过程中稳定性好，对于磁条方式的地标检测定位精度高，达到1mm～2mm精度，同比现有的传感器检测磁条的方式检测精度提高6倍以上，另外，每8个霍尔传感器将检测的数据经过一个数据锁存器进行锁存，MCU控制器以定时或不定时方式从个数据锁存器中获取磁条磁场数据，并经过计算及处理，通过CAN总线数据收发器以CAN总线将数据发送出去，AGV车的主控单元实时通过CAN总线获取一字磁条和十字磁条的角度偏差θ和AGV车与一字磁条的横向位置偏差DX，能够测量AGV车行进时，偏离圆心的角度偏差，其精度为1度；还能够测量AGV车到达磁性地标的位置偏差，其精度为1mm～2mm；在十字和一字磁条检测模式下，当原地以十字坐标O为中心旋转前，记录当前角度偏差θ，当原地以十字坐标O为中心旋转时，角度偏差θ将会连续增加或减少，即可获知旋转角度，其精度为1度。

附图说明

图1为一种用于AGV车的磁导航传感器的原理示意图；

图2为发明中印制板主视图，附图标记1为印制板；

图3为本发明中霍尔传感器自身十字作标系示意图；

图4和图5为本发明中检测一字磁条时的示意图；

图6和图7为本发明中检测十字磁条时的示意图。

具体实施方式

具体实施方式一：参照图1至图7具体说明本实施方式，本实施方式所述的一种基于高精度磁导航传感器的磁条偏差角度的测量方法，它包括以下内容：

采用m个霍尔传感器组成一个闭环的圆形，检测一字磁条或十字磁条的磁场位置，每8个霍尔传感器将检测的数据经过一个数据锁存器进行锁存，MCU控制器以定时或不定时方式从个数据锁存器中获取磁条磁场数据，并经过计算及处理，通过CAN总线数据收发器以CAN总线将数据发送出去，AGV车的主控单元实时通过CAN总线获取一字磁条和十字磁条的角度偏差θ、AGV车与一字磁条的横向位置偏差DX和AGV车与十字磁条的横向位置偏差DX及纵向位置偏差DX，实现磁条偏差角度的测量。

具体实施方式二：本实施方式是对具体实施方式一所述的一种基于高精度磁导航传感器的磁条偏差角度的测量方法作进一步说明，本实施方式中，霍尔传感器的个数为180个。

本实施方式中，霍尔传感器的个数取180为检测精度最高。180个霍尔传感器的数据采用24个数据锁存器进行数据锁存，其中，22个数据锁存器中的每8个霍尔传感器将检测的数据经过一个数据锁存器进行锁存，剩下的4个霍尔传感器中的每2个霍尔传感器将检测的数据经过一个数据锁存器。