Dynamic active constraints for robot assisted minimally invasive surgery