Updated processing xbee config logic

Issue of after writing 2 commands, read returns NULL still exists.