Fixes to get serial interface working

1. Fixed 2 bugs that prevented the aux interface working.

2. Fixed incorrect format in M105 S2 command