Add new joint groups

Added both_arms and both_arms_torso joint groups.
Fix for value iterator
Restructure joint groups definition so joints are just written once.