imported work from seawolfVI
added binscontour
Merge branch 'master' of https://github.com/ncsurobotics/seawolf5