一种AGV陀螺仪导航传感器交互式漂移补偿方法及装置制造方法及图纸

本发明专利技术涉及一种AGV陀螺仪导航传感器交互式漂移补偿方法及装置，包括：三轴加速度计传感器单元，用于生成X、Y、Z三个矢量方向的加速度数据送至数据采集单元；数据采集单元，用来采集三轴加速度数据和陀螺仪传感器角速度、温度数据；数据处理单元，用于对采集的加速度数据进行滤波分析，判断AGV车体是否处于静止状态，执行漂移补偿数值计算并将漂移补偿值送至漂移补偿执行单元；漂移补偿执行单元，用于更新漂移补偿值并发送至陀螺仪传感器。本发明专利技术通过采取漂移补偿装置进行实时漂移补偿与上位机漂移补偿指令补偿两种方式结合的补偿方式，能够在AGV运行过程中给予陀螺仪传感器实时的，交互式的漂移补偿，最大限度的纠正偏移误差，提高陀螺仪设备的导航精度。

An interactive drift compensation method and device for AGV gyroscope navigation sensor

【技术实现步骤摘要】
一种AGV陀螺仪导航传感器交互式漂移补偿方法及装置
本专利技术属于AGV陀螺仪导航领域。
技术介绍
陀螺仪导航是AGV领域中近年来新兴的导航技术，陀螺仪导航是AGV导航中不易受到干扰的自主式导航系统。AGV车体通过陀螺仪传感器测量载体在惯性参考系的角速度，从而获得车体航偏角和位置等数据，适用于智能仓储物流、车间移动装配等各种复杂地理环境和外界干扰下的精确定向和定位。但是由于陀螺仪传感器硬件特性限制，陀螺仪传感器芯片受外界环境，尤其是温度的影响较大，导致其输出精度下降，最终导致AGV运行稳定性下降。针对这种情况，陀螺仪厂商普遍采取温度标定方法对陀螺仪传感器进行温度漂移补偿，可以在一定程度上弥补陀螺仪对温度敏感所带来的漂移。但这种方法的局限性在于，温度标定是根据历史数据拟合标定的一组数据，在实际应用中仍受AGV运行环境的各种因素影响，如温度变化速率、振动、电场磁场、湿度、气压等，而陀螺仪传感器无法实时调整漂移补偿量，使得AGV在长时间、环境复杂情况下的导航精度和稳定性无法得到有效保证。
技术实现思路
针对现有技术的不足，本专利技术提供一种AGV陀螺仪导航传感器交互式漂移补偿方法及装置，相较现有技术，在AGV运行过程中以多种方式与陀螺仪导航传感器进行实时的，交互式的漂移补偿，最大限度的纠正偏移误差，提高AGV陀螺仪导航设备的导航精度。本专利技术解决其技术问题所采用的技术方案是：一种AGV陀螺仪导航传感器交互式漂移补偿装置，包括：三轴加速度计传感器单元，用于生成加速度数据送至数据采集单元；数据采集单元，用来采集三轴加速度数据和陀螺仪传感器角速度、温度数据；数据处理单元，用于对采集的加速度数据进行滤波分析，判断AGV车体是否处于静止状态，执行漂移补偿数值计算并将漂移补偿值送至漂移补偿执行单元；漂移补偿执行单元，用于更新漂移补偿值并发送至陀螺仪传感器。所述数据采集单元通过SPI总线连接三轴加速度计传感器单元，在AGV上电启动后实时采集三轴加速度数据、陀螺仪角速度、温度数据。所述数据处理单元含有计数器，用于累加或清零。一种AGV陀螺仪导航传感器交互式漂移补偿方法，包括以下步骤：在AGV和陀螺仪传感器上电启动后，上位机控制陀螺仪传感器进行AGV运行前的第一次漂移补偿，补偿时间为若干秒；在AGV运行过程中，漂移补偿装置通过实时采集三轴加速度计传感器单元数据，处理并判断当前AGV运行状态；当AGV车体处于静止状态时间达到设定时间时，则漂移补偿装置对陀螺仪导航传感器进行一次漂移补偿；在AGV运行时，上位机根据AGV运行情况向陀螺仪传感器发送漂移指令，陀螺仪传感器进行漂移补偿。所述上位机控制陀螺仪传感器进行AGV运行前的第一次漂移补偿，包括以下步骤：上位机向陀螺仪传感器发送漂移补偿开始指令，此时数据采集单元以设定频率采集陀螺仪传感器输出的角速度数据并计数；达到预设的漂移补偿时长后，上位机向陀螺仪传感器发送漂移补偿结束指令，陀螺仪传感器通知数据采集单元停止数据采集，数据处理单元计算采集的角速度数据均值，将均值作为新的漂移补偿值，通过漂移补偿执行单元更新并发送陀螺仪传感器漂移补偿值至陀螺仪传感器。所述漂移补偿装置通过实时采集三轴加速度计传感器单元数据，处理并判断当前AGV运行状态具体如下：数据处理单元内的计数器初始化值为0，每次接收数据采集单元的三个方向加速度数据时，数据处理单元将该数据与上一次采集的数据做差值计算；如果差值绝对值低于阈值，则AGV车体处于静止状态，计数器加1，同时保存当前陀螺仪传感器漂移值；否则，AGV车体未处于静止状态，计数器清零，并清除历史陀螺仪漂移值。所述漂移补偿装置对陀螺仪导航传感器进行一次漂移补偿具体为：当计数器值累加至限值，数据处理单元计算限值个数的陀螺仪漂移值的平均值，送入漂移补偿执行单元更新为新的陀螺仪漂移值，并将新的陀螺仪漂移值发送至陀螺仪导航传感器；陀螺仪导航传感器发送漂移补偿完毕指令至上位机。所述上位机根据AGV运行情况向陀螺仪传感器发送漂移指令，包括以下步骤：当遇到下列情形中的至少一种，上位机控制AGV停止运行，并发送漂移补偿指令，补偿时间若干秒钟；再启动AGV继续运行：当上位机检测到陀螺仪传感器温度发生超出设定范围的变化时；当上位机检测到陀螺仪传感器在设定时间内未进行过漂移补偿时；当AGV通过指定的行走路线之前。本专利技术具有以下有益效果及优点：在AGV和陀螺仪导航传感器上电启动后，上位机通过漂移补偿指令进行第一次漂移补偿，保证了AGV运行前导航精度；在AGV运行过程中，通过三轴加速度计判断AGV是否处于静止状态从而可在短时间内多次执行漂移补偿，保证了AGV运行过程中的导航精度；在AGV通过复杂行走路线前或检测到漂移补偿长时间未运行时，上位机可通过指令进行一次漂移补偿，通过上位机交互式漂移补偿，最大限度的纠正偏移误差，提高AGV陀螺仪导航传感器的精度和稳定性。附图说明图1是本专利技术的交互式漂移补偿方法流程图；图2是本专利技术的装置结构框图。具体实施方式下面结合实施例对本专利技术做进一步的详细说明。一种AGV陀螺仪导航传感器交互式漂移补偿方法，包括：在AGV和陀螺仪导航传感器上电启动后，上位机向陀螺仪导航传感器发送漂移补偿指令，进行第一次漂移补偿；在AGV运行过程中，漂移补偿装置实时判断当前AGV运行状态，并在AGV静止状态下对陀螺仪导航传感器进行漂移补偿，此过程在AGV运行过程中自动、重复执行；上位机可根据AGV运行实际情况在一些特定条件下发送漂移指令进行漂移补偿。上位机与陀螺仪导航传感器采用标准CAN总线通讯协议，第一次漂移补偿时长为8秒，数据采集单元采集8秒内陀螺仪传感器漂移数据，交给数据处理单元经过计算处理，最终通过漂移补偿执行单元更新陀螺仪传感器的漂移补偿值。数据采集单元在AGV运行过程中以100Hz频率实时采集三轴加速度计X、Y和Z三个方向的加速度数据和陀螺仪传感器漂移值，加速度数据交给数据处理单元通过中值滤波处理，依此判断AGV车体是否处于静止状态。数据处理单元内置计数器，计数器初始化值为0，每次数据采集单元将三个方向加速度数据交给数据处理单元时，数据处理单元将该数据与上一次采集的数据做差值计算，如果绝对值低于设定阈值时，判定为静止状态，计数器加1，同时保存当前陀螺仪传感器漂移值，否则，计数器清零，并清除历史陀螺仪漂移值。若计数器值累加至2000，数据处理单元计算陀螺仪漂移平均值，通过漂移补偿执行单元更新陀螺仪漂移补偿数据，同时向上位机发送漂移补偿完毕指令。上位机能够根据AGV运行情况，在以下情况发送漂移补偿指令进行漂移补偿：当上位机检测到陀螺仪传感器温度发生较大变动时，上位机可以在适当时刻停止AGV运行，并发送漂移补偿指令，补偿时间5秒钟；当上位机检测到陀螺仪传感器在设定时间段内本文档来自技高网...

