在各种伪距定位算法中,最小二乘法是一种比较简单而广泛的方法,该算法可以分为以下几步: 1.准备数据与设置初始值 这里准备数据,主要是对于各颗可见卫星,收集到它们在同一时刻的伪距测量值,计算测量值的各项偏差.误差成分的校正量,然后计算出误差校正后的伪距测量值,这里假设伪距为理想距离加上随机高斯误差.设置初始值,假设大概知道位置坐标,则设定其为初始值,也可根据上一次定位结果设定:若什么都不了解,那么初值设置为0,只不过多几次迭代过程罢了. 2.非线性方程组线性化(不详细解释,就是得到雅克比矩阵).…