diff --git a/g2core/device/trinamic/tmc2130.h b/g2core/device/trinamic/tmc2130.h
index 8d4b10fb..9c541851 100644
--- a/g2core/device/trinamic/tmc2130.h
+++ b/g2core/device/trinamic/tmc2130.h
@@ -501,7 +501,8 @@ struct Trinamic2130 final : Stepper {
         }
 
         out_buffer.addr = (uint8_t) next_reg;
-        _device.queueMessage(_message.setup((uint8_t *)&out_buffer, (uint8_t *)&in_buffer, 5, SPIMessage::DeassertAfter, SPIMessage::KeepTransaction));
+        _message.setup((uint8_t *)&out_buffer, (uint8_t *)&in_buffer, 5, SPIMessage::DeassertAfter, SPIMessage::KeepTransaction);
+        _device.queueMessage(&_message);
     };
 
     void _doneReadingCallback()
@@ -538,7 +539,7 @@ struct Trinamic2130 final : Stepper {
         _reading_only = false;
 
         _transmitting = false;
-        _startNextReadWrite();
+        //_startNextReadWrite();
     };
 
     void init() override