Merge pull request #2 from Stinktier/master

Stops only every 1.5 secs
Merge pull request #3 from Stinktier/master

 Added Phase features
Merge pull request #4 from Stinktier/master

 Small fix for continuing stopping
Current working master from robot
Merge pull request #1 from RoboGroup3/master

update my code