GPIO D10 High-Low Based on Height

Dependencies:   FXOS8700Q mbed

main.cpp

Committer:
chavan
Date:
2018-03-30
Revision:
1:643da51350f0
Parent:
0:748d42bc36b2

File content as of revision 1:643da51350f0:

#include "mbed.h"
#include "FXOS8700Q.h"
FXOS8700Q_acc acc( PTE25, PTE24, FXOS8700CQ_SLAVE_ADDR1);
FXOS8700Q_mag mag( PTE25, PTE24, FXOS8700CQ_SLAVE_ADDR1);
//Temrinal enable
Serial pc(USBTX, USBRX);
MotionSensorDataUnits mag_data;
MotionSensorDataUnits acc_data;


InterruptIn switch1(SW2);

//Setting the motor Pin
DigitalOut motorPin(D10);


void switch1ISR(){
    switch1.fall(NULL);
    //v=1;
    switch1.fall(&switch1ISR);
}

int main()
{
    int cnt =0;
    float faX, faY, faZ;
    float fmX, fmY, fmZ;
    acc.enable();
    printf("\r\n\nFXOS8700Q Who Am I= %X\r\n", acc.whoAmI());
    while (true)
    {
        acc.getAxis(acc_data);
        mag.getAxis(mag_data);
        printf("FXOS8700Q ACC: X=%1.4f Y=%1.4f Z=%1.4f ", acc_data.x, acc_data.y, acc_data.z);
        printf(" MAG: X=%4.1f Y=%4.1f Z=%4.1f\r\n", mag_data.x, mag_data.y, mag_data.z);
        acc.getX(&faX);
        acc.getY(&faY);
        acc.getZ(&faZ);
        mag.getX(&fmX);
        mag.getY(&fmY);
        mag.getZ(&fmZ);
        printf("FXOS8700Q ACC: X=%1.4f Y=%1.4f Z=%1.4f ", faX, faY, 1000*faZ);
        printf(" MAG: X=%4.1f Y=%4.1f Z=%4.1f\r\n", fmX, fmY, fmZ);

        wait(10);
        if(1000*faZ<1001)
      {  motorPin = 1;
        cnt = 1;
        wait(10);
        }
      else ( cnt = 0);
       { motorPin = 0;
       wait(10);
   }
}
}