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