Commit 16

Redid drive switches to "not-toggles", flipped pnuematics in begin.
Added debug outputs to Teleop.