Changed autonomous

Changed all .c to .h and added a stopMotor