Jurica Resetar / Mbed OS acnSensa_LIS

Edit

Dependencies:   Lis2dh12 aconno_I2C aconno_nrf52_uart adc52832_common aconno_SEGGER_RTT

source/main.cpp@10:83dab6cc625d, 2018-02-28 (annotated)

Committer:
jurica238814
Date:
Wed Feb 28 19:59:55 2018 +0000
Branch:
NanoModule
Revision:
10:83dab6cc625d
Parent:
9:a9c5db477f35
Child:
12:d5d47f848af5
RTT included for debugging.

Who changed what in which revision?

UserRevisionLine numberNew contents of line
jurica238814 3:f2078081a779 1 /*
jurica238814 3:f2078081a779 2 * aconno.de
jurica238814 3:f2078081a779 3 * Made by Jurica Resetar
jurica238814 3:f2078081a779 4 * All right reserved
jurica238814 3:f2078081a779 5 *
jurica238814 3:f2078081a779 6 */
jurica238814 3:f2078081a779 7
jurica238814 3:f2078081a779 8 #include "main.h"
jurica238814 3:f2078081a779 9
jurica238814 3:f2078081a779 10 void disableI2C(){
jurica238814 3:f2078081a779 11 NRF_TWI0->ENABLE = 0;
jurica238814 3:f2078081a779 12 NRF_TWI0->PSELSCL = 0xFFFFFFFF;
jurica238814 3:f2078081a779 13 NRF_TWI1->ENABLE = 0;
jurica238814 3:f2078081a779 14 NRF_TWI1->PSELSCL = 0xFFFFFFFF;
jurica238814 3:f2078081a779 15 NRF_TWIM0->ENABLE = 0;
jurica238814 3:f2078081a779 16 NRF_TWIM0->PSEL.SCL = 0x80000000;
jurica238814 3:f2078081a779 17 NRF_TWIM0->PSEL.SDA = 0x80000000;
jurica238814 3:f2078081a779 18 NRF_TWIM1->ENABLE = 0;
jurica238814 3:f2078081a779 19 NRF_TWIM0->PSEL.SCL = 0x80000000;
jurica238814 3:f2078081a779 20 NRF_TWIM0->PSEL.SDA = 0x80000000;
jurica238814 3:f2078081a779 21 DigitalOut foo(I2C_DATA);
jurica238814 3:f2078081a779 22 DigitalOut bar(I2C_CLK);
jurica238814 3:f2078081a779 23 foo = 1;
jurica238814 3:f2078081a779 24 bar = 1;
jurica238814 3:f2078081a779 25 }
jurica238814 3:f2078081a779 26
jurica238814 3:f2078081a779 27 void disableBle(){
jurica238814 3:f2078081a779 28 bleTicker.detach();
jurica238814 3:f2078081a779 29 bleT.signal_set(DISABLE_BLE_SIG);
jurica238814 3:f2078081a779 30 }
jurica238814 3:f2078081a779 31
jurica238814 3:f2078081a779 32 void int1Handler(){
jurica238814 3:f2078081a779 33 __disable_irq();
jurica238814 10:83dab6cc625d 34 //I2C i2c(I2C_DATA,I2C_CLK);
jurica238814 3:f2078081a779 35 mems.clearIntFlag();
jurica238814 3:f2078081a779 36 bleT.signal_set(ACC_INT_SIG);
jurica238814 3:f2078081a779 37 bleTicker.attach(disableBle, BLE_ACTIVE_TIME_S);
jurica238814 10:83dab6cc625d 38 //disableI2C();
jurica238814 3:f2078081a779 39 __enable_irq();
jurica238814 10:83dab6cc625d 40
jurica238814 3:f2078081a779 41 }
jurica238814 3:f2078081a779 42
jurica238814 3:f2078081a779 43
jurica238814 3:f2078081a779 44 void bleF(BLE *ble){
jurica238814 3:f2078081a779 45 // Thread function for managing BLE radio
jurica238814 3:f2078081a779 46 // First wait for acc interrupt signal
jurica238814 3:f2078081a779 47 while(true){
jurica238814 3:f2078081a779 48 Thread::signal_wait(ACC_INT_SIG);
jurica238814 3:f2078081a779 49 Thread::signal_clr(ACC_INT_SIG);
jurica238814 10:83dab6cc625d 50 //I2C i2c(I2C_DATA,I2C_CLK);
jurica238814 10:83dab6cc625d 51 printf("Interrupt on accelerometer.\r\n");
jurica238814 10:83dab6cc625d 52 printf("X acceleration data: %d [mg]\r\n", mems.readXAxis()*LSB_VALUE);
jurica238814 10:83dab6cc625d 53 printf("Y acceleration data: %d [mg]\r\n", mems.readYAxis()*LSB_VALUE);
jurica238814 10:83dab6cc625d 54 printf("Z acceleration data: %d [mg]\r\n", mems.readZAxis()*LSB_VALUE);
jurica238814 10:83dab6cc625d 55 //disableI2C();
jurica238814 10:83dab6cc625d 56 //__enable_irq();
jurica238814 10:83dab6cc625d 57
jurica238814 3:f2078081a779 58 ble->gap().startAdvertising();
jurica238814 10:83dab6cc625d 59 printf("Ble advertisement is ON.\r\n");
jurica238814 3:f2078081a779 60 #if DEBUG_LED
jurica238814 3:f2078081a779 61 redLed = 0;
jurica238814 3:f2078081a779 62 #endif
jurica238814 3:f2078081a779 63 Thread::signal_wait(DISABLE_BLE_SIG);
jurica238814 3:f2078081a779 64 Thread::signal_clr(DISABLE_BLE_SIG);
jurica238814 3:f2078081a779 65 ble->gap().stopAdvertising();
jurica238814 10:83dab6cc625d 66 printf("Ble advertisement is OFF.\r\n\r\n");
jurica238814 3:f2078081a779 67 #if DEBUG_LED
jurica238814 3:f2078081a779 68 redLed = 1;
jurica238814 3:f2078081a779 69 #endif
jurica238814 3:f2078081a779 70 }
jurica238814 3:f2078081a779 71 }
jurica238814 3:f2078081a779 72
jurica238814 10:83dab6cc625d 73 void measureF( void )
jurica238814 10:83dab6cc625d 74 {
jurica238814 10:83dab6cc625d 75 while(1){
jurica238814 10:83dab6cc625d 76 printf("X acceleration data: %d [mg]\r\n", mems.readXAxis()*LSB_VALUE);
jurica238814 10:83dab6cc625d 77 printf("Y acceleration data: %d [mg]\r\n", mems.readYAxis()*LSB_VALUE);
jurica238814 10:83dab6cc625d 78 printf("Z acceleration data: %d [mg]\r\n\r\n", mems.readZAxis()*LSB_VALUE);
jurica238814 10:83dab6cc625d 79 wait_ms(1000);
jurica238814 10:83dab6cc625d 80 }
jurica238814 10:83dab6cc625d 81 }
jurica238814 10:83dab6cc625d 82
jurica238814 3:f2078081a779 83 int main(){
jurica238814 8:4b1ac4733b3d 84
jurica238814 10:83dab6cc625d 85 printf("Main program started.\r\n");
jurica238814 10:83dab6cc625d 86
jurica238814 8:4b1ac4733b3d 87 NRF_NVMC->CONFIG = 0x00000002; // Erase enable UICR
jurica238814 8:4b1ac4733b3d 88 NRF_NVMC->ERASEUICR = 0x00000001; // Erase all
jurica238814 8:4b1ac4733b3d 89 NRF_NVMC->CONFIG = 0x00000001; // Write enable UICR
jurica238814 8:4b1ac4733b3d 90 NRF_UICR->NFCPINS = 0xFFFFFFFE; // Change NFC to GPIO function
jurica238814 8:4b1ac4733b3d 91
jurica238814 3:f2078081a779 92 redLed = 1;
jurica238814 3:f2078081a779 93 AccVcc = 1;
jurica238814 3:f2078081a779 94 wait_ms(POWER_UP_DELAY_MS);
jurica238814 3:f2078081a779 95
jurica238814 3:f2078081a779 96 INT1.rise(int1Handler);
jurica238814 3:f2078081a779 97 NRF_GPIO->PIN_CNF[INT_PIN1] &= 0xFFFFFFF3; // NO PullUps
jurica238814 3:f2078081a779 98
jurica238814 3:f2078081a779 99 BLE &ble = BLE::Instance();
jurica238814 3:f2078081a779 100 ble.init(bleInitComplete);
jurica238814 3:f2078081a779 101
jurica238814 3:f2078081a779 102 mems.setMode(LOW_POWER);
jurica238814 3:f2078081a779 103
jurica238814 10:83dab6cc625d 104 mems.enableAxes(X_axis);
jurica238814 10:83dab6cc625d 105 mems.enableAxes(Y_axis);
jurica238814 3:f2078081a779 106 mems.enableAxes(Z_axis);
jurica238814 10:83dab6cc625d 107 mems.setODR(ODR_50Hz);
jurica238814 3:f2078081a779 108 mems.int1Setup(0x40); // IntActivity 1 driven to INT1 pad
jurica238814 3:f2078081a779 109 mems.int1Latch(0x01); // Enable int1 latch
jurica238814 9:a9c5db477f35 110 mems.int1Threshold(INT1_THRESHOLD);
jurica238814 10:83dab6cc625d 111 mems.int1Duration(INT1_DUR);
jurica238814 10:83dab6cc625d 112 mems.int1Config(0x2A); // Enable XHigh, YHigh and ZHigh
jurica238814 3:f2078081a779 113
jurica238814 3:f2078081a779 114 bleT.start(callback(bleF, &ble)); // Start bleT
jurica238814 10:83dab6cc625d 115 //measureT.start(callback(measureF));
jurica238814 3:f2078081a779 116
jurica238814 3:f2078081a779 117 while(1){
jurica238814 10:83dab6cc625d 118 //disableI2C();
jurica238814 3:f2078081a779 119 Thread::wait(0xFFFFFFFF);
jurica238814 3:f2078081a779 120 }
jurica238814 3:f2078081a779 121 }