Sliding mode based impedance control