Changed state_publisher to robot_state_publisher.
Fixed some assignment errors, added check for client_id.