command code

wrote some code for user command.  Different handles and user command codes. Need to add disarm and arm for shutdown, land and flight. Some problems: can be solved with processing to take in user input instead.