Position Based Impedance Control