started using observations for the caculation. seems real world had more error then expected so change observation code to recored more and reduce the distance between each one