CN109141410B - Agv组合导航的多传感器融合定位方法 - Google Patents
Agv组合导航的多传感器融合定位方法 Download PDFInfo
- Publication number
- CN109141410B CN109141410B CN201810825951.0A CN201810825951A CN109141410B CN 109141410 B CN109141410 B CN 109141410B CN 201810825951 A CN201810825951 A CN 201810825951A CN 109141410 B CN109141410 B CN 109141410B
- Authority
- CN
- China
- Prior art keywords
- agv
- cos
- sin
- quaternion
- positioning method
- 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.)
- Active
Links
Images
Classifications
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
- G01C21/00—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
- G01C21/10—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration
- G01C21/12—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration executed aboard the object being navigated; Dead reckoning
- G01C21/16—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration executed aboard the object being navigated; Dead reckoning by integrating acceleration or speed, i.e. inertial navigation
- G01C21/165—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration executed aboard the object being navigated; Dead reckoning by integrating acceleration or speed, i.e. inertial navigation combined with non-inertial navigation instruments
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
- G01C21/00—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
- G01C21/04—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by terrestrial means
- G01C21/08—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by terrestrial means involving use of the magnetic field of the earth
Landscapes
- Engineering & Computer Science (AREA)
- Remote Sensing (AREA)
- Radar, Positioning & Navigation (AREA)
- Automation & Control Theory (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Life Sciences & Earth Sciences (AREA)
- Environmental & Geological Engineering (AREA)
- General Life Sciences & Earth Sciences (AREA)
- Geology (AREA)
- Navigation (AREA)
Abstract
本发明公开了一种AGV组合导航的多传感器融合定位方法,所述方法包括:确定坐标:获取AGV机器人的载体坐标系(b)与地理坐标系(n);数据处理:采用四元数微分方程进行姿态解算;获取数据:通过陀螺仪、角速度计和磁力计分别获取AGV机器人的角速度、运行的加速度和磁场强度;滤波去噪:采用互补滤波算法,通过加速度计和磁力计测量值修正四元数来修正姿态。本发明提供一种AGV组合导航的多传感器融合定位方法,使线性化程度和精度均有所提高,并且降低了全姿态解算算法的计算量和误差。
Description
技术领域
本发明涉及自动导引机器人技术领域,尤其涉及一种AGV组合导航的多传感器融合定位方法。
背景技术
AGV是(Automated Guided Vehicle)的缩写,即“自动导引运输车”,是指装备有电磁或光学等自动导引装置,它能够沿规定的导引路径行驶,具有安全保护以及各种移载功能的运输车。AGV组合导航技术一般通过两步定位,第一步为粗定位,采用柔性高、精度低的导引方式初步定位,确定AGV的当前位置;第二步为精定位,通过技术成熟、可靠性髙、成本低的导引方式进行误差矫正,提高AGV的定位精度。组合导航作为导航技术发展的重要方向之一,目前在汽车、航海、航空、航天等领域得到广泛运用。
AGV的导航引导技术的核心在于AGV姿态解算,即是确定载体坐标系与地理坐标系之间的方位关系,目前常用的算法分为欧拉角微分方程法、方向余弦微分方程法和四元数微分方程法。其中,欧拉角法虽然较为简单,但三角运算困难,在俯仰角为90度附近时算法将会出现退化失效现象,不能用于全姿态解算;方向余弦法虽可避免欧拉角法产生的方程退化现象,但需解算九个微分方程,计算量大;四元数姿态解算的线性化程度和精度均较高,并可实现全姿态解算。但是,运用四元数姿态解算法,陀螺仪测量角速度会产生累积误差,容易发散,而加速度计和磁力计不易产生累积误差,但实时精度较差。因此,设计一种线性化程度和精度均较高,并可降低计算量的全姿态解算算法是本领域技术人员迫切需要解决的技术问题。
发明内容
本发明的目的在于提供一种AGV组合导航的多传感器融合定位方法,使线性化程度和精度均有所提高,并且降低了全姿态解算算法的计算量和误差。
本发明公开的AGV组合导航的多传感器融合定位方法所采用的技术方案是:
一种AGV组合导航的多传感器融合定位方法,所述方法包括:
确定坐标:获取AGV机器人的载体坐标系(b)与地理坐标系(n);
数据处理:采用四元数微分方程进行姿态解算;
获取数据:通过陀螺仪、角速度计和磁力计分别获取AGV机器人的角速度、运行的加速度和磁场强度;
滤波去噪:采用互补滤波算法,通过加速度计和磁力计测量值修正四元数来修正姿态。
作为优选方案,所述获取数据步骤中,所述陀螺仪采用三个独立的MEMS检测X、Y、Z轴的电容变化,输出与角速度变化相关的电压值。
作为优选方案,所述滤波去噪步骤中,通过陀螺仪、加速度计和磁力计测得的值对俯仰角、翻滚角、航向角和四元数初始化,计算公式如下:
q0_init=cos(0.5*roll0)*cos(0.5*pitch0)*cos(0.5*yaw0)-
sin(0.5*roll0)*sin(0.5*pitch0)*sin(0.5*yaw0)
q1_init=cos(0.5*roll0)*sin(0.5*pitch0)*cos(0.5*yaw0)-
sin(0.5*roll0)*cos(0.5*pitch0)*sin(0.5*yaw0)
q2_init=sin(0.5*roll0)*cos(0.5*pitch0)*cos(0.5*yaw0)+
cos(0.5*roll0)*sin(0.5*pitch0)*sin(0.5*yaw0)
q3_init=cos(0.5*roll0)*cos(0.5*pitch0)*sin(0.5*yaw0)+
sin(0.5*roll0)*sin(0.5*pitch0)*cos(0.5*yaw0)
其中,ax,ay,az为加速度计测得的轴加速度值,mx,my,mz为陀螺仪测得的三轴磁感应强度值。
作为优选方案,所述数据处理步骤中,采用数值积分中的四阶龙格库塔算法。微分方程如下:
由求解的四元数表示地理坐标系(n)到载体坐标系(b)之间的姿态矩阵为:
根据切上求解的四元数数值和姿态矩阵计算载体的姿态角为:
Pitch=arcsinC32,Pitch∈(-90°,90°)
作为优选方案,所述方法还包括双轮差速驱动AGV运动模型算法,包括:
获取AGV形心位置P、航向角θ、两驱动轮轴间间距d,驱动轮半径r,轴间连线中必点M,坐标为(xM,yM)P与M距离l,直线PM与AGV中轴线夹角β,两轮旋转角速度为wL和wR。;
运动学运算:通过左右两轮角速度和车轮半径推出M点速度和角速度;
运动模型建立。
作为优选方案,所述运动学运算步骤中,计算公式为:
P点的位置坐标可由其与点位置关系推出,计算公式为:
xP=xM+lcos(θ+β)
yP=yM+lsin(θ+β)
P点的位置方程对时间求导得到P点的速度,计算公式为:
作为优选方案,所述运动模型建立步骤中,其运动模型公式:
作为优选方案,所述方法还包括辅助定位方法,包括:
向地理坐标系(n)铺设校正标识;
扫描经过的每一个校正标识;
更新对应标识数据,获取距离偏差e并清除。
作为优选方案,所述铺设的校正标识为二维码。
作为优选方案,所述更新对应标识数据,获取距离偏差e并清除步骤中,AGV的距离偏差e为:
其中:x为每个像素对应的实际距离。当e>o时,车辆在导航线右侧,当e<o时,车辆在导航线左侧,从而校正AGV的位置和航向角。
本发明公开的AGV组合导航的多传感器融合定位方法的有益效果是:通过四元数法进行姿态解算,利用数值积分中的四阶龙格库塔算法,简化全姿态解算算法的计算量;与此同时,采用互补滤波算法通过加速度计和磁力计测量值修正四元数来修正姿态,使线性化程度和精度均有所提高,并且降低了全姿态解算算法误差。
附图说明
图1是本发明AGV组合导航的多传感器融合定位方法的流程图。
图2是本发明AGV机器人信息流转关系图。
图3是本发明AGV机器人无线通讯模块ESP8266。
图4是本发明AGV机器人工业控制器和传感器MPU9255。
图5是本发明AGV组合导航的多传感器融合定位方法互补滤波姿态修正算法流程图。
图6是本发明AGV组合导航的多传感器融合定位方法位姿监测测试结果。
图7是本发明双轮差速驱动AGV运动模型算法。
图8是本发明AGV机器人的运动模型。
图9是本发明辅助定位方法。
图10是本发明二维码图像与参数定义示意图。
具体实施方式
下面结合具体实施例和说明书附图对本发明做进一步阐述和说明:
请参考图1,一种AGV组合导航的多传感器融合定位方法,所述方法包括:
步骤S101:确定坐标:获取AGV机器人的载体坐标系(b)与地理坐标系(n);
步骤S102:数据处理:采用四元数微分方程进行姿态解算;
步骤S103:获取数据:通过陀螺仪、角速度计和磁力计分别获取AGV机器人的角速度、运行的加速度和磁场强度;
步骤S104:滤波去噪:采用互补滤波算法,通过加速度计和磁力计测量值修正四元数来修正姿态。
请参考图2,具体的,本方法主要应用于AGV机器人领域。本实施例中的AGV机器人的通信模块都是通过串口RS232与外界进行通信的,AGV车载***与上位机调度***之间采用无线局域网通信。
由于上位机和下位机之间传输数据量较少,为减少***资源占用,本实施例选择OSI(Open System Interconnection)参考模型中的UDP(User Datagram Protocol)协议进行无线模块传输数据。本实施例硬件选的是目前技术比较成熟的ESP8266串口wifi无线模块,如图3所示。现阶段主要用来测试接收AGV发送的数掘的稳定性,包括AGV的IP、电压、速度、运行状态、位置等相关信息。UDP通讯模块编程包括服务器和客户端两部分组成,主要通过UDP控制块和相关巧用接口函数实现数据传输功能。
为提高姿态测量精度,陀螺仪需要结合加速度计或磁力计进行姿态检测。本实施例采用基于LPC2388设计的工业控制器和IrwenSense公司生产的9轴姿态检测数字传感器MPU925实现AGV捷联惯导技术,如图4所示。
本实施例中,陀螺仪利用科里奥利效应,通过三个独立MEMS检测X、Y、Z轴的电容变化,输出与角速率变化相关的电压;加速度计利用惯性原理,通过测量三轴上电容来检测轴的偏差度;磁力计利用霍尔效应,检测地磁场在X、Y、Z轴的电磁强度。
在步骤S102中,采用数值积分中的四阶龙格库塔算法。微分方程如下:
由求解的四元数表示地理坐标系(n)到载体坐标系(b)之间的姿态矩阵为:
根据切上求解的四元数数值和姿态矩阵计算载体的姿态角为:
Pitch=arcsinC32,Pitch∈(-90°,90°)
由于陀螺仪测量角速度会产生累积误差,容易发散;而加速度计和磁力计不易产生累积误差,但实时精度较差,二者适合进行互补滤波。本实施例中进行姿态修正的原理是:对于确定的向量n,当向量n经过存在误差的旋转矩阵变换后,在另一个坐标系中和理论值产生偏差,通过这个偏差来修正旋转矩阵,而旋转矩阵由四元数组成,因此可以修正四元数,从而修正姿态。
由四元数构成的方向余弦矩阵nCb表示从b系到n的转换矩阵,bCn表示从n系到b的转换矩阵,二者互为转置。加速度计和地磁计是测量工具和载体,本实施例通过这两个器件表征旋转矩阵的误差存在,然后通过互补滤波算法修正误差,即修正四元数,互补滤波修正姿态的具体求解流程如图5所示。
其中,n系中重力的理论输出转换到机体坐标系中,该矢量与测量的值存在误差,通过该差值来修正陀螺;同理磁力计将将测量的磁强用上一次的四元数得到的bCn转换到地理坐标系,xy平面的分量合成到x轴上后作为精确输出再经过nCb转换到机体坐标系中,该矢量与测量的值存在误差,通过该差值来修正磁力计。
在步骤S104中,通过陀螺仪、加速度计和磁力计测得的值对俯仰角、翻滚角、航向角和四元数初始化,计算公式如下:
q0_init=cos(0.5*roll0)*cos(0.5*pitch0)*cos(0.5*yaw0)-
sin(0.5*roll0)*sin(0.5*pitch0)*sin(0.5*yaw0)
q1_init=cos(0.5*roll0)*sin(0.5*pitch0)*cos(0.5*yaw0)-
sin(0.5*roll0)*cos(0.5*pitch0)*sin(0.5*yaw0)
q2_init=sin(0.5*roll0)*cos(0.5*pitch0)*cos(0.5*yaw0)+
cos(0.5*roll0)*sin(0.5*pitch0)*sin(0.5*yaw0)
q3_init=cos(0.5*roll0)*cos(0.5*pitch0)*sin(0.5*yaw0)+
sin(0.5*roll0)*sin(0.5*pitch0)*cos(0.5*yaw0)
其中,ax,ay,az为加速度计测得的轴加速度值,mx,my,mz为陀螺仪测得的三轴磁感应强度值。
采用MPU9255分别测试水平左右移动和前后俯仰倾斜两种情况,采样频率为125Hz,通过互补滤波融合修正陀螺仪、加速度计和电子罗盘测得的数据,输出航向角(Yaw)、俯仰角巧(Pitch)、翻滚角(Roll)随采样次数的变化,如图6所示。
水平测试时,航向角、俯仰角变化速度较快,翻滚角基本稳定;前后俯仰倾斜测试时,翻滚角、俯仰角变化速度较快,航向角基本稳定。测试结果表明,两种情况下传感器均能较快的跟随位姿变化,姿态稳定时波形上下偏差在1度以内,互补滤波算法的效果显著,能够满足实时监测AGV位姿的要求。
请参考图7,本技术方案还包括双轮差速驱动AGV运动模型算法,包括:
步骤S201:获取AGV形心位置P、航向角θ、两驱动轮轴间间距d,驱动轮半径r,轴间连线中必点M,坐标为(xM,yM)P与M距离l,直线PM与AGV中轴线夹角β,两轮旋转角速度为wL和wR。;
具体的,AGV运动模型,P为AGV形心位置,θ为平台航向角,d为两驱动轮轴间间距,r为驱动轮半径,M为轴间连线中必点,坐标为(xM,yM)P与M距离为l,直线PM与AGV中轴线夹角为β,两轮旋转角速度为wL和wR。为分析AGV运动状态。本实施例中,预先设定:①车体为刚体;②水平面内运动;③左右车轮受力相同,且不变形;④轮面与接触面为点接触;⑤驱动轮尺寸相同。
步骤S202:运动学运算:通过左右两轮角速度和车轮半径推出M点速度和角速度;
请参考图8,具体的,图中M点速度和角速度可由左右两轮角速度和车轮半径推出,计算公式为:
P点的位置坐标可由其与点位置关系推出,计算公式为:
xP=xM+lcos(θ+β)
yP=yM+lsin(θ+β)
P点的位置方程对时间求导得到P点的速度,计算公式为:
步骤S203:运动模型建立。
具体的,由以上公式联立得运动模型公式:
由运动学模型公式可知,P与M距离为l和直线PM,AGV中轴线夹角为β和车轮半径(r)已知的情况下,调度***对AGV实时速度(xP,yP)与角速度(θ)的控制可通过控制两个驱动轮的角速度(wL,wR)实现。
请参考图9,本技术方案还包括辅助定位方法,包括:
步骤S301:向地理坐标系(n)铺设校正标识;
步骤S302:扫描经过的每一个校正标识;
步骤S303:更新对应标识数据,获取距离偏差e并清除。
具体的,惯性导航单独使用时,随时间增长会产生累积误差,因此对于需要长时间运行并且不便停机校正的AGV***,需要采用其他辅助定位方式修正AGV位置。本实施例引入二维码技术,将包含有位置信息的二维码粘贴到对应地面坐标点,通过对车载工业相机拍摄到二维码图像识别处理进行定位导航。,利用己知二维码的绝对位置便可计算出AGV的绝对位置,从而校正AGV的位置和航向角。
工业相机采集到二维码图像后,通过对二维码识别读取位置信息完成定位,然后根据二维码特征点在图像中的坐标确定偏差参数,得到ACV位姿。二维码图像与参数定义示意图,如图10所示。
图10中白色方框区域为二维码的背景区域,黑色点为车体中心,α为ACV中心线与二维码中心线的方向偏差,e为两者的距离偏差。假设图2中A,B,C,D四个顶点在图像坐标系OUV中的坐标分别为(ax,ay)、(bx,by)、(cx,cy)、(dx,dy),车体中心点坐标为(ox,oy)右下角像素即最大像素坐标为(u,v),则:
当α>0时,车辆方向左偏,α<0时,车辆方向右偏。以左下角为原点,向上为Y轴正方向,向右为X轴正方向建立坐标系,则A、B、C、D在OXY坐标系中的坐标(x,y)为:
则AGV的距离偏差e为:
其中:x为每个像素对应的实际距离。当e>o时,车辆在导航线右侧,当e<o时,车辆在导航线左侧,从而校正AGV的位置和航向角。
本发明提供一种AGV组合导航的多传感器融合定位方法,通过四元数法进行姿态解算,利用数值积分中的四阶龙格库塔算法,简化全姿态解算算法的计算量;与此同时,采用互补滤波算法通过加速度计和磁力计测量值修正四元数来修正姿态,使线性化程度和精度均有所提高,并且降低了全姿态解算算法误差。
最后应当说明的是,以上实施例仅用以说明本发明的技术方案,而非对本发明保护范围的限制,尽管参照较佳实施例对本发明作了详细地说明,本领域的普通技术人员应当理解,可以对本发明的技术方案进行修改或者等同替换,而不脱离本发明技术方案的实质和范围。
Claims (8)
1.一种AGV组合导航的多传感器融合定位方法,其特征在于,所述方法包括:
确定坐标:获取AGV机器人的载体坐标系b与地理坐标系n;
数据处理:采用四元数微分方程进行姿态解算;
获取数据:通过陀螺仪、加速度计和磁力计分别获取AGV机器人的角速度、运行的加速度和磁场强度,所述陀螺仪采用三个独立的MEMS检测X、Y、Z轴的电容变化,输出与角速度变化相关的电压值;
滤波去噪:采用互补滤波算法,通过加速度计和磁力计测量值修正四元数来修正姿态,即通过陀螺仪、加速度计和磁力计测得的值对俯仰角、翻滚角、航向角和四元数初始化,计算公式如下:
其中,Roll0为翻滚角、Pitch0为俯仰角、Yaw0为航向角,ax,ay,az为加速度计测得的轴加速度值,mx,my,mz为陀螺仪测得的三轴磁感应强度值。
6.如权利要求1或2任一项所述的AGV组合导航的多传感器融合定位方法,其特征在于,所述方法还包括辅助定位方法,包括:
向地理坐标系n铺设校正标识;
扫描经过的每一个校正标识;
更新对应标识数据,获取距离偏差e并清除。
7.如权利要求6所述的AGV组合导航的多传感器融合定位方法,其特征在于,所述铺设的校正标识为二维码。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201810825951.0A CN109141410B (zh) | 2018-07-25 | 2018-07-25 | Agv组合导航的多传感器融合定位方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201810825951.0A CN109141410B (zh) | 2018-07-25 | 2018-07-25 | Agv组合导航的多传感器融合定位方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN109141410A CN109141410A (zh) | 2019-01-04 |
CN109141410B true CN109141410B (zh) | 2020-09-01 |
Family
ID=64798929
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201810825951.0A Active CN109141410B (zh) | 2018-07-25 | 2018-07-25 | Agv组合导航的多传感器融合定位方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN109141410B (zh) |
Families Citing this family (10)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN110398251B (zh) * | 2019-08-16 | 2021-02-09 | 北京邮电大学 | 一种基于多传感器融合的无轨导航agv定位***及其定位方法 |
CN111007863B (zh) * | 2019-12-06 | 2023-05-02 | 广州市申迪计算机***有限公司 | 一种机器人航向角的测量方法、装置及存储介质 |
CN111060126B (zh) * | 2019-12-31 | 2022-06-07 | 东软睿驰汽车技术(沈阳)有限公司 | 定位方法、装置及车辆 |
CN111443735B (zh) * | 2020-03-25 | 2023-10-24 | 浙江大华技术股份有限公司 | 一种车载云台摄像机姿态保持的方法、装置及*** |
CN111323043B (zh) * | 2020-03-26 | 2023-04-07 | 深圳市创客火科技有限公司 | 传感器数据处理方法及*** |
CN113494910B (zh) * | 2020-04-02 | 2024-06-18 | 广州汽车集团股份有限公司 | 一种基于uwb定位的车辆定位方法、装置及存储介质 |
CN111590572B (zh) * | 2020-05-15 | 2021-05-04 | 深圳国信泰富科技有限公司 | 一种机器人姿态更新方法及*** |
CN113752883B (zh) * | 2021-08-11 | 2024-06-28 | 镇江默勒电器有限公司 | 一种基于高速信息通信的agv物料配送车定位*** |
CN115560756B (zh) * | 2022-08-26 | 2023-07-04 | 北京开拓航宇导控科技有限公司 | 一种发射坐标系下微型自寻的导弹捷联导航方法 |
CN116592876B (zh) * | 2023-07-17 | 2023-10-03 | 北京元客方舟科技有限公司 | 定位装置及定位装置的定位方法 |
Citations (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN103900569A (zh) * | 2014-03-28 | 2014-07-02 | 哈尔滨工程大学 | 微惯导与dgps和电子罗盘组合导航姿态测量方法 |
CN106225784A (zh) * | 2016-06-13 | 2016-12-14 | 国家***第二海洋研究所 | 基于低成本多传感器融合行人航位推算方法 |
CN107560613A (zh) * | 2017-08-15 | 2018-01-09 | 江苏科技大学 | 基于九轴惯性传感器的机器人室内轨迹跟踪***及方法 |
Family Cites Families (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
EP2325605A1 (en) * | 2009-11-24 | 2011-05-25 | Nederlandse Organisatie voor toegepast -natuurwetenschappelijk onderzoek TNO | Navigation system, navigation device, navigation server, vehicle provided with a navigation device, group of such vehicles and navigation method. |
-
2018
- 2018-07-25 CN CN201810825951.0A patent/CN109141410B/zh active Active
Patent Citations (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN103900569A (zh) * | 2014-03-28 | 2014-07-02 | 哈尔滨工程大学 | 微惯导与dgps和电子罗盘组合导航姿态测量方法 |
CN106225784A (zh) * | 2016-06-13 | 2016-12-14 | 国家***第二海洋研究所 | 基于低成本多传感器融合行人航位推算方法 |
CN107560613A (zh) * | 2017-08-15 | 2018-01-09 | 江苏科技大学 | 基于九轴惯性传感器的机器人室内轨迹跟踪***及方法 |
Also Published As
Publication number | Publication date |
---|---|
CN109141410A (zh) | 2019-01-04 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN109141410B (zh) | Agv组合导航的多传感器融合定位方法 | |
CN106767804B (zh) | 一种运动物体的多维数据测量装置及方法 | |
CN104406585B (zh) | 基于惯性检测的激光跟踪仪靶球定位*** | |
CN109946732A (zh) | 一种基于多传感器数据融合的无人车定位方法 | |
CN113819914A (zh) | 一种地图构建方法及装置 | |
CN105172793B (zh) | 自动驾驶汽车的位姿估算方法 | |
CN105547288A (zh) | 一种煤矿井下移动设备自主定位的方法及*** | |
CN106969784B (zh) | 一种并发建图定位与惯性导航的组合误差融合*** | |
CN105987696A (zh) | 一种低成本车辆自动驾驶设计实现方法 | |
CN107607113A (zh) | 一种两轴姿态倾角测量方法 | |
CN106979780A (zh) | 一种无人车实时姿态测量方法 | |
CN110823224B (zh) | 一种车辆定位方法及车辆 | |
CN106840152A (zh) | 一种面向室内移动机器人的高精度组合导航***及方法 | |
CN108759822B (zh) | 一种移动机器人3d定位*** | |
CN105841698A (zh) | 一种无需调零的auv舵角精确实时测量*** | |
CN104515519A (zh) | 加速度、陀螺仪和磁场九轴传感器的空间轨迹定位*** | |
CN104515532A (zh) | 基于蓝牙的人体运动仿真装置 | |
CN108873043A (zh) | 车辆侧滑角度的计算方法及装置 | |
CN109828587A (zh) | 一种避障***及避障方法 | |
CN106979779A (zh) | 一种无人车实时姿态测量方法 | |
Xu et al. | A robust incremental-quaternion-based angle and axis estimation algorithm of a single-axis rotation using MARG sensors | |
CN110030995A (zh) | 融合图像传感器和惯性传感器的智能小车控制方法及*** | |
CN111912403B (zh) | 一种叉车的定位方法及叉车 | |
CN110489807B (zh) | 一种摇臂悬架结构巡视器的局部精确定位方法 | |
CN104515522A (zh) | 一种水下磁场及六轴惯性联合定位*** |
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 | ||
GR01 | Patent grant | ||
GR01 | Patent grant |