* NXP SUMMER CAMP PARTICIPANTS:
* This code just shows you how to retrieve the data from the
* AprilTag node. You will need to use this data to perform actions
* with the car within listener_callback.
void apriltag_callback(apriltag_msgs::msg::AprilTagDetectionArray::SharedPtr msg)
// Check to see if the detections object is empty. If so, then no detections found.
if(!msg->detections.empty())
// Store the 1st detection in an AprilTagDetection object
apriltag_msgs::msg::AprilTagDetection detection = msg->detections[0];
// Print the detection ID to the ROS INFO stream
RCLCPP_INFO(this->get_logger(), "Detection found! ID: %d\n Count: %d\n", detection.id, stop_count);