% Least square estimation huangzuhui 09/09/2017 % LS % x(1) stands the slope % x(2) stands the intercept % S 为量测矩阵, d为相应的时间或者距离矩阵