Working code for 2 servo drive motors and one sonar servo motor
I'm drunk. So please forgive lame posts.