% 功能：由伪距、伪距变化率，进行单点定位、定速计算。 % 输入：------------------------------------------------------------------- % Rou： 伪距观测值(m)，32*1维 % Rou_Dot： 伪距变化率观测值(m/s)，32*1维 % Weight： 权矩阵，32*32维，第 i行 i列元素为 1表示第 i个伪距观测方程有效，为 0表示无效。 %