Testing this new controller seems to produce strange behaviour on `A6` that triggers joint saturation routine
Testing this new controller seems to produce strange behaviour on
A6that triggers joint saturation routine