See and touch: Visio-haptic control for safe human robot interaction