Update XbeeS6c.cpp