Bugfixes
moveToCartesianPosition more or less working
new functions to call LIN and PTP motion controllers on the KRC
added function getQuaternionFromRPY