Outgoing USB data overwrite bugfix

Fixed a bug where more data were written to SFP ASCII message buffer
than the pre-calculated packet size, causing data overflow.
Minor IAP code modification

Warning and visual code fix.