Refactor a load of crap

Get rid of superfluous methods and use the correct indexes for the
servos.  Also add left/right movement methods.