impedance controller that supports multiple arms

Jianfeng Gaorequested to merge
feature/dict_arm_cfg into main

re-implementation of the NJointImpedanceController to support multiple arms, similar changes apply to admittance controllers, and MPControllers

Merge request reports