Config node works, TODO: make GridWorld as a ROS node compatible with RL node