diff --git a/RP2040/I2Cdev/I2Cdev.cpp b/RP2040/I2Cdev/I2Cdev.cpp
index acfb8c2b..3958f182 100644
--- a/RP2040/I2Cdev/I2Cdev.cpp
+++ b/RP2040/I2Cdev/I2Cdev.cpp
@@ -320,7 +320,7 @@ bool I2Cdev::writeWords(uint8_t devAddr, uint8_t regAddr, uint8_t length, uint16
     for(int i=0; i<length; i++){
         data_buf[j] = data[i] >> 8;
         data_buf[j+1] = data[i];
-        j++;
+        j += 2;
     }
     status = i2c_write_blocking(i2c_default, devAddr, data_buf, new_len, false);