added transformation Kinect->Map
motion controller on actual velocity