[testing] Add a target in rotorcraft_waypoint

Regression test for #370
[core] Improve wrapper against mathutils.Matrix

In particular, it now includes the static method Rotation.

Fix #370