Robust robotic manipulation for effective multi-contact and safe physical interactions