CN112346468A - 一种自动引导运输车运动监控方法、系统及电子设备 - Google Patents

一种自动引导运输车运动监控方法、系统及电子设备 Download PDF

Info

Publication number
CN112346468A
CN112346468A CN202011044771.2A CN202011044771A CN112346468A CN 112346468 A CN112346468 A CN 112346468A CN 202011044771 A CN202011044771 A CN 202011044771A CN 112346468 A CN112346468 A CN 112346468A
Authority
CN
China
Prior art keywords
motion
automatic guided
inclination angle
guided vehicle
representing
Prior art date
Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
Pending
Application number
CN202011044771.2A
Other languages
English (en)
Inventor
马骁
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
CASIC Defense Technology Research and Test Center
Original Assignee
CASIC Defense Technology Research and Test Center
Priority date (The priority date is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the date listed.)
Filing date
Publication date
Application filed by CASIC Defense Technology Research and Test Center filed Critical CASIC Defense Technology Research and Test Center
Priority to CN202011044771.2A priority Critical patent/CN112346468A/zh
Publication of CN112346468A publication Critical patent/CN112346468A/zh
Pending legal-status Critical Current

Links

Images

Classifications

    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05DSYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D1/00Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
    • G05D1/08Control of attitude, i.e. control of roll, pitch, or yaw
    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05DSYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D1/00Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
    • G05D1/08Control of attitude, i.e. control of roll, pitch, or yaw
    • G05D1/0891Control of attitude, i.e. control of roll, pitch, or yaw specially adapted for land vehicles

Landscapes

  • Engineering & Computer Science (AREA)
  • Aviation & Aerospace Engineering (AREA)
  • Radar, Positioning & Navigation (AREA)
  • Remote Sensing (AREA)
  • Physics & Mathematics (AREA)
  • General Physics & Mathematics (AREA)
  • Automation & Control Theory (AREA)
  • Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)

Abstract

本申请中一个或多个实施例提供一种自动引导运输车运动监控方法、系统及电子设备,包括:采集自动引导运输车的运动数据;根据运动数据确定倾角预测值X(k|k);比较倾角预测值X(k|k)和预设倾角阈值以得到比较结果;根据比较结果控制自动引导运输车的运动状态。通过在自动引导运输车设置加速度计和陀螺仪,采集小车倾斜角度信息,并通过与预设倾角阈值的判定结果,控制自动引导运输车的运动状态,并在预测到自动引导运输车倾斜角超出阈值后,及时停止自动引导运输车的运行,并发出告警信息,达到在自动引导运输车行进过程中的安全预警的效果。

Description

