RDD2 drifting in velocity mode when reset_position is enabled

With `reset_position` set to `True`  in `rdd2_sim.py` the quad is slowly drifting. Likely because the attitude estimation is not ideal and with reset_position the drone doesn't hold the set position.

Video:
https://github.com/user-attachments/assets/672bd7ab-4fc0-42e6-b5fc-4c4a000a345f