Diff: ReadCommand.cpp

Revision:

3:32afe87d4b62

Parent:

2:c9e47ac47edb

Child:

4:f81029197ab2

--- a/ReadCommand.cpp	Sun Jun 07 17:49:23 2015 +0000
+++ b/ReadCommand.cpp	Sun Jun 07 21:57:46 2015 +0000
@@ -37,32 +37,27 @@
 
 void ReadCommand::readFromMemory()
 {
-    float angle;
-    float gyro;
-
-    for(int i = 0; i <= OfflineCommand::getLastAddress(); i = i + 4 ) {
-        this->storage->read(i);
+    uint8_t angle[2]= {0,0};
+    int8_t imu[2]= {0,0};
 
-/*
-        this->storage->readData();
-        this->storage->readData();
-        this->storage->readData();
-        this->storage->readData();
+    uint32_t addr = 0; 
+    
+    do{
+        storage->read(addr);
 
-        this->storage->endAction();
+        angle[0] = storage->readData();
+        angle[1] = storage->readData();
+        imu[0] = storage->readData();
+        imu[1] = storage->readData();
 
-        angle = ((angle_H << 8) + angle_L) * 0.087912087;
-        
+        storage->endAction();
         
-        gyro = ((float)((imu_H << 8) + imu_L)) / 200;
-        //float xgyro = ((float)sensors->getGyroX())/200;
-     
-
-        printf("Memory: angle = %.2f, gyroX =  %.4f\n", angle, gyro);
-        */
-    }
-
-
+        printf("Memory: angle = %.2f, ", ((float)(angle[0] << 8) + angle[1]) * 0.087912087);
+        printf("accelX = %.2f\n", ((float)(imu[0] << 8) + imu[1]) / 16.4);
+        addr = addr + 4;
+        
+    } while(angle[0] != 255);
+    
     printf("DONE!\n");
 }