[Autonomous] Add functionality to robot vision loop for getting apriltag pose data

[BanceDev]

Add an implementation of the functions provided in apriltag_pose.h to our loop function under robot vision. It may be practical to pull this out into its own function for better debugging later. Also make sure that this is inserted into the loop after the tag data has been properly updated or it wont be able to work.