Adapt new structure for cob4-1 

Tested on cob4-1
At the moment cob4-1 has only 3 joints per arm, if you define in yaml file 7 joints the hardware doesn't work.