【技术保护点】
1.一种AGV陀螺仪导航传感器交互式漂移补偿装置，其特征在于包括：/n三轴加速度计传感器单元，用于生成加速度数据送至数据采集单元；/n数据采集单元，用来采集三轴加速度数据和陀螺仪传感器角速度、温度数据；/n数据处理单元，用于对采集的加速度数据进行滤波分析，判断AGV车体是否处于静止状态，执行漂移补偿数值计算并将漂移补偿值送至漂移补偿执行单元；/n漂移补偿执行单元，用于更新漂移补偿值并发送至陀螺仪传感器。/n

【技术特征摘要】
1.一种AGV陀螺仪导航传感器交互式漂移补偿装置，其特征在于包括：
三轴加速度计传感器单元，用于生成加速度数据送至数据采集单元；
数据采集单元，用来采集三轴加速度数据和陀螺仪传感器角速度、温度数据；
数据处理单元，用于对采集的加速度数据进行滤波分析，判断AGV车体是否处于静止状态，执行漂移补偿数值计算并将漂移补偿值送至漂移补偿执行单元；
漂移补偿执行单元，用于更新漂移补偿值并发送至陀螺仪传感器。


2.根据权利要求1所述的一种AGV陀螺仪导航传感器交互式漂移补偿装置，其特征在于：，所述数据采集单元通过SPI总线连接三轴加速度计传感器单元，在AGV上电启动后实时采集三轴加速度数据、陀螺仪角速度、温度数据。


