Moved SAVE to after reading back from SDO
Only reads device when new NMT state is 5