WIP: Move joint to a position in a defined time.

Signed-off-by: Thomas Helmke <thomas.helmke@gmx.de>