corrected byte packing for 16 bit values
corrected wait, goto to extract 16 bits. added if command (havn't tested it yet)