Started tweaking April tag test for use with robot