摘要
本发明公开了一种移动机器人3D定位系统,包括,同步定位建图单元和导航单元,所述同步定位建图单元和所述导航单元之间可以切换,所述同步定位建图单元是所述导航单元的2D位姿,所述导航单元显示所述同步定位建图单元的角度和初始位姿;所述导航单元包括算法,所述算法进行信息融合,所述信息包括多种传感器的输入和所述同步定位建图单元算法结果融合,所述算法结果融合,先将移动机器人在空间所处的状态用15维向量X进行描述:X=[x,y,z,θr,θp,θy,vx,vy,vz,ωr,ωp,ωy,ax,ay,az]T。本发明在进行信息融合时,不仅能够灵活配置传感器,还能灵活配置采用的算法,进行信息融合时,不仅能够灵活配置传感器,还能灵活配置采用的算法,能够进行3D位姿估计,适应三维环境。