Fixed estimator so that the initial estimate is the last position estimate...
Fixed estimator so that the initial estimate is the last position estimate instead of trilaterate if possible
Fixed estimator so that the initial estimate is the last position estimate instead of trilaterate if possible