一种自动引导运输车运动监控方法、系统及电子设备
技术领域
本申请中一个或多个实施例涉及状态监控技术领域,尤其涉及一种自动引导运输车运动监控方法、系统及电子设备。
背景技术
现有技术中,电子元器件在进行可靠性筛选试验时,传统方法是需要通过人工使用专用托盘运输电子元器件在不同作业区域之间转运,而随着自动化和智能化检测运输装置的普及,现有技术引入自动引导运输车进行电子元器件的运输。自动引导运输车需要保证按照预定路径到指定区域按照指定指令传递使用专用托盘承装的不同大小和封装的电子元器件,这就对该自动引导运输车的运动控制系统的平衡控制性能提出了更高的要求,若自动引导运输车在移动过程中发生冲击会发生器件堆叠,甚至掉落的状态,严重影响电子元器件的性能测试结果。而现有技术中无法保证实时监控自动引导运输车在行进过程中的倾斜角度,无法通过对自动引导运输车行进过程中的倾斜角度的预测进行安全预警。
发明内容
有鉴于此,本申请中一个或多个实施例的目的在于提出一种自动引导运输车运动监控方法、系统及电子设备,以解决现有技术无法实时监控并预测自动引导运输车行进过程中的倾斜角度进行安全预警的问题。
基于上述目的,本申请中一个或多个实施例提供了一种自动引导运输车运动监控方法,包括:
采集自动引导运输车的运动数据;
根据所述运动数据确定倾角预测值X(k|k)
比较所述倾角预测值X(k|k)和预设倾角阈值以得到比较结果;
根据所述比较结果控制所述自动引导运输车的运动状态。
可选的,所述采集自动引导运输车的运动数据,包括:
所述运动数据,包括:运动倾角
Figure BDA0002707652030000021
和运动倾角角速度ωgyro
根据所述自动引导运输车的加速度计采集所述运动倾角
Figure BDA0002707652030000022
根据所述自动引导运输车的陀螺仪确定所述运动倾角角速度ωgyro
可选的,所述根据所述运动数据确定倾角预测值,包括:
根据所述运动数据,建立运动系统模型,所述运动系统模型表示为
Figure BDA0002707652030000023
其中,
Figure BDA0002707652030000024
表示所述自动引导运输车的真实倾斜角度,
Figure BDA0002707652030000025
表示所述陀螺仪的常值偏差,wg表示所述陀螺仪的测量噪声,wq表示所述加速度计的测量噪声。
可选的,还包括:
根据所述运动数据确定k时刻倾角预测变量X(k|k-1),所述k时刻倾角预测变量X(k|k-1)表示为
X(k|k-1)=AX(k-1|k-1)+Bωgyro+w(k)
其中,A表示状态转移矩阵,
Figure BDA0002707652030000026
Ts表示采样周期,B表示控制输入矩阵,
Figure BDA0002707652030000027
X(k-1|k-1)表示k-1时刻倾角预测变量,
Figure BDA0002707652030000028
w(k)表示过程噪声。
可选的,在确定所述k时刻倾角预测变量X(k|k-1)后,利用k时刻先验误差协方差矩阵P(k|k-1)验证所述k时刻倾角预测变量X(k|k-1)准确度;所述k时刻先验误差协方差矩阵P(k|k-1)表示为
P(k|k-1)=AP(k-1|k-1)AT+Qk
其中,P(k-1|k-1)表示k-1时刻先验误差协方差矩阵,AT表示状态转移矩阵的转置矩阵,Qk表示所述加速度计和陀螺仪偏差的状态估计协方差矩阵。
可选的,还包括:
基于卡尔曼滤波算法确定所述k时刻先验误差协方差矩阵P(k|k-1)的卡尔曼增益Kg(k)以评价所述k时刻先验误差协方差矩阵P(k|k-1)的可信度;所述k时刻先验误差协方差矩阵P(k|k-1)的卡尔曼增益Kg(k)表示为
Kg(k)=P(k|k-1)HTSK(k) -1
其中,HT表示观测矩阵H的转置矩阵,SK(k)表示k时刻新息协方差。
可选的,还包括:
基于所述k时刻倾角预测变量X(k|k-1)和k时刻先验误差协方差矩阵P(k|k-1)的卡尔曼增益Kg(k)确定所述倾角预测值X(k|k),所述倾角预测值X(k|k)表示为
X(k|k)=X(k|k-1)+Kg(k)yk(k)
其中,yk(k)表示k时刻新息。
可选的,所述比较所述倾角预测值X(k|k)和预设倾角阈值以得到比较结果,包括:
所述比较结果,包括:正常状态和告警状态;
判断所述倾角预测值X(k|k)是否超过所述预设倾角阈值;
若超过,则所述自动引导运输车处于所述告警状态,更改所述自动引导运输车的运动状态;
若不超过,则所述自动引导运输车处于所述正常状态,保持所述自动引导运输车的运动状态。
基于同一发明构思,本申请一个或多个实施例还提出了一种自动引导运输车运动监控系统,包括:
采集模块,被配置为采集自动引导运输车的运动数据;
预测模块,被配置为根据所述运动数据确定倾角预测值X(k|k)
比较模块,被配置为比较所述倾角预测值X(k|k)和预设倾角阈值以得到比较结果;
控制模块,被配置为根据所述比较结果控制所述自动引导运输车的运动状态。
基于同一发明构思,本申请一个或多个实施例还提出了一种电子设备,包括存储器、处理器及存储在存储器上并可在处理器上运行的计算机程序,其特征在于,所述处理器执行所述程序时实现如上任意一种所述的方法。
从上面所述可以看出,本申请中一个或多个实施例提供的一种自动引导运输车运动监控方法、系统及电子设备,包括:采集自动引导运输车的运动数据,利用加速度计和陀螺仪采集自动引导运输车在行进过程中的运动数据,实时监测自动引导运输车上承载电子元器件的专用托盘在自动引导运输车行进过程中的倾斜角度;根据所述运动数据确定倾角预测值X(k|k),通过采集到的运动数据,得到一个基于加速度计和陀螺仪组成的组合传感器的数据融合角度值来估算自动引导运输车在转送电子元器件的运动过程中的倾斜角度预测值;比较所述倾角预测值X(k|k)和预设倾角阈值以得到比较结果,通过比较得到的倾角预测值X(k|k)和预设倾角阈值,如果倾角预测值X(k|k)超过预设倾角阈值,则证明自动引导运输车在运动过程中的倾斜角度超过电子元器件可承受的倾斜角度,需要对自动引导运输车的运动状态进行控制;根据所述比较结果控制所述自动引导运输车的运动状态,通过比较结果判定自动引导运输车处于倾斜角度正常的正常状态还是倾斜角度超出极限的告警状态,进一步控制自动引导运输车的运动状态,达到在自动引导运输车行进过程中的安全预警的效果。
附图说明
为了更清楚地说明本申请中一个或多个实施例或现有技术中的技术方案,下面将对实施例或现有技术描述中所需要使用的附图作简单地介绍,显而易见地,下面描述中的附图仅仅是本申请中一个或多个实施例,对于本领域普通技术人员来讲,在不付出创造性劳动的前提下,还可以根据这些附图获得其他的附图。
图1为本申请中一个或多个实施例中自动引导运输车运动监控方法的流程图;
图2为本申请中一个或多个实施例中运动系统的结构示意图;
图3为本申请中一个或多个实施例中一种自动引导运输车运动监控系统的结构示意图;
图4为本申请中一个或多个实施例中电子设备示意图。
具体实施方式
为使本公开的目的、技术方案和优点更加清楚明白,以下结合具体实施例,并参照附图,对本公开进一步详细说明。
需要说明的是,除非另外定义,本申请中一个或多个实施例使用的技术术语或者科学术语应当为本公开所属领域内具有一般技能的人士所理解的通常意义。本申请中一个或多个实施例中使用的“第一”、“第二”以及类似的词语并不表示任何顺序、数量或者重要性,而只是用来区分不同的组成部分。“包括”或者“包含”等类似的词语意指出现该词前面的元件或者物件涵盖出现在该词后面列举的元件或者物件及其等同,而不排除其他元件或者物件。“连接”或者“相连”等类似的词语并非限定于物理的或者机械的连接,而是可以包括电性的连接,不管是直接的还是间接的。“上”、“下”、“左”、“右”等仅用于表示相对位置关系,当被描述对象的绝对位置改变后,则该相对位置关系也可能相应地改变。
本申请中一个或多个实施例提供了一种自动引导运输车运动监控方法、系统及电子设备。
发明人通过研究发现当使用自动引导运输车进行电子元器件的转运时,自动引导运输车需要保证按照预定路径到指定区域按照指定指令传递使用专用托盘承装的不同大小和封装的电子元器件,这就对该自动引导运输车的运动控制系统的平衡控制性能提出了更高的要求,否则由于器件大小不一,管腿密度也不同,若自动引导运输车在移动过程中发生冲击会发生器件堆叠,甚至掉落的状态,严重影响电子元器件的性能测试结果。所以在转运过程中需要对自动引导运输车的稳定性进行严格监督,在托盘发生倾斜的时候,需要通过运动控制系统对自动引导运输车行进过程中的倾斜角度进行监控,在发生威胁到器件安全的角度对行进状态进行改变,同时产生预警。所以现有技术存在无法实时监控并预测自动引导运输车行进过程中的倾斜角度进行安全预警的问题。
参考图1,因此本申请中一个或多个实施例提供的一种自动引导运输车运动监控方法,包括:
S101采集自动引导运输车的运动数据。
本实施例中,自动引导运输车的运动数据,包括:运动倾角
Figure BDA0002707652030000051
和运动倾角角速度ωgyro。通过在自动引导运输车中设置倾角采集子系统和陀螺仪,利用倾角采集子系统中的加速度计采集自动引导运输车的运动倾角
Figure BDA0002707652030000061
利用陀螺仪采集自动引导运输车的运动倾角角速度ωgyro,通过陀螺仪对自动引导运输车实现自动引导的同时加入加速度计对运输托盘相对于自动引导运输车的倾斜角度进行实时监控的组合传感器构成运动系统,能够准确的采集自动引导运输车的运动数据。当安装于承载电子元器件的专用托盘上的倾角采集子系统放置于自动引导运输车车体上时,加速度计能够获得静态输出的水平倾角
Figure BDA0002707652030000062
和垂直滚动角θy,二者组合得到运动倾角
Figure BDA0002707652030000063
但此时的运动倾角
Figure BDA0002707652030000064
中存在固定偏差;当自动引导运输车开始运动后,动态响应较好的陀螺仪会直接输出相对于灵敏轴的角速度,即运动倾角角速度ωgyro,运动倾角角速度ωgyro对时间积分能够得到围绕灵敏轴旋转过的角度值,但是由于温度变化、摩擦力、不稳定力矩等因素,陀螺仪会产生漂移误差,且运动倾角角速度ωgyro中也存在固有偏差,而无论多么小的偏差通过积分后都会得到无限大的角度误差,所以需要对运动倾角
Figure BDA0002707652030000065
和运动倾角角速度ωgyro进行进一步的数据处理。
S102根据所述运动数据确定倾角预测值X(k|k)
本实施例中,参考图2,根据安装于自动引导运输车的倾角采集子系统和陀螺仪进行运动系统的构建,包括:含上位控制器的车体、倾角采集子系统、托盘、陀螺仪、编码器及车轮。其中φ表示航向偏角,正值表示由x轴方向转向y轴方向,即向右偏转,θ表示滚动角,正值表示由y轴方向转向z轴方向,即车体左侧抬高,ψ表示倾斜角,正值表示由x轴方向转向z轴方向,即坡度角,ωx表示自动引导运输车的滚动角速率,ωz表示自动引导运输车的摇动角速率,aL表示自动引导运输车的横向加速度,ay表示自动引导运输车的垂向加速度。在运动系统中,首先建立运动系统模型,由于运动倾角
Figure BDA0002707652030000066
和运动倾角角速度ωgyro之间存在导数关系,自动引导运输车的真实倾斜角度
Figure BDA0002707652030000067
可以看做一个状态向量,在运动系统中采用加速度计估计陀螺仪的常值偏差为
Figure BDA0002707652030000068
陀螺仪的常值偏差
Figure BDA0002707652030000069
也是陀螺仪漂移的大小,将陀螺仪的常值偏差
Figure BDA00027076520300000610
可以看做另一个状态向量,从而根据自动引导运输车的真实倾斜角度
Figure BDA00027076520300000611
和陀螺仪的常值偏差
Figure BDA00027076520300000612
得到运动系统模型,表示为
Figure BDA0002707652030000071
其中,wg表示陀螺仪的测量噪声,wq表示加速度计的测量噪声,wg和wq相互独立,假设wg和wq均为满足正态分布的白色噪声,wg的方差为Q,wg~(0,Q),wq的方差为R,wq~(0,R)。
作为一个可选的实施例,对于自动引导运输车行进过程中的运动倾角
Figure BDA0002707652030000077
采用卡尔曼滤波方法来融合陀螺仪输出的运动倾角角速度ωgyro,补偿陀螺仪的偏移误差和加速度计的动态误差,得到一个基于加速度计和陀螺仪组合的传感器的数据融合角度值来估算自动引导运输车在转送电子元器件在运动过程中的倾角预测值,具体地,根据运动数据确定k时刻倾角预测变量X(k|k-1),k时刻倾角预测变量X(k|k-1)表示为
X(k|k-1)=AX(k-1|k-1)+Bωgyro+w(k)
其中,A表示状态转移矩阵,
Figure BDA0002707652030000072
Ts表示采样周期,B表示控制输入矩阵,
Figure BDA0002707652030000073
X(k-1|k-1)表示k-1时刻倾角预测变量,
Figure BDA0002707652030000074
w(k)表示过程噪声,w(k)~N(0,Qk),其中Qk是加速度计和陀螺仪偏差的状态估计协方差矩阵,它的表达式是:
Figure BDA0002707652030000075
qq表示加速度计测量时的置信度,qg表示陀螺仪测量时的置信度,qq和qg的数值分别代表卡尔曼滤波器对于加速度计和陀螺仪的数据的信任程度,数值越小,则信任程度越高,在本申请中的运动系统中,陀螺仪的值更加接近准确值,因此qg的值小于qq的值。传统的自动引导运输车在运动过程中的角度信息,仅仅是对通过陀螺仪输出的角速度进行计算后得到,但是在本申请提供的运动系统中,则是融合了倾角采集子系统的运动倾角
Figure BDA0002707652030000076
和陀螺仪的运动倾角角速度ωgyro,通过k-1时刻的倾角状态量,预测出k时刻倾角预测变量X(k|k-1)
作为一个可选的实施例,在确定k时刻倾角预测变量X(k|k-1)后,利用k时刻先验误差协方差矩阵P(k|k-1)验证k时刻倾角预测变量X(k|k-1)准确度;k时刻先验误差协方差矩阵P(k|k-1)表示为
P(k|k-1)=AP(k-1|k-1)AT+Qk
其中,P(k-1|k-1)表示k-1时刻先验误差协方差矩阵,AT表示状态转移矩阵A的转置矩阵。
作为一个可选的实施例,为了得到倾角预测值X(k|k)的最优值,可以利用加速度计和陀螺仪组合传感器预测状态在k时刻的新息反算出k时刻的理论测量值,再分析组合传感器在k时刻的实际测量值与k时刻的理论测量值,评价预测得到的理论测量值的准确度。首先,根据运动系统模型计算组合传感器在k时刻的测量值的预测值Z(k|k-1),具体表示为
Z(k|k-1)=HX(k|k-1)
其中,Z(k|k-1)是运动倾角
Figure BDA0002707652030000081
排除加速度计测量噪声wq后的加速度计得到的倾角角度值,代入H和X(k|k-1)的值代入后,得到
Figure BDA0002707652030000082
然后,根据加速度计实际测量的测量值Z(k)和组合传感器在k时刻的测量值的预测值Z(k|k-1)确定k时刻的新息yk(k),具体表示为
yk(k)=Z(k)-Z(k|k-1)
再通过计算k时刻的新息yk(k)的协方差SK(k),对k时刻的新息yk(k)进行评价,k时刻的新息yk(k)的协方差SK(k)具体表示为
SK(k)=HP(k|k-1)HT+R
其中,HT表示观测矩阵H的转置矩阵。
作为一个可选的实施例,基于卡尔曼滤波算法确定k时刻先验误差协方差矩阵P(k|k-1)的卡尔曼增益Kg(k)以评价k时刻先验误差协方差矩阵P(k|k-1)的可信度;k时刻先验误差协方差矩阵P(k|k-1)的卡尔曼增益Kg(k)表示为
Kg(k)=P(k|k-1)HTSK(k) -1
根据计算得到的卡尔曼增益Kg(k)调整组合传感器的测量值和预测值在计算倾角预测值X(k|k)过程中的权重,如果组合传感器的测量值的置信度更高,在计算倾角预测值X(k|k)过程中组合传感器的测量值的比重就会更高。
作为一个可选的实施例,基于k时刻倾角预测变量X(k|k-1)和k时刻先验误差协方差矩阵P(k|k-1)的卡尔曼增益Kg(k)确定倾角预测值X(k|k),倾角预测值X(k|k)表示为
X(k|k)=X(k|k-1)+Kg(k)yk(k)
倾角预测值X(k|k)是k时刻的倾角的最优估计值,但是为了使卡尔曼滤波不断的运行直到找到最优的倾角的角度值,还需要更新倾角预测值X(k|k)的协方差P(k|k),具体表示为
P(k|k)=(I-Kg(k)H)P(k|k-1)
其中,I表示单位矩阵。
S103比较所述倾角预测值X(k|k)和预设倾角阈值以得到比较结果。
本实施例中,在基于运动系统模型采用卡尔曼滤波方式对加速度计和陀螺仪组合传感器采集的数据进行融合后,得到了基于组合传感器的自动引导运输车的最优的倾角预测值X(k|k),相比于单独根据加速度计或陀螺仪得到的角度信息值更优,此时需要将得到的倾角预测值X(k|k)与预设倾角阈值进行比较,确定比较结果,根据比较结果进一步确定自动引导运输车的运动状态,以及是否需要对自动引导运输车的运动状态进行控制操作。参考表1,根据自动引导运输车运输的电子元器件种类的不同,以及封装形式的不同,设置不同的预设倾角阈值。具体地,比较结果,包括:正常状态和告警状态,判断倾角预测值X(k|k)是否超过所述预设倾角阈值,若超过,则自动引导运输车处于告警状态;若不超过,则自动引导运输车处于正常状态。
表1
Figure BDA0002707652030000091
Figure BDA0002707652030000101
S104根据所述比较结果控制所述自动引导运输车的运动状态。
本实施例中,根据步骤S103中比较倾角预测值X(k|k)和预设倾角阈值后得到的比较结果,对自动引导运输车的运动状态进行控制,具体包括:
当倾角预测值X(k|k)超过预设倾角阈值时,则自动引导运输车处于所述告警状态,更改自动引导运输车的运动状态,如果自动引导运输车处于行进的运动状态,需要发出报警信息,自动引导运输车警示灯闪烁并响起警示音,通过控制自动引导运输车内部编码器停止转动以控制自动引导运输车停止,如果自动引导运输车处于停止状态,则自动引导运输车继续保持停止状态,直至放置在自动引导运输车上的运输托盘的角度经过校正并达到可以行进状态的要求后,自动引导运输车方可继续执行运输工作;
当倾角预测值X(k|k)不超过预设倾角阈值时,则自动引导运输车处于正常状态,保持自动引导运输车的运动状态,不对自动引导运输车的运动状态进行改变,保持自动引导运输车继续运行。
从上面所述可以看出,本申请中一个或多个实施例提供的一种自动引导运输车运动监控方法、系统及电子设备,包括:采集自动引导运输车的运动数据,利用加速度计和陀螺仪采集自动引导运输车在行进过程中的运动数据,实时监测自动引导运输车上承载电子元器件的专用托盘在自动引导运输车行进过程中的倾斜角度;根据所述运动数据确定倾角预测值X(k|k),通过采集到的运动数据,得到一个基于加速度计和陀螺仪组成的组合传感器的数据融合角度值来估算自动引导运输车在转送电子元器件的运动过程中的倾斜角度预测值;比较所述倾角预测值X(k|k)和预设倾角阈值以得到比较结果,通过比较得到的倾角预测值X(k|k)和预设倾角阈值,如果倾角预测值X(k|k)超过预设倾角阈值,则证明自动引导运输车在运动过程中的倾斜角度超过电子元器件可承受的倾斜角度,需要对自动引导运输车的运动状态进行控制;根据所述比较结果控制所述自动引导运输车的运动状态,通过比较结果判定自动引导运输车处于倾斜角度正常的正常状态还是倾斜角度超出极限的告警状态,进一步控制自动引导运输车的运动状态,达到在自动引导运输车行进过程中的安全预警的效果。根据实际运输电子元器件的运输过程中的角度限制,具体对应设置预设倾角阈值,通过加速度计和陀螺仪的组合传感器的数据处理,使得自动引导运输车在移动过程中运动倾角
Figure BDA0002707652030000111
和运动倾角角速度ωgyro信息获取的精度有所提高,并通过卡尔曼滤波算法的核心思想和本申请一个或多个实施例提供的方法中的运动系统模型确定倾角预测值X(k|k),实时监控电子元器件在转运过程中的运动情况,对处于告警状态的自动引导运输车进行报警,有效预防自动引导运输车自动传送电子元器件过程中的冲击对器件造成的伤害,同时能够提高自动引导运输车的运输效率,提高了自动引导运输车运动过程中的稳定性和可靠性。
上述对本申请中特定实施例进行了描述。其它实施例在所附权利要求书的范围内。在一些情况下,在权利要求书中记载的动作或步骤可以按照不同于实施例中的顺序来执行并且仍然可以实现期望的结果。另外,在附图中描绘的过程不一定要求示出的特定顺序或者连续顺序才能实现期望的结果。在某些实施方式中,多任务处理和并行处理也是可以的或者可能是有利的。
基于同一发明构思,本说明书一个或多个实施例还提供了一种自动引导运输车运动监控系统,包括:采集模块、预测模块、比较模块和控制模块。
参考图3,本系统中包括:
采集模块,被配置为采集自动引导运输车的运动数据;
预测模块,被配置为根据所述运动数据确定倾角预测值X(k|k)
比较模块,被配置为比较所述倾角预测值X(k|k)和预设倾角阈值以得到比较结果;
控制模块,被配置为根据所述比较结果控制所述自动引导运输车的运动状态。
为了描述的方便,描述以上装置时以功能分为各种模块分别描述。当然,在实施本说明书一个或多个实施例时可以把各模块的功能在同一个或多个软件和/或硬件中实现。
上述实施例的装置用于实现前述实施例中相应的方法,并且具有相应的方法实施例的有益效果,在此不再赘述。
基于同一发明构思,本说明书一个或多个实施例还提供了一种电子设备,该电子设备,包括存储器、处理器及存储在存储器上并可在处理器上运行的计算机程序,所述处理器执行所述程序时实现如上任意一实施例所述的方法。
图4示出了本实施例所提供的一种更为具体的电子设备硬件结构示意图,该设备可以包括:处理器401、存储器402、输入/输出接口403、通信接口404和总线405。其中处理器401、存储器402、输入/输出接口403和通信接口404通过总线405实现彼此之间在设备内部的通信连接。
处理器401可以采用通用的CPU(Central Processing Unit,中央处理器)、微处理器、应用专用集成电路(Application Specific Integrated Circuit,ASIC)、或者一个或多个集成电路等方式实现,用于执行相关程序,以实现本说明书实施例所提供的技术方案。
存储器402可以采用ROM(Read Only Memory,只读存储器)、RAM(Random AccessMemory,随机存取存储器)、静态存储设备,动态存储设备等形式实现。存储器402可以存储操作系统和其他应用程序,在通过软件或者固件来实现本说明书实施例所提供的技术方案时,相关的程序代码保存在存储器402中,并由处理器401来调用执行。
输入/输出接口403用于连接输入/输出模块,以实现信息输入及输出。输入输出/模块可以作为组件配置在设备中(图中未示出),也可以外接于设备以提供相应功能。其中输入设备可以包括键盘、鼠标、触摸屏、麦克风、各类传感器等,输出设备可以包括显示器、扬声器、振动器、指示灯等。
通信接口404用于连接通信模块(图中未示出),以实现本设备与其他设备的通信交互。其中通信模块可以通过有线方式(例如USB、网线等)实现通信,也可以通过无线方式(例如移动网络、WIFI、蓝牙等)实现通信。
总线405包括一通路,在设备的各个组件(例如处理器401、存储器402、输入/输出接口403和通信接口404)之间传输信息。
需要说明的是,尽管上述设备仅示出了处理器401、存储器402、输入/输出接口403、通信接口404以及总线405,但是在具体实施过程中,该设备还可以包括实现正常运行所必需的其他组件。此外,本领域的技术人员可以理解的是,上述设备中也可以仅包含实现本说明书实施例方案所必需的组件,而不必包含图中所示的全部组件。
所属领域的普通技术人员应当理解:以上任何实施例的讨论仅为示例性的,并非旨在暗示本公开的范围(包括权利要求)被限于这些例子;在本公开的思路下,以上实施例或者不同实施例中的技术特征之间也可以进行组合,步骤可以以任意顺序实现,并存在如上所述的本申请中一个或多个实施例的不同方面的许多其它变化,为了简明它们没有在细节中提供。
本申请中一个或多个实施例旨在涵盖落入所附权利要求的宽泛范围之内的所有这样的替换、修改和变型。因此,凡在本申请中一个或多个实施例的精神和原则之内,所做的任何省略、修改、等同替换、改进等,均应包含在本公开的保护范围之内。

Claims (10)

1.一种自动引导运输车运动监控方法,其特征在于,包括:
采集自动引导运输车的运动数据;
根据所述运动数据确定倾角预测值X(k|k)
比较所述倾角预测值X(k|k)和预设倾角阈值以得到比较结果;
根据所述比较结果控制所述自动引导运输车的运动状态。
2.根据权利要求1所述的方法,其特征在于,所述采集自动引导运输车的运动数据,包括:
所述运动数据,包括:运动倾角
Figure FDA0002707652020000015
和运动倾角角速度ωgyro
根据所述自动引导运输车的加速度计采集所述运动倾角
Figure FDA0002707652020000016
根据所述自动引导运输车的陀螺仪确定所述运动倾角角速度ωgyro
3.根据权利要求2所述的方法,其特征在于,所述根据所述运动数据确定倾角预测值,包括:
根据所述运动数据,建立运动系统模型,所述运动系统模型表示为
Figure FDA0002707652020000011
其中,
Figure FDA0002707652020000012
表示所述自动引导运输车的真实倾斜角度,
Figure FDA0002707652020000013
表示所述陀螺仪的常值偏差,wg表示所述陀螺仪的测量噪声,wq表示所述加速度计的测量噪声。
4.根据权利要求3所述的方法,其特征在于,还包括:
根据所述运动数据确定k时刻倾角预测变量X(k|k-1),所述k时刻倾角预测变量X(k|k-1)表示为
X(k|k-1)=AX(k-1|k-1)+Bωgyro+w(k)
其中,A表示状态转移矩阵,
Figure FDA0002707652020000014
Ts表示采样周期,B表示控制输入矩阵,
Figure FDA0002707652020000021
X(k-1|k-1)表示k-1时刻倾角预测变量,
Figure FDA0002707652020000022
w(k)表示过程噪声。
5.根据权利要求4所述的方法,其特征在于,在确定所述k时刻倾角预测变量X(k|k-1)后,利用k时刻先验误差协方差矩阵P(k|k-1)验证所述k时刻倾角预测变量X(k|k-1)准确度;所述k时刻先验误差协方差矩阵P(k|k-1)表示为
P(k|k-1)=AP(k-1|k-1)AT+Qk
其中,P(k-1|k-1)表示k-1时刻先验误差协方差矩阵,AT表示所述状态转移矩阵A的转置矩阵,Qk表示所述加速度计和陀螺仪偏差的状态估计协方差矩阵。
6.根据权利要求5所述的方法,其特征在于,还包括:
基于卡尔曼滤波算法确定所述k时刻先验误差协方差矩阵P(k|k-1)的卡尔曼增益Kg(k)以评价所述k时刻先验误差协方差矩阵P(k|k-1)的可信度;所述k时刻先验误差协方差矩阵P(k|k-1)的卡尔曼增益Kg(k)表示为
Kg(k)=P(k|k-1)HTSK(k) -1
其中,HT表示观测矩阵H的转置矩阵,SK(k)表示k时刻新息协方差。
7.根据权利要求6所述的方法,其特征在于,还包括:
基于所述k时刻倾角预测变量X(k|k-1)和k时刻先验误差协方差矩阵P(k|k-1)的卡尔曼增益Kg(k)确定所述倾角预测值X(k|k),所述倾角预测值X(k|k)表示为
X(k|k)=X(k|k-1)+Kg(k)yk(k)
其中,yk(k)表示k时刻的新息。
8.根据权利要求1所述的方法,其特征在于,所述比较所述倾角预测值X(k|k)和预设倾角阈值以得到比较结果,包括:
所述比较结果,包括:正常状态和告警状态;
判断所述倾角预测值X(k|k)是否超过所述预设倾角阈值;
若超过,则所述自动引导运输车处于所述告警状态,更改所述自动引导运输车的运动状态;
若不超过,则所述自动引导运输车处于所述正常状态,保持所述自动引导运输车的运动状态。
9.一种自动引导运输车运动监控系统,其特征在于,包括:
采集模块,被配置为采集自动引导运输车的运动数据;
预测模块,被配置为根据所述运动数据确定倾角预测值X(k|k)
比较模块,被配置为比较所述倾角预测值X(k|k)和预设倾角阈值以得到比较结果;
控制模块,被配置为根据所述比较结果控制所述自动引导运输车的运动状态。
10.一种电子设备,包括存储器、处理器及存储在存储器上并可在处理器上运行的计算机程序,其特征在于,所述处理器执行所述程序时实现如权利要求1至8任意一项所述的方法。
CN202011044771.2A 2020-09-28 2020-09-28 一种自动引导运输车运动监控方法、系统及电子设备 Pending CN112346468A (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN202011044771.2A CN112346468A (zh) 2020-09-28 2020-09-28 一种自动引导运输车运动监控方法、系统及电子设备

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN202011044771.2A CN112346468A (zh) 2020-09-28 2020-09-28 一种自动引导运输车运动监控方法、系统及电子设备

Publications (1)

Publication Number Publication Date
CN112346468A true CN112346468A (zh) 2021-02-09

Family

ID=74361234

Family Applications (1)

Application Number Title Priority Date Filing Date
CN202011044771.2A Pending CN112346468A (zh) 2020-09-28 2020-09-28 一种自动引导运输车运动监控方法、系统及电子设备

Country Status (1)

Country Link
CN (1) CN112346468A (zh)

Cited By (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
WO2024022396A1 (zh) * 2022-07-27 2024-02-01 湖州丽天智能科技有限公司 光伏清洗机器人的自动纠偏方法、纠偏系统及清洗机器人

Citations (8)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN2188551Y (zh) * 1993-01-21 1995-02-01 杨东均 货物倾斜监测仪
KR20130086746A (ko) * 2012-01-26 2013-08-05 두산산업차량 주식회사 지게차의 화물 낙하 방지 장치 및 방법
CN105404296A (zh) * 2015-10-28 2016-03-16 南京师范大学 一种两轮自平衡智能车姿态控制方法
CN106176081A (zh) * 2016-07-05 2016-12-07 国家康复辅具研究中心 一种包含加速度传感器的电动轮椅车防倾翻装置及方法
CN106467059A (zh) * 2015-08-21 2017-03-01 深圳市赛格导航科技股份有限公司 一种基于三轴加速度传感器的侧翻报警方法和装置
CN110440799A (zh) * 2019-09-19 2019-11-12 哈尔滨工程大学 一种基于陀螺仪和加速度计的姿态角度测量融合系统及方法
CN110542417A (zh) * 2019-09-05 2019-12-06 武汉理工大学 基于静态和和动态倾角仪校正的陀螺仪线形测量方法与系统
CN110954103A (zh) * 2019-12-18 2020-04-03 无锡北微传感科技有限公司 基于mems传感器的车体动态姿态估计的方法及系统

Patent Citations (8)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN2188551Y (zh) * 1993-01-21 1995-02-01 杨东均 货物倾斜监测仪
KR20130086746A (ko) * 2012-01-26 2013-08-05 두산산업차량 주식회사 지게차의 화물 낙하 방지 장치 및 방법
CN106467059A (zh) * 2015-08-21 2017-03-01 深圳市赛格导航科技股份有限公司 一种基于三轴加速度传感器的侧翻报警方法和装置
CN105404296A (zh) * 2015-10-28 2016-03-16 南京师范大学 一种两轮自平衡智能车姿态控制方法
CN106176081A (zh) * 2016-07-05 2016-12-07 国家康复辅具研究中心 一种包含加速度传感器的电动轮椅车防倾翻装置及方法
CN110542417A (zh) * 2019-09-05 2019-12-06 武汉理工大学 基于静态和和动态倾角仪校正的陀螺仪线形测量方法与系统
CN110440799A (zh) * 2019-09-19 2019-11-12 哈尔滨工程大学 一种基于陀螺仪和加速度计的姿态角度测量融合系统及方法
CN110954103A (zh) * 2019-12-18 2020-04-03 无锡北微传感科技有限公司 基于mems传感器的车体动态姿态估计的方法及系统

Cited By (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
WO2024022396A1 (zh) * 2022-07-27 2024-02-01 湖州丽天智能科技有限公司 光伏清洗机器人的自动纠偏方法、纠偏系统及清洗机器人

Similar Documents

Publication Publication Date Title
US10466809B2 (en) Camera-assisted motion estimation for application control
US20200056904A1 (en) Technologies for pedestrian dead reckoning
US8000925B2 (en) Moving body with tilt angle estimating mechanism
US8200452B2 (en) Attitude-angle detecting apparatus and attitude-angle detecting method
CN113064433B (zh) 机器人迈步控制方法、装置、机器人控制设备及存储介质
CN107560613B (zh) 基于九轴惯性传感器的机器人室内轨迹跟踪系统及方法
JP3591130B2 (ja) ナビゲーション装置
US11903484B2 (en) Collision prevention control system based on electric lifting table and collision prevention method thereof
US9771240B2 (en) Inertial measurement unit assisted elevator position calibration
US9222237B1 (en) Earthmoving machine comprising weighted state estimator
CN113031639B (zh) 机器人步长处理方法、装置、机器人控制设备及存储介质
JP5419268B2 (ja) 三次元姿勢推定装置、三次元姿勢推定方法及び三次元姿勢推定プログラム
CN112346468A (zh) 一种自动引导运输车运动监控方法、系统及电子设备
KR101226767B1 (ko) 주행 장치를 위한 위치측정 시스템 및 방법
CN104819717B (zh) 一种基于mems惯性传感器组的多旋翼飞行器姿态检测方法
US11085801B2 (en) Physical quantity measuring apparatus
JP5565736B2 (ja) 計算装置、計算装置の制御方法、制御プログラム、及び記録媒体
CN113753759B (zh) 一种吊具定位方法、吊具定位装置及起重设备
JP6718166B1 (ja) 情報処理システム、情報処理装置、プログラム、及び情報処理方法
US20220042803A1 (en) Method for characterising an inertial measurement unit
JP5816879B2 (ja) 磁気式ジャイロ
CN113387274B (zh) 集卡车对位方法、系统及集装箱起重机
CN116337331B (zh) 水下机器人平衡检测方法、控制装置及设备
EP4375618A1 (en) Dynamic gravity vector estimation for memory constrained devices
JP2007064854A (ja) 姿勢角検出装置及び姿勢角検出用プログラム

Legal Events

Date Code Title Description
PB01 Publication
PB01 Publication
SE01 Entry into force of request for substantive examination
SE01 Entry into force of request for substantive examination