stty sane to clean up.
Added (I think) servo reversing logic.  Doesn't seem to work!