Calculate workspace for end effector, manipulator