Rewritten Sabertooth code

Has not been proven to work. Libraries won't work for some reason.
Fixed typo
Working version of Sabertooth code.

Basic human interface. Responds to all cases correctly.