Controlor for Humanoid. Walking trajectory generator, sensor reflection etc.

Dependencies:   Adafruit-PWM-Servo-Driver MPU6050 RS300 mbed

Revision:
11:1539d181e159
Parent:
10:be8b10e54ecb
Child:
12:6cd135bf03bd
--- a/main.cpp	Sat Sep 22 06:58:21 2012 +0000
+++ b/main.cpp	Sat Sep 22 10:24:14 2012 +0000
@@ -8,21 +8,21 @@
 
 int main(void)
 {  
-    unsigned char size_x = 4, size_y = 24;
+    unsigned short int size_x = 400;    //max about 25kb
+    unsigned char size_y = 25;
     
-    uint32_t **array = new uint32_t*[size_x];
+    uint16_t **array = new uint16_t*[size_x];
 	for (int i = 0; i < size_x; ++i) {
-		array[i] = new uint32_t[size_y];
+		array[i] = new uint16_t[size_y];
 	}
 	for (int i = 0; i < size_x; ++i) {
 	    for (int j = 0; j < size_y; ++j) {
-	        array[i][j] = 900 + 300 * i;
+	        array[i][j] = 900 + 2*i;
 	    }
 	}
-	array[0][size_y - 1] = 50;
-	array[1][size_y - 1] = 50;
-	array[2][size_y - 1] = 50;
-	array[3][size_y - 1] = 50;
+	for (int i = 0; i < size_x; ++i) {
+	    array[i][size_y - 1] = 1;
+	}
 	
     Motion inter0(array, size_x, size_y);
     
@@ -33,6 +33,6 @@
         if (!inter0.is_in_interrupt()) {
             tick.attach(&inter0, &Motion::step, 0.02);
         }
-        wait(0.02);
+        wait(0.05);
     }
 }
\ No newline at end of file