一种用于无人机的大地坐标系与SLAM坐标系转换方法

摘要

本发明公开了一种用于无人机的大地坐标系与SLAM坐标系转换方法，涉及无人机技术领域。该方法首先获取GPS导航信息以及摄像头图像，然后利用时间戳近似同步规则采集30组数据，计算转换矩阵和平移矩阵，并利用各组数据的欧式距离计算尺度信息；接着利用转换矩阵、平移矩阵和尺度信息将SLAM坐标映射到GPS的笛卡尔坐标，剔除差异过大的点，并重新计算转换矩阵、平移矩阵和尺度信息，实现转换精度的动态提高。