added impedanceController-test for elbows