Estimation
¥
¥
¥(zj - H(Fapj,Fpaj))tR-j1 (zj - H(Fapj,Fpaj))/2 + (pj - Pj)tR-j1 (pj - Pj) /2
¥ 
¥The rubber bands are the prior estimates of parameters