Position estimates now based on RK4 integration