Model predictive control with haptic feedback for robot manipulation in cluttered scenarios