Switched default wbi_id_list to ROBOT_TORQUE_CONTROL_JOINTS

Also fixed the order of the joints and added ROBOT_MEX_WBI_TOOLBOX