AED2 to the rescue!

Fixed drive, added ultra sonics and speaker code.