From 19801c2a3b37917a7690775e5364180164c30706 Mon Sep 17 00:00:00 2001
From: naum <alphatech56@gmail.com>
Date: Sat, 3 Dec 2022 21:06:45 -0500
Subject: [PATCH] bug in I2Cdev::writeWords #726

I2Cdev::writeWords work incorrectly if len is greater than 1.
---
 RP2040/I2Cdev/I2Cdev.cpp | 2 +-
 1 file changed, 1 insertion(+), 1 deletion(-)

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);