added softstop
Merge pull request #34 from sloev/Motors_rewrite

added softstop