Diff: mdcompat.cpp

Revision:

3:8f2d21735748

Parent:

2:e7e761471df9

Child:

4:f395d9cc57c4

--- a/mdcompat.cpp	Tue Aug 08 08:38:48 2017 +0000
+++ b/mdcompat.cpp	Tue Aug 08 14:14:26 2017 +0000
@@ -20,10 +20,10 @@
     unsigned char slave_addr,
     unsigned char reg_addr,
     unsigned char length,
-    char const *data) {
+    char const *data) {const char RA[]={reg_addr};
         
-    imu9250.write((int)slave_addr,(char const*)reg_addr,1,true);//sending register adress first to indicate which register we are writing and a write register(0)
-    imu9250.write((int)slave_addr,data,(int)length,false);
+    imu9250.write((int)slave_addr<<1,RA,1,1);//sending register adress first to indicate which register we are writing and a write register(0)
+    imu9250.write((int)slave_addr<<1,data,(int)length,0);
     
     return 0;
 }
@@ -32,9 +32,9 @@
     unsigned char slave_addr,
     unsigned char reg_addr,
     unsigned char length,
-    char *data) {
-    imu9250.write((int)slave_addr,(const char*)reg_addr, 1, 1); // no stop
-    imu9250.read((unsigned int)slave_addr, data, 1, 0); 
+    char *data) {const char RA[]={reg_addr};
+    imu9250.write((int)slave_addr<<1,RA, 1, 1); // no stop
+    imu9250.read((int)slave_addr<<1, data, 1, 0); 
     return 0; 
 }