Done stuff

Added safety. Moved shifting to neutral to the fire command from the arm command.