Implementation of the SMP for control of SCHUNK PowerCube series robotic manipulators and modules