Diff: ACS.cpp

Revision:

9:7936b618a879

Parent:

8:6d856d863537

--- a/ACS.cpp	Wed Mar 04 18:14:01 2015 +0000
+++ b/ACS.cpp	Mon Apr 06 15:53:24 2015 +0000
@@ -7,8 +7,8 @@
                         //PWM output comes from pins p6
 Serial pc1(USBTX, USBRX);
 SPI spi_acs (PIN16, PIN17, PIN15); // mosi, miso, sclk  PTE18,19,17
-DigitalOut SSN_MAG (PTC16); // ssn for magnetometer PTB11
-DigitalInOut DRDY (PTE3); // drdy for magnetometer PTA17
+DigitalOut SSN_MAG (PIN61); // ssn for magnetometer PTB11
+DigitalInOut DRDY (PIN47); // drdy for magnetometer PTA17
 DigitalOut ssn_gyr (PTE2);         //Slave Select pin of gyroscope  PTB16
 InterruptIn dr(PTC6);       //Interrupt pin for gyro PTC5
 PwmOut PWM1(D2);        //Functions used to generate PWM signal 
@@ -228,7 +228,7 @@
    DRDY.write(0);
    int a;
    a = DRDY;
-   printf("\n\r DRDY is %d\n\r",a);
+   //printf("\n\r DRDY is %d\n\r",a);
    SSN_MAG=0;                                //enabling slave to measure the values
    wait_ms(10);
    spi_acs.write(0x82);                     //initiates measurement
@@ -355,12 +355,12 @@
         
         for(i=0;i<3;i++)
         {
-            printf("\n\rreached here\n\r");
+         //   printf("\n\rreached here\n\r");
             if(den!=0)
                 b[i]=b[i]/den;                                      //there is a problem here. The code gets stuck here.  Maf value is required 
                 
         }
-        
+        //printf("\nhere\n");
 // select kz, kmu, gamma
         if(b[0]>0.9 || b[0]<-0.9)
         {
@@ -368,6 +368,7 @@
             kmu = kmu2;
             gamma = gamma2;
         }
+        printf("\nhere\n");
 // calculate Mu, v, dv, z, u
         for(i=0;i<2;i++)
         {