【技术实现步骤摘要】
一种AGV陀螺仪导航传感器交互式漂移补偿方法及装置
本专利技术属于AGV陀螺仪导航领域。
技术介绍
陀螺仪导航是AGV领域中近年来新兴的导航技术,陀螺仪导航是AGV导航中不易受到干扰的自主式导航系统。AGV车体通过陀螺仪传感器测量载体在惯性参考系的角速度,从而获得车体航偏角和位置等数据,适用于智能仓储物流、车间移动装配等各种复杂地理环境和外界干扰下的精确定向和定位。但是由于陀螺仪传感器硬件特性限制,陀螺仪传感器芯片受外界环境,尤其是温度的影响较大,导致其输出精度下降,最终导致AGV运行稳定性下降。针对这种情况,陀螺仪厂商普遍采取温度标定方法对陀螺仪传感器进行温度漂移补偿,可以在一定程度上弥补陀螺仪对温度敏感所带来的漂移。但这种方法的局限性在于,温度标定是根据历史数据拟合标定的一组数据,在实际应用中仍受AGV运行环境的各种因素影响,如温度变化速率、振动、电场磁场、湿度、气压等,而陀螺仪传感器无法实时调整漂移补偿量,使得AGV在长时间、环境复杂情况下的导航精度和稳定性无法得到有效保证。
技术实现思路
...
【技术保护点】
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
还没有人留言评论。发表了对其他浏览者有用的留言会获得科技券。