Fixed the r_shoulder joints and 	added imu_joint_controller node