Added AprilTags test program