Obstacle Avoidance Controller: a switch controller determine when to trigger a OA algorithm, and which algorithm should be used. OA Utils: is the major algorithm library, contains most obstacle avoidance algorithm and support function