1st semi intelligent robot, suggestions please!

Working code for 2 servo drive motors and one sonar servo motor

I'm drunk. So please forgive lame posts.