Figure 4: Diagram of all implemented ROS nodes.