Fix array index in BNO055_tty_read().

diff --git a/lib/bno055_tty.c b/lib/bno055_tty.c
index 1adfcc3..d27e1a7 100644 (file)
--- a/lib/bno055_tty.c
+++ b/lib/bno055_tty.c
@@ -108,7 +108,7 @@ s8 BNO055_tty_read(u8 dev_addr,u8 reg_addr,u8 *reg_data,u8 cnt)
                        if(length > BUFFER_LEN) length=BUFFER_LEN;
                        n=0;
                        while(n < length) if((n+=read(dev_addr,array+n,length-n))==-1) return BNO055_ERROR;
-                       for(i=0;i < cnt && i < length;i++) *(reg_data+i)=array[i+2];
+                       for(i=0;i < cnt && i < length;i++) *(reg_data+i)=array[i];
                        break;
                        
                case BNO055_UART_ACK: