Code for OSU underwater robotics' autonomous underwater vehicle for the 2015 robosub competition