Fixed remapping of joint_states to work with moveit