bspAcc.cpp

00001 
00002 #include "mbed.h"
00003 #include "Lis2dh12.h"
00004 #include "Lis2dh12_regs.h"
00005 #include "bspAcc.h"
00006 #include "main.h"
00007 
00008 
00009 extern DigitalOut AccVcc;
00010 
00011 extern Lis2dh12 mems;
00012 
00013 extern InterruptIn INT1;
00014 
00015 void init_acc()
00016 {
00017     INT1.disable_irq();
00018     //__disable_irq();
00019     
00020     AccVcc = 1;
00021     
00022     wait_ms(POWER_UP_DELAY_MS);
00023     
00024     //__enable_irq();
00025     
00026     mems.setMode(LOW_POWER);
00027     //mems.setMode(HIGH_RES);
00028     mems.enableAxes(X_axis);
00029     mems.enableAxes(Y_axis);
00030     mems.enableAxes(Z_axis);    
00031     mems.setODR(ACC_ODR_MODE);
00032     //mems.setScale(_16g);
00033     mems.setScale(_8g);
00034     mems.int1Setup(0x40);       // IntActivity 1 driven to INT1 pad
00035     mems.int1Latch(0x01);       // Enable int1 latch
00036     mems.int1Threshold(INT1_THRESHOLD); 
00037     mems.int1Duration(INT1_DUR);            
00038     mems.int1Config(0x2A);      // Enable XHigh, YHigh and ZHigh
00039     
00040     //__enable_irq();
00041     INT1.enable_irq();
00042 }