From 1d5350dbf3841f6a7c9a788efdf45cf0d6797339 Mon Sep 17 00:00:00 2001
From: Nahuel Greco <ngreco@gmail.com>
Date: Tue, 3 Dec 2013 19:39:59 -0300
Subject: [PATCH] Fixed a bug when removing a monitored device with
 I2C_STOP_READING from the devices array

---
 examples/StandardFirmata/StandardFirmata.ino | 2 +-
 1 file changed, 1 insertion(+), 1 deletion(-)

diff --git a/examples/StandardFirmata/StandardFirmata.ino b/examples/StandardFirmata/StandardFirmata.ino
index 974fbdca..f886ad86 100644
--- a/examples/StandardFirmata/StandardFirmata.ino
+++ b/examples/StandardFirmata/StandardFirmata.ino
@@ -402,7 +402,7 @@ void sysexCallback(byte command, byte argc, byte *argv)
         for (byte i = queryIndexToSkip; i<queryIndex + 1; i++) {
           if (i < MAX_QUERIES) {
             query[i].addr = query[i+1].addr;
-            query[i].reg = query[i+1].addr;
+            query[i].reg = query[i+1].reg;
             query[i].bytes = query[i+1].bytes; 
           }
         }