Fixed Mihir Mixtakes - 11/11/14

Added soft stop code NEED TO MAKE IT ONLY DO STUFF WHEN IT GOES DOWN
Fixed arm not going up