Fix initial robot state setting (some of the joints specified by ROS are invalid in OpenRAVE).