Updated code to use #define instead of magic number variables for ease of reading and understanding code. Added some print statements to the vertical flight states so that they will print out to the serial as all other states are doing.