Updated and finished stateSetter function. Drone should follow commands through the states properly. Have to upload and test on the arduino chip to make sure that everything is progressing as it should.