Fix some issues

* No need for scaling
* Adapt to the new message structure from BLORT
 (Added a message in BLORT to output the object position in the correct frame)