some major updates to how the AI functions. More Movement changes ruh roh
Merge branch 'dev-integration' of https://github.com/PalouseRobosub/robosub into dev-integration