Minor mod to RS232_Driver to print msg when called in test mode