Diff: main.cpp

Revision:

3:42d01cfd6477

Parent:

2:8e9a39eff1c8

Child:

4:df821f0e9ad7

--- a/main.cpp	Wed Mar 29 23:42:38 2017 +0000
+++ b/main.cpp	Thu Mar 30 02:15:11 2017 +0000
@@ -6,20 +6,25 @@
 GpioDigitalOut  Bat2EN( gpio_exp, X0_1 );
 GpioDigitalOut  Bat1EN( gpio_exp, X0_0 );
  
-Serial pc(PA_11, PA_12);
+Serial pi(PA_11, PA_12);
 DigitalOut EN33(PA_8);
 DigitalOut EN_PI_PWR(PA_9);
 DigitalOut EN_SERVO_PWR(PB_5);
 DigitalOut EN_LIGHTS_PWR(PA_10);
 DigitalOut BAT_PWR_EN(PB_10);
+AnalogIn BatS1(PA_0);
+AnalogIn BatS2(PA_3);
+
 int main() {
-      int i = 1;
+    int i = 1;
+    float BatS1V;
+    float BatS2V;
     pc.printf("Hello World !\n");
     Bat3EN = 1;
     Bat2EN = 1;
     Bat1EN = 1;
     EN33 = 1;
-    
+
     EN_SERVO_PWR = 1;
     //EN_LIGHTS_PWR = 1;
     //EN_PI_PWR = 1;
@@ -27,8 +32,10 @@
     while( 1 ) {
         wait(3);
         //BAT_PWR_EN = !BAT_PWR_EN;
-        pc.printf("This program runs since %d seconds.\n", i++);
-        
+        pi.printf("This program runs since %d seconds.\n", i++);
+        BatS1V = BatS1*(3.30/0.25);
+        BatS2V = BatS2*(3.30/0.25);
+        pi.printf("Battery 1 Voltage = %d Battery 2 Voltage = %d", static_cast<int>(BatS1V),static_cast<int>(BatS2V));
  
         }
     }