3.根据权利要求1所述的一种AGV陀螺仪导航传感器交互式漂移补偿装置，其特征在于，所述数据处理单元含有计数器，用于累加或清零。


4.一种AGV陀螺仪导航传感器交互式漂移补偿方法，其特征在于包括以下步骤：
在AGV和陀螺仪传感器上电启动后，上位机控制陀螺仪传感器进行AGV运行前的第一次漂移补偿，补偿时间为若干秒；
在AGV运行过程中，漂移补偿装置通过实时采集三轴加速度计传感器单元数据，处理并判断当前AGV运行状态；当AGV车体处于静止状态时间达到设定时间时，则漂移补偿装置对陀螺仪导航传感器进行一次漂移补偿；
在AGV运行时，上位机根据AGV运行情况向陀螺仪传感器发送漂移指令，陀螺仪传感器进行漂移补偿。


5.根据权利要求4所述的一种AGV陀螺仪导航传感器交互式漂移补偿方法，其特征在于，所述上位机控制陀螺仪传感器进行AGV运行前的第一次漂移补偿，包括以下步骤：
上位机向陀螺仪传感器发送漂移补偿开始指令，此时数据采集单元以设定频率采集陀螺仪传感器输出的角速度数...

【专利技术属性】
技术研发人员：张雷，刘帅，史晓斌，曹智荀，
申请(专利权)人：沈阳新松机器人自动化股份有限公司，
类型：发明
国别省市：辽宁;21