TDoA 2D position Z dependent of orientation

[ataffanel]

The TDoA 2D position mode is implemented by pushing height in the kalman filter using the z-ranger TOF measurement. The problem is that this measurement is supposed to be taken by a sensor attach to the Crazyflie body and so it is compensated for the body orientation. We should push an absolute height instead to get rid of this orientation dependency.