Augmented Invariance Control for Impedance-controlled Robots with Safety Margins. Issue 1 (July 2017)