adding algorithms for the haptic to mobile manip workspace transformation