added april tag support while the robot is in "waiting" state