Isn't the vehicle position in its body frame always zero? What do you mean with this?