Additions and fixes from PAL robotics

* The first commit enables frame conversion
* The two next commits are fixes spotted by running the node through Cython