用于移动机器人定位与环境重构的绝对坐标获取方法

摘要

本发明公开用于移动机器人定位与环境重构的绝对坐标获取方法，包含：引入虚拟坐标系；求取当前时刻机器人在以卫星导航接收机天线为原点的局部地理坐标系的坐标，机器人在地心地固坐标系的大地坐标，环境特征点以c点为中心的局部地理坐标系的坐标，环境特征点在地心地固坐标系的大地坐标；求取当前时刻机器人在上一时刻c坐标系的坐标，机器人在上一时刻以c点为原点的局部地理坐标系的坐标，机器人的经度、纬度、高度；求取环境特征点在当前时刻以c点为中心的局部地理坐标系的坐标；求取当前时刻环境特征点在地心地固坐标系的大地坐标。本发明引入虚拟坐标系，等效卫星导航接收机天线中心点与传感器坐标系中心点为一点，节省人力、时间成本。