Underwater searching algorithm for Robotx International Challange - View it on GitHub