Diff: main.cpp

Branch:

Cheetah_noflash

Revision:

55:081470dee393

Parent:

53:e85efce8c1eb

--- a/main.cpp	Thu Aug 08 17:39:43 2019 +0000
+++ b/main.cpp	Thu Jan 02 09:11:07 2020 +0000
@@ -101,7 +101,13 @@
     wait_us(10);
     printf(" z - Set Zero Position\n\r");
     wait_us(10);
-    printf(" esc - Exit to Menu\n\r");
+    printf(" p - Print flash data\n\r");
+    wait_us(10);
+    printf(" o - Write flash data\n\r");
+    wait_us(10);
+    printf(" i - Read flash data\n\r");
+    wait_us(10);
+    printf(" q - Exit to Menu\n\r");
     wait_us(10);
     state_change = 0;
     gpio.led->write(0);
@@ -150,7 +156,7 @@
     calibrate(&spi, &gpio, &controller, &prefs);                                // Perform calibration procedure
     gpio.led->write(0);;                                                     // Turn off status LED
     wait(.2);
-    printf("\n\r Calibration complete.  Press 'esc' to return to menu\n\r");
+    printf("\n\r Calibration complete.  Press 'q' to return to menu\n\r");
     drv.disable_gd();
     //gpio.enable->write(0);
      state_change = 0;
@@ -253,7 +259,8 @@
 void serial_interrupt(void){
     while(pc.readable()){
         char c = pc.getc();
-        if(c == 27){
+        //if(c == 27){
+        if(c == 'q'){
                 state = REST_MODE;
                 state_change = 1;
                 char_count = 0;
@@ -279,6 +286,24 @@
                     state = SETUP_MODE;
                     state_change = 1;
                     break;
+                case 'p':
+                    printf("__int_reg\r\n");
+                    for(int i = 0; i<=132; i++){printf("i:%d,int:%d\n\r", i,__int_reg[i]);}
+                    printf("__float_reg\r\n");
+                    for(int i = 0; i<=9; i++){printf("i:%d,float:%0.5f\n\r", i,__float_reg[i]);}
+                    printf("Print data over");
+                    break;
+                case 'o':
+                    if (!prefs.ready()) prefs.open();
+                        prefs.flush();                                                  // Write new prefs to flash
+                        prefs.close();    
+                        prefs.load(); 
+                    printf("Write flash data over");
+                    break;
+                case 'i':
+                    prefs.load(); 
+                    printf("Read flash data over");
+                    break;
                 case 'z':
                     spi.SetMechOffset(0);
                     spi.Sample(DT);
@@ -342,7 +367,7 @@
             }
         else if (state == ENCODER_MODE){
             switch (c){
-                case 27:
+                case 'q':
                     state = REST_MODE;
                     state_change = 1;
                     break;
@@ -363,8 +388,8 @@
     controller.v_bus = V_BUS;
     controller.mode = 0;
     Init_All_HW(&gpio);                                                         // Setup PWM, ADC, GPIO
-    wait(.1);
-    
+    //wait(.1);
+    wait(1);    
     gpio.enable->write(1);
     wait_us(100);
     drv.calibrate();
@@ -435,8 +460,9 @@
     printf(" CAN ID:  %d\n\r", CAN_ID);
     
 
-
-
+    
+    
+    
     //printf(" %d\n\r", drv.read_register(DCR));
     //wait_us(100);
     //printf(" %d\n\r", drv.read_register(CSACR));
@@ -463,6 +489,7 @@
             wait(.002);
         }
         */
+        
 
     }
 }