申请/专利权人:华晟(青岛)智能装备科技有限公司
申请日:2018-08-17
公开(公告)日:2021-09-17
公开(公告)号:CN109116845B
主分类号:G05D1/02(20200101)
分类号:G05D1/02(20200101)
优先权:
专利状态码:有效-授权
法律状态:2021.09.17#授权;2019.01.25#实质审查的生效;2019.01.01#公开
摘要:本发明公开一种自动导引运输车定位方法、定位系统及自动导引运输系统。本发明根据导航仪的最新采样时间和驱动轮传感器的最新采样时间的大小关系确定导航仪的期望位置。最终获得的导航仪位置的输出频率为驱动轮传感器采样频率与导航仪采样频率之和,由于驱动轮传感器的采样频率远高于导航仪的采样频率,因此,采用本发明提供的定位方法及定位系统能够有效提高AGV导航数据的更新频率,从而提高AGV控制算法频率,进而提高AGV整车控制精度,尤其在高速运动状态下,其优势尤其明显。本发明提供的自动导引运输系统,预测器的输出频率高,能够有效提高自动导引运输车的控制精度,尤其在高速运动状态下,其高精度的优势尤为突出。
主权项:1.一种自动导引运输车的定位方法,其特征在于,所述定位方法包括:根据目标自动导引运输车的轴距、导航仪的位姿角、驱动轮转向角和驱动轮转速确定所述目标自动导引运输车的状态预测模型,其中,所述目标自动导引运输车包括所述导航仪和所述驱动轮,所述状态预测模型的状态向量包括驱动轮位置和导航仪位姿角;获取第k-1个采样周期的所述驱动轮的位置坐标、第k-1个采样周期的位姿角、第k个采样周期的驱动轮实测转速、第k个采样周期的驱动轮转向角;将第k-1个采样周期的所述驱动轮的位置坐标、第k-1个采样周期的位姿角、第k个采样周期的驱动轮实测转速、第k个采样周期的驱动轮转向角输入所述状态预测模型,获得第k个采样周期的状态向量预测值;判断所述导航仪的最新采样时间是否小于驱动轮传感器的最新采样时间,获得判断结果;当所述判断结果表示所述导航仪的最新采样时间小于所述驱动轮传感器的最新采样时间时,则根据所述状态向量预测值、所述导航仪与所述驱动轮的距离确定所述导航仪的期望位置;所述根据所述状态向量预测值、所述导航仪与所述驱动轮的距离确定所述导航仪的期望位置,具体包括:获取所述导航仪与所述驱动轮的距离和所述导航仪与所述驱动轮的位置变换关系式,所述位置变换关系式为: 其中,xn,yn表示导航仪的位置坐标,xd,yd表示驱动轮的位置坐标,h表示导航仪与驱动轮的距离,ψ为位姿角;对所述位置变换关系式进行逆变换,获得导航仪位置预测模型;将所述状态向量预测值、所述导航仪与所述驱动轮的距离输入所述导航仪位置预测模型,获得所述导航仪的期望位置;当所述判断结果表示所述导航仪的最新采样时间大于或者等于所述驱动轮传感器的最新采样时间时,根据所述状态向量预测值、第k个采样周期的位姿角、第k个采样周期的导航仪实测位置确定所述导航仪的期望位置。
全文数据:自动导引运输车定位方法、定位系统及自动导引运输系统技术领域本发明涉及自动导引运输技术领域,特别是涉及一种自动导引运输车定位方法、定位系统及自动导引运输系统。背景技术自动导引运输车AutomatedGuidedVehicle,AGV激光导航仪的定位原理,是通过自转扫描其周边一定数量的反光桶获取位置信息,并计算当前坐标和角度。其数据输出频率主要受限于扫描仪的物理自转频率,目前行业内主流导航仪如sick2-2NAV350最高输出频率均低于8HZ。AGV对于定位精度要求较高,而低频的导航仪数据使得控制器往往无法将AGV控制在允许精度范围内,尤其在高速运动过程中。因此,如何提高AGV的定位精度,成为本领域技术人员亟需解决的技术问题。发明内容本发明的目的是提供一种自动导引运输车定位方法、定位系统及自动导引运输系统,能够有效提高AGV导航数据的更新频率,从而提高AGV控制算法频率,进而提高AGV整车控制精度,尤其在高速运动状态下,其优势尤其明显。为实现上述目的,本发明提供了如下方案:一种自动导引运输车的定位方法,所述定位方法包括:根据目标自动导引运输车的轴距、导航仪的位姿角、驱动轮转向角和驱动轮转速确定所述目标自动导引运输车的状态预测模型,其中,所述目标自动导引运输车包括所述导航仪和所述驱动轮,所述状态预测模型的状态向量包括驱动轮位置和导航仪位姿角;获取第k-1个采样周期的所述驱动轮的位置坐标、第k-1个采样周期的位姿角、第k个采样周期的驱动轮实测转速、第k个采样周期的驱动轮转向角;将第k-1个采样周期的所述驱动轮的位置坐标、第k-1个采样周期的位姿角、第k个采样周期的驱动轮实测转速、第k个采样周期的驱动轮转向角输入所述状态预测模型,获得第k个采样周期的状态向量预测值;判断所述导航仪的最新采样时间是否小于所述驱动轮传感器的最新采样时间,获得判断结果;当所述判断结果表示所述导航仪的最新采样时间小于所述驱动轮传感器的最新采样时间时,则根据所述状态向量预测值、所述导航仪与所述驱动轮的距离确定所述导航仪的期望位置;当所述判断结果表示所述导航仪的最新采样时间大于或者等于所述驱动轮传感器的最新采样时间时,根据所述状态向量预测值、第k个采样周期的位姿角、第k个采样周期的导航仪实测位置确定所述导航仪的期望位置。可选的,所述状态预测模型为:其中,表示第k个采样周期的状态向量预测值,表示驱动轮的横坐标预测值,表示驱动轮的纵坐标预测值,表示导航仪位姿角预测值,Δt表示驱动轮传感器的采样周期,v表示驱动轮的实测转速,表示驱动轮的加速度估值,θk表示驱动轮转向角,可选的,所述根据所述状态向量预测值、所述导航仪与所述驱动轮的距离确定所述导航仪的期望位置,具体包括:获取所述导航仪与所述驱动轮的距离和所述导航仪与所述驱动轮的位置变换关系式,所述位置变换关系式为:其中,xn,yn表示导航仪的位置坐标,xd,yd表示驱动轮的位置坐标,h表示导航仪与驱动轮的距离,ψ为位姿角;对所述位置变换关系式进行逆变换,获得导航仪位置预测模型;将所述状态向量预测值、所述导航仪与所述驱动轮的距离输入所述导航仪位置预测模型,获得所述导航仪的期望位置。可选的,所述根据所述状态向量预测值、第k个采样周期的位姿角、第k个采样周期的导航仪实测位置确定所述导航仪的期望位置,具体包括:获取所述导航仪与所述驱动轮的距离、观测矩阵和所述导航仪与所述驱动轮的位置变换关系式,所述位置变换关系式为:其中,xn,yn表示导航仪的位置坐标,xd,yd表示驱动轮的位置坐标,h表示导航仪与驱动轮的距离,ψ为位姿角;对所述位置变换关系式进行逆变换,获得导航仪位置预测模型;将所述状态向量预测值、所述导航仪与所述驱动轮的距离输入所述导航仪位置预测模型,获得导航仪预测位置;根据所述导航仪预测位置和第k个采样周期的导航仪实测位置确定预测误差;根据所述状态预测模型确定所述状态预测模型的状态协方差矩阵;根据所述状态协方差矩阵确定卡尔曼增益;根据所述预测误差、所述卡尔曼增益和所述所述导航仪的预测位置确定所述导航仪的期望位置。一种自动导引运输车的定位系统,所述定位系统包括:状态预测模型确定模块,用于根据目标自动导引运输车的轴距、导航仪的位姿角、驱动轮转向角和驱动轮转速确定所述目标自动导引运输车的状态预测模型,其中,所述目标自动导引运输车包括所述导航仪和所述驱动轮,所述状态预测模型的状态向量包括驱动轮位置和导航仪位姿角;数据获取模块,用于获取第k-1个采样周期的所述驱动轮的位置坐标、第k-1个采样周期的位姿角、第k个采样周期的驱动轮实测转速、第k个采样周期的驱动轮转向角;状态向量预测值确定模块,用于将第k-1个采样周期的所述驱动轮的位置坐标、第k-1个采样周期的位姿角、第k个采样周期的驱动轮实测转速、第k个采样周期的驱动轮转向角输入所述状态预测模型,获得第k个采样周期的状态向量预测值;判断模块,用于判断所述导航仪的最新采样时间是否小于所述驱动轮传感器的最新采样时间,获得判断结果;判断处理模块,用于当所述判断结果表示所述导航仪的最新采样时间小于所述驱动轮传感器的最新采样时间时,则根据所述状态向量预测值、所述导航仪与所述驱动轮的距离确定所述导航仪的期望位置;当所述判断结果表示所述导航仪的最新采样时间大于或者等于所述驱动轮传感器的最新采样时间时,根据所述状态向量预测值、第k个采样周期的位姿角、第k个采样周期的导航仪实测位置确定所述导航仪的期望位置。一种自动导引运输系统,所述自动导引运输系统包括:自动导引运输车和预测器,所述自动导引运输车包括导航仪和驱动轮,所述预测器用于根据所述的定位方法确定所述导航仪的期望位置,以控制所述自动导引运输车运动带动所述导航仪到达所述期望位置。根据本发明提供的具体实施例,本发明公开了以下技术效果:本发明提供的一种自动导引运输车的定位方法及定位系统,根据导航仪的最新采样时间和驱动轮传感器的最新采样时间的大小关系确定导航仪的期望位置。当导航仪的最新采样时间小于驱动轮传感器的最新采样时间时,根据状态向量预测值、所述导航仪与所述驱动轮的距离确定所述导航仪的期望位置。当导航仪的最新采样时间大于或者等于驱动轮传感器的最新采样时间时,根据状态向量预测值、第k个采样周期的位姿角、第k个采样周期的导航仪实测位置确定所述导航仪的期望位置。可见,最终获得的导航数据的更新频率为驱动轮传感器采样频率与导航仪采样频率之和,由于驱动轮传感器的采样频率远高于导航仪的采样频率,因此,采用本发明提供的定位方法及定位系统能够有效提高AGV导航数据的更新频率,从而提高AGV控制算法频率,进而提高AGV整车控制精度,尤其在高速运动状态下,其优势尤其明显。进一步地,基于本发明提供的定位方法的自动导引运输系统,预测器的输出频率高,AGV导航数据的更新频率高,能够有效提高自动导引运输车的控制精度,尤其是在高速运动状态下,其高精度的优势尤为突出。附图说明为了更清楚地说明本发明实施例或现有技术中的技术方案,下面将对实施例中所需要使用的附图作简单地介绍,显而易见地,下面描述中的附图仅仅是本发明的一些实施例,对于本领域普通技术人员来讲,在不付出创造性劳动的前提下,还可以根据这些附图获得其它的附图。图1为本发明实施例1提供的一种自动导引运输车的定位方法的流程图;图2为本发明实施例2提供的一种自动导引运输车的定位系统的结构框图;图3为本发明实施例3提供的自动导引运输车的平面坐标图;图4为本发明实施例3提供的预测器的结构框图;图5为本发明实施例3提供的预测模块的结构框图;图6为本发明实施例3提供的AGV的实测数据对比图。具体实施方式下面将结合本发明实施例中的附图,对本发明实施例中的技术方案进行清楚、完整地描述,显然,所描述的实施例仅仅是本发明一部分实施例,而不是全部的实施例。基于本发明中的实施例,本领域普通技术人员在没有做出创造性劳动前提下所获得的所有其他实施例,都属于本发明保护的范围。本发明的目的是提供一种自动导引运输车定位方法、定位系统及自动导引运输系统,能够有效提高AGV导航数据的更新频率,从而提高AGV控制算法频率,进而提高AGV整车控制精度,尤其在高速运动状态下,其优势尤其明显。为使本发明的上述目的、特征和优点能够更加明显易懂,下面结合附图和具体实施方式对本发明作进一步详细的说明。实施例1:图1为本发明实施例1提供的一种自动导引运输车的定位方法的流程图,所述定位方法包括:步骤101:根据目标自动导引运输车的轴距、导航仪的位姿角、驱动轮转向角和驱动轮转速确定所述目标自动导引运输车的状态预测模型,其中,所述目标自动导引运输车包括所述导航仪和所述驱动轮,所述状态预测模型的状态向量包括驱动轮位置和导航仪位姿角。所述状态预测模型为:其中,表示第k个采样周期的状态向量预测值,表示驱动轮的横坐标预测值,表示驱动轮的纵坐标预测值,表示导航仪位姿角预测值,Δt表示驱动轮传感器的采样周期,v表示驱动轮的实测转速,表示驱动轮的加速度估值,θk表示驱动轮转向角,步骤102:获取第k-1个采样周期的所述驱动轮的位置坐标、第k-1个采样周期的位姿角、第k个采样周期的驱动轮实测转速、第k个采样周期的驱动轮转向角。步骤103:将第k-1个采样周期的所述驱动轮的位置坐标、第k-1个采样周期的位姿角、第k个采样周期的驱动轮实测转速、第k个采样周期的驱动轮转向角输入所述状态预测模型,获得第k个采样周期的状态向量预测值。步骤104:判断所述导航仪的最新采样时间是否小于所述驱动轮传感器的最新采样时间,获得判断结果。当所述判断结果表示所述导航仪的最新采样时间小于所述驱动轮传感器的最新采样时间时,执行步骤105。当所述判断结果表示所述导航仪的最新采样时间大于或者等于所述驱动轮传感器的最新采样时间时,执行步骤106。步骤105:根据所述状态向量预测值、所述导航仪与所述驱动轮的距离确定所述导航仪的期望位置。步骤106:根据所述状态向量预测值、第k个采样周期的位姿角、第k个采样周期的导航仪实测位置确定所述导航仪的期望位置。本实施例中,第0个采样周期的采样数据均为0。具体地,所述根据所述状态向量预测值、所述导航仪与所述驱动轮的距离确定所述导航仪的期望位置,具体包括:获取所述导航仪与所述驱动轮的距离和所述导航仪与所述驱动轮的位置变换关系式,所述位置变换关系式为:其中,xn,yn表示导航仪的位置坐标,xd,yd表示驱动轮的位置坐标,h表示导航仪与驱动轮的距离,ψ为位姿角;对所述位置变换关系式进行逆变换,获得导航仪位置预测模型;将所述状态向量预测值、所述导航仪与所述驱动轮的距离输入所述导航仪位置预测模型,获得所述导航仪的期望位置。所述根据所述状态向量预测值、第k个采样周期的位姿角、第k个采样周期的导航仪实测位置确定所述导航仪的期望位置,具体包括:获取所述导航仪与所述驱动轮的距离、观测矩阵和所述导航仪与所述驱动轮的位置变换关系式,所述位置变换关系式为:其中,xn,yn表示导航仪的位置坐标,xd,yd表示驱动轮的位置坐标,h表示导航仪与驱动轮的距离,ψ为位姿角;对所述位置变换关系式进行逆变换,获得导航仪位置预测模型;将所述状态向量预测值、所述导航仪与所述驱动轮的距离输入所述导航仪位置预测模型,获得导航仪预测位置;根据所述导航仪预测位置和第k个采样周期的导航仪实测位置确定预测误差。本实施例中,首先根据公式:获得所述导航仪预测位置观测值,其中,C表示观测矩阵,表示导航仪预测位置观测值,表示导航仪预测位置。然后根据确定预测误差,Yk表示导航仪实测位置,r表示预测误差。根据所述状态预测模型确定所述状态预测模型的状态协方差矩阵;根据所述状态协方差矩阵确定卡尔曼增益;根据所述预测误差、所述卡尔曼增益和所述所述导航仪的预测位置确定所述导航仪的期望位置。实施例2:图2为本发明实施例2提供的一种自动导引运输车的定位系统的结构框图。如图2所示,一种自动导引运输车的定位系统,所述定位系统包括:状态预测模型确定模块201,用于根据目标自动导引运输车的轴距、导航仪的位姿角、驱动轮转向角和驱动轮转速确定所述目标自动导引运输车的状态预测模型,其中,所述目标自动导引运输车包括所述导航仪和所述驱动轮,所述状态预测模型的状态向量包括驱动轮位置和导航仪位姿角;数据获取模块202,用于获取第k-1个采样周期的所述驱动轮的位置坐标、第k-1个采样周期的位姿角、第k个采样周期的驱动轮实测转速、第k个采样周期的驱动轮转向角;状态向量预测值确定模块203,用于将第k-1个采样周期的所述驱动轮的位置坐标、第k-1个采样周期的位姿角、第k个采样周期的驱动轮实测转速、第k个采样周期的驱动轮转向角输入所述状态预测模型,获得第k个采样周期的状态向量预测值;判断模块204,用于判断所述导航仪的最新采样时间是否小于所述驱动轮传感器的最新采样时间,获得判断结果;判断处理模块205,用于当所述判断结果表示所述导航仪的最新采样时间小于所述驱动轮传感器的最新采样时间时,则根据所述状态向量预测值、所述导航仪与所述驱动轮的距离确定所述导航仪的期望位置;当所述判断结果表示所述导航仪的最新采样时间大于或者等于所述驱动轮传感器的最新采样时间时,根据所述状态向量预测值、第k个采样周期的位姿角、第k个采样周期的导航仪实测位置确定所述导航仪的期望位置。实施例3:一种自动导引运输系统,所述自动导引运输系统包括:自动导引运输车和预测器,所述自动导引运输车包括导航仪和驱动轮,所述预测器用于根据实施例1所述的定位方法确定所述导航仪的期望位置,以控制所述自动导引运输车运动带动所述导航仪到达所述期望位置,所述自动导引运输系统预测器的确定步骤如下:步骤1:确定自动导引运输车的状态预测模型;图3为本发明实施例3提供的自动导引运输车的平面坐标图。如图3所示,θ为驱动轮转向角,v为驱动轮转速,ψ为位姿角,δ为驱动轮与x正半轴夹角,w为位姿角速度,h为导航仪与驱动轮距离,L为驱动轮与后轮中点距离,r为转向半径,D为驱动轮,N为导航仪,O为旋转圆心。AGV在xy坐标系的某一位置,当驱动轮转向角度为θ、驱动轮速度分别为v时,车体将以O为圆心,r为半径做圆周运动。已知导航仪坐标采样值xn,yn,根据导航仪与驱动轮的位置变换关系式可以得到相应驱动轮的坐标xd,yd,位置变换关系式为:为位姿角估值值,θ为驱动轮的实测转向角度,当θ顺时针转向时,θ>0;逆时针时θ<0,表示第k个采样周期驱动轮与x正半轴夹角的估计值,k表示采样周期序号。因为驱动轮传感器的采样周期很小,可近似认相邻采样周期内车体为匀速直线运动,因此,有其中,表示第k个采样周期的驱动轮转速估计值,Δtk表示负k个采样周期。ψ,分别为位姿角的实测值和估计值,w为位姿角速度的估计值,v分别为驱动轮转速的估计值和实测值,为驱动轮加速度的估计值将5式带入公式2得;将8和9写成状态转移矩阵为:即:其中,为系统的状态向量,Ak为状态转移矩阵,Bk为输入矩阵,Uk为系统输入向量。步骤2:预测器设计;图4为本发明实施例3提供的预测器的结构框图。如图4所示,预测器包括预测模块和数据融合模块,为预测模块输出的状态向量和状态协方差矩阵,为融合模块输出的状态向量和状态协方差矩阵,Xout为预测器输出的状态向量。预测器整体基于卡尔曼滤波原理,融合驱动轮传感器的多传感器数据得到预测输出。预测模块根据当前周期驱动轮传感器的采样值,经车体运动模型状态预测模型可得到单周期内车体导航数据的偏移增量,再叠加上周期导航数据即可得到当前周期的预测值。预测模块同时计算融合模块所需的状态协方差矩阵,预测模块输出给融合模块的参数包括导航仪预测位置及状态矩阵协方差其中,Q表示过程噪声。图5为本发明实施例3提供的预测模块的结构框图。如图5所示,融合模块将预测模块的输出数据与导航仪实测数据进行数据融合得到预测器的输出。任一输入数据更新,融合模块都将输出新预测值。首先根据公式14确定所述导航仪预测位置观测值,其中,C表示观测矩阵,表示导航仪预测位置观测值,表示导航仪预测位置。根据公式15确定预测误差:根据公式13所示的状态协方差矩阵及公式16确定卡尔曼增益K:其中,R表示输入噪声。根据公式18确定所述导航仪的期望位置。设tn为导航仪最新一次采样时间,tm为磁编码器最新一次采样时间,本发明的融合决策模块的决策规则见公式19:图6为本发明实施例3提供的AGV的实测数据对比图。如图6中显示了AGV在高速运动状态下,导航仪原始数据以及预测器的输出值。可以看出,相较于导航仪原始数据,预测器的输出频率显著提高7倍以上。且即使在高速状态下,预测器的输出与原始数据具有高度的线性一致性。可见,本发明提供的自动导引运输车的定位方法、定位系统及自动导引运输系统具有较高的工程应用价值,应用前景良好。本说明书中各个实施例采用递进的方式描述,每个实施例重点说明的都是与其他实施例的不同之处,各个实施例之间相同相似部分互相参见即可。对于实施例公开的系统而言,由于其与实施例公开的方法相对应,所以描述的比较简单,相关之处参见方法部分说明即可。本文中应用了具体个例对本发明的原理及实施方式进行了阐述,以上实施例的说明只是用于帮助理解本发明的方法及其核心思想;同时,对于本领域的一般技术人员,依据本发明的思想,在具体实施方式及应用范围上均会有改变之处。综上所述,本说明书内容不应理解为对本发明的限制。
权利要求:1.一种自动导引运输车的定位方法,其特征在于,所述定位方法包括:根据目标自动导引运输车的轴距、导航仪的位姿角、驱动轮转向角和驱动轮转速确定所述目标自动导引运输车的状态预测模型,其中,所述目标自动导引运输车包括所述导航仪和所述驱动轮,所述状态预测模型的状态向量包括驱动轮位置和导航仪位姿角;获取第k-1个采样周期的所述驱动轮的位置坐标、第k-1个采样周期的位姿角、第k个采样周期的驱动轮实测转速、第k个采样周期的驱动轮转向角;将第k-1个采样周期的所述驱动轮的位置坐标、第k-1个采样周期的位姿角、第k个采样周期的驱动轮实测转速、第k个采样周期的驱动轮转向角输入所述状态预测模型,获得第k个采样周期的状态向量预测值;判断所述导航仪的最新采样时间是否小于所述驱动轮传感器的最新采样时间,获得判断结果;当所述判断结果表示所述导航仪的最新采样时间小于所述驱动轮传感器的最新采样时间时,则根据所述状态向量预测值、所述导航仪与所述驱动轮的距离确定所述导航仪的期望位置;当所述判断结果表示所述导航仪的最新采样时间大于或者等于所述驱动轮传感器的最新采样时间时,根据所述状态向量预测值、第k个采样周期的位姿角、第k个采样周期的导航仪实测位置确定所述导航仪的期望位置。2.根据权利要求1所述的定位方法,其特征在于,所述状态预测模型为:其中,表示第k个采样周期的状态向量预测值,表示驱动轮的横坐标预测值,表示驱动轮的纵坐标预测值,表示导航仪位姿角预测值,Δt表示驱动轮传感器的采样周期,v表示驱动轮的实测转速,表示驱动轮的加速度估值,θk表示驱动轮转向角,3.根据权利要求1所述的定位方法,其特征在于,所述根据所述状态向量预测值、所述导航仪与所述驱动轮的距离确定所述导航仪的期望位置,具体包括:获取所述导航仪与所述驱动轮的距离和所述导航仪与所述驱动轮的位置变换关系式,所述位置变换关系式为:其中,xn,yn表示导航仪的位置坐标,xd,yd表示驱动轮的位置坐标,h表示导航仪与驱动轮的距离,ψ为位姿角;对所述位置变换关系式进行逆变换,获得导航仪位置预测模型;将所述状态向量预测值、所述导航仪与所述驱动轮的距离输入所述导航仪位置预测模型,获得所述导航仪的期望位置。4.根据权利要求2所述的定位方法,其特征在于,所述根据所述状态向量预测值、第k个采样周期的位姿角、第k个采样周期的导航仪实测位置确定所述导航仪的期望位置,具体包括:获取所述导航仪与所述驱动轮的距离、观测矩阵和所述导航仪与所述驱动轮的位置变换关系式,所述位置变换关系式为:其中,xn,yn表示导航仪的位置坐标,xd,yd表示驱动轮的位置坐标,h表示导航仪与驱动轮的距离,ψ为位姿角;对所述位置变换关系式进行逆变换,获得导航仪位置预测模型;将所述状态向量预测值、所述导航仪与所述驱动轮的距离输入所述导航仪位置预测模型,获得导航仪预测位置;根据所述导航仪预测位置和第k个采样周期的导航仪实测位置确定预测误差;根据所述状态预测模型确定所述状态预测模型的状态协方差矩阵;根据所述状态协方差矩阵确定卡尔曼增益;根据所述预测误差、所述卡尔曼增益和所述所述导航仪的预测位置确定所述导航仪的期望位置。5.一种自动导引运输车的定位系统,其特征在于,所述定位系统包括:状态预测模型确定模块,用于根据目标自动导引运输车的轴距、导航仪的位姿角、驱动轮转向角和驱动轮转速确定所述目标自动导引运输车的状态预测模型,其中,所述目标自动导引运输车包括所述导航仪和所述驱动轮,所述状态预测模型的状态向量包括驱动轮位置和导航仪位姿角;数据获取模块,用于获取第k-1个采样周期的所述驱动轮的位置坐标、第k-1个采样周期的位姿角、第k个采样周期的驱动轮实测转速、第k个采样周期的驱动轮转向角;状态向量预测值确定模块,用于将第k-1个采样周期的所述驱动轮的位置坐标、第k-1个采样周期的位姿角、第k个采样周期的驱动轮实测转速、第k个采样周期的驱动轮转向角输入所述状态预测模型,获得第k个采样周期的状态向量预测值;判断模块,用于判断所述导航仪的最新采样时间是否小于所述驱动轮传感器的最新采样时间,获得判断结果;判断处理模块,用于当所述判断结果表示所述导航仪的最新采样时间小于所述驱动轮传感器的最新采样时间时,则根据所述状态向量预测值、所述导航仪与所述驱动轮的距离确定所述导航仪的期望位置;当所述判断结果表示所述导航仪的最新采样时间大于或者等于所述驱动轮传感器的最新采样时间时,根据所述状态向量预测值、第k个采样周期的位姿角、第k个采样周期的导航仪实测位置确定所述导航仪的期望位置。6.一种自动导引运输系统,其特征在于,所述自动导引运输系统包括:自动导引运输车和预测器,所述自动导引运输车包括导航仪和驱动轮,所述预测器用于根据权利要求1-4任一项所述的定位方法确定所述导航仪的期望位置,以控制所述自动导引运输车运动带动所述导航仪到达所述期望位置。
百度查询: 华晟(青岛)智能装备科技有限公司 自动导引运输车定位方法、定位系统及自动导引运输系统
免责声明
1、本报告根据公开、合法渠道获得相关数据和信息,力求客观、公正,但并不保证数据的最终完整性和准确性。
2、报告中的分析和结论仅反映本公司于发布本报告当日的职业理解,仅供参考使用,不能作为本公司承担任何法律责任的依据或者凭证。