手机导航能分清楚你在高架下还是地面上,无人机在楼群缝隙里能稳住高度,共享单车的电子围栏能判断你是不是停进了规定区域——这些体验背后最底层的那套算法,就是伪距单点定位。前几年我做接收机固件时,调过很长一段时间PVT解算,回头再看整个GNSS定位的技术树,几乎所有更高级的玩法——RTK、PPP、精密单点定位辅助惯性导航——入口都是“伪距观测方程 + 最小二乘/卡尔曼滤波”这个组合。这篇我就想聊聊伪距单点定位算法的原理,以及怎么用最小二乘法把一个实际的定位解算跑通,文末给一个带有卫星坐标、伪距观测值、迭代求解过程的完整算例,新手可以照着复现,老手也可以当作排查定位异常时的基线参考。
1. 伪距单点定位到底是什么
1.1 四个未知数,为什么最少要四颗卫星
定位这件事的直觉模型很简单:如果我精确知道你的位置,也知道某颗卫星此刻的位置,再测出你到卫星的距离,那你的位置就被限制在了一个以卫星为球心的球面上。来三颗卫星,三个球面相交,理论上就能得到唯一的空间交点,这就是大家常说的“三球交会”。
但实际接收机遇到的问题比这个模型多一个维度:接收机内部那个石英钟,和卫星上搭载的原子钟之间,存在一个随时间缓慢变化的钟差。接收机测得的距离本质上是通过“信号发射时刻”和“信号接收时刻”之间的时间差乘光速得到的,这个时间差里天然包含了接收机钟差。换句话说,我测量出的伪距并不是几何距离,而是“几何距离 + 光速乘以接收机钟差”。
这就意味着方程组里除了三个位置未知数 x、y、z,还有一个接收机钟差未知数需要一起解。四个未知数,至少要建立起四个独立方程,也就是至少需要看到四颗卫星。这也是为什么手机在空旷地带定位快,一进隧道就失效——卫星数不够,方程组连满秩都做不到。
1.2 “伪距”里的“伪”字从哪来
伪距(pseudorange)这个概念,我第一次接触时觉得这个名字起得特别好,它直接点破了测量的本质:这个距离是“带误差的”,不是真实几何距离。
伪距观测值可以写成:
ρ = r + c·δt_u + c·δt_s + I + T + ε
其中:
- ρ 是接收机测得的伪距,单位米;
- r 是接收机到卫星的真实几何距离;
- δt_u 是接收机钟差;
- δt_s 是卫星钟差,可以从广播星历里的钟差参数修正;
- I 是电离层延迟,T 是对流层延迟,可以用经验模型削弱;
- ε 是测量噪声和多径等未模型化误差。
工程里通常会把卫星钟差、电离层、对流层这些能修正的项先用模型扣掉,剩下的接收机钟差作为未知数放进定位方程,和位置一起解算。所以,“伪距单点定位”这个名字背后其实隐含了一个处理逻辑:先把所有能算出来的误差从测量值里剥离,剩下的交给最小二乘去做估计。
1.3 先把所有坐标放进同一个坐标系
做定位解算最容易翻车的一步,不是矩阵算不对,而是坐标系没统一。
卫星星历解算出来的卫星位置,通常在ECEF(地心地固坐标系)下,这个坐标系和地球一起转动,X轴指向格林尼治子午线与赤道交点,Z轴指向北极。接收机最后输出的经纬度是大地坐标,但中间计算必须在ECEF里完成,等解出ECEF坐标后再投影到经纬度和椭球高。
我在刚接手定位解算时踩过一个坑:拿一段用了WGS-84经纬度转ECEF的代码去和别人的输出对,差了几十米,排查了半天,发现是对方用的椭球参数是CGCS2000的,长半轴差毫米级,但高程基准差异没有被正确处理,最后高程差了十几米。做单点定位解算之前,必须搞清楚星历给出的坐标系、伪距对应的信号发射时刻、以及接收机坐标输出的参考框架是不是一致。坐标系不一致,后面的所有计算都是在给错误结果做精确拟合。
2. 观测方程与最小二乘解算的核心推导
2.1 观测方程到底长什么样
假设接收机在第 i 颗卫星的观测方程可以写为:
ρ_i = sqrt((X_i - x)² + (Y_i - y)² + (Z_i - z)²) + c·δt_u + ε_i
其中 (X_i, Y_i, Z_i) 是第 i 颗卫星在ECEF坐标系下的坐标,(x, y, z) 是接收机位置,δt_u 是接收机钟差等效
2517



被折叠的 条评论
为什么被折叠?



