work in progress: included motions in function (Cx-d) instead of pose

Signed-off-by: Amit Shah <amit.shah@tum.de>
Merge branch 'master' of https://github.com/mor1pheus/HybridTracking