Update XbeeS6.cpp

Modified the code to include more escape char checks. NEED TO VERIFY