wip - added preliminary pid controller code

Avoid Obstacle behavior now attempts to call PID controller.
However, the PID parameters need to be tuned before we can
get some meaningful output.