Moved debug function to the top of the file
Corrected field length of return_code
Corrected parsing of the '-p' option
Corrected parsing of return codes - should only be 1 byte
Started writing matts-sub tool and implemented sending of SUBSCRIBE and receiving of SUBACK