[发明专利]一种AGV小车导航方法

权利要求书

1.一种AGV小车导航方法，其特征在于，包括设置在地面上的金属带以及设置在小车上的检测组件，所述检测组件包括按阵列设置的多个传感器，多个传感器分为多列并形成阵列组，每个阵列组均朝向小车移动方向排布，传感器用于检测金属带并进行状态触发；

在小车移动时，每个传感器均工作并输出检测的状态；

根据所有传感器的输出状态进行传感器的分值的积分；

通过积分以及触发传感器的在阵列组中的位置进行轮控计算，控制小车的车轮运动方式实现姿态控制；

实时积分和姿态控制使小车沿金属带持续行走。

2.如权利要求1所述的AGV小车导航方法，其特征在于，所述传感器的状态分为0和1,检测到金属带时，传感器输出检测的状态为1，输出检测的状态为1的传感器的分值总和为积分的数值。

3.如权利要求2所述的AGV小车导航方法，其特征在于，每个阵列组中的传感器分值均不同，并且从小车的首端至尾端依次增加，沿小车前进方向的轴向两侧的阵列组的传感器分别记为负分值和正分值，根据状态积分的数值，通过非线性函数计算，分别对小车的四个车轮的旋转方向、旋转角度及当前速度状态进行控制。

4.如权利要求3所述的AGV小车导航方法，其特征在于，以检测组件位于小车前进方向的轴向作为对称中心，将对称中心处设置为微调区，在微调区两侧设置为调整区，在两个调整区外侧设置为刹车控制区。

微调区内的传感器分值之和小于调整区内的传感器分值之和，当刹车控制区的传感器触发时，启动刹车控制，刹车的快慢，强度的大小由积分数值决定。

5.如权利要求1所述的AGV小车导航方法，其特征在于，所述小车在使用前先进行传感器安装距离调整和校核，并对传感器的状态进行复位。

6.如权利要求3所述的AGV小车导航方法，其特征在于，所述姿态控制包括小车的四个车轮的旋转方向、旋转角度及当前的速度状态。

7.如权利要求6所述的AGV小车导航方法，其特征在于，当进行姿态控制时，积分器采集传感器的状态数据并送入轮角向量控制器内，轮角向量控制器通过状态数据进行旋转方向判断和旋转角度计算；

当旋转方向和旋转角度均0或设定的极小值时，代表直线行走，无需调整姿态，小车的四个车轮保持或者加速运行；

当旋转方向出现正负时，正和负分别对应左旋和右旋，然后分别对小车的四个车轮进行旋转方向控制，根据旋转角度对四个车轮进行姿态调整，并根据调整的旋转角度，小车的四个车轮分别单独控制，保持或者减速运行。

8.如权利要求1所述的AGV小车导航方法，其特征在于，所述传感器为光电传感器或者磁性传感器。

9.如权利要求1所述的AGV小车导航方法，其特征在于，所述金属带为合金钢带。

10.如权利要求1所述的AGV小车导航方法，其特征在于，在校核状态外且为行驶状态时，当所有传感器触发或所有传感器不触发时，小车均进行刹车并停止运行；并根据系统设定的其他识别标志决定发出到位停止信号或异常停止信号。