ucf-gatefinder Test code to find and navigate through the gate/channel for the auvsi 2016 competition