this is program how build nRF51822 to get ADXL345 data
Dependencies: BLE_API mbed nRF51822
Fork of ADXL345_I2C by
main.cpp
- Committer:
- asyrofi
- Date:
- 2018-02-19
- Revision:
- 16:e97016b6a7e0
- Parent:
- 15:a24cfc193284
- Child:
- 17:75e827cd0923
File content as of revision 16:e97016b6a7e0:
#include "mbed.h" #include "ADXL345_I2C.h" #include "ble/BLE.h" #include "ble/services/UARTService.h" #include "Serial.h" #define NEED_CONSOLE_OUTPUT 1 /* Set this if you need debug messages on the console; * it will have an impact on code-size and power consumption. */ #if NEED_CONSOLE_OUTPUT #define DEBUG(...) { printf(__VA_ARGS__); } #else #define DEBUG(...) /* nothing */ #endif /* #if NEED_CONSOLE_OUTPUT */ ADXL345_I2C accelerometer(p30, p7); BLEDevice ble; DigitalOut led1(LED1); Serial uart1(USBTX,USBRX); UARTService *uartServicePtr; void disconnectionCallback(const Gap::DisconnectionCallbackParams_t *params) { DEBUG("Disconnected!\n\r"); DEBUG("Restarting the advertising process\n\r"); ble.startAdvertising(); } void connectionCallback(const Gap::ConnectionCallbackParams_t *params) { DEBUG("Connected!\n\r"); } uint8_t b[40]={'a','d','q','w'}; void onDataWritten(const GattWriteCallbackParams *params) { if ((uartServicePtr != NULL) && (params->handle == uartServicePtr->getTXCharacteristicHandle())) { uint16_t bytesRead = params->len; DEBUG("received %u bytes %s\n\r", bytesRead,params->data); } } void periodicCallback(void) { led1 = !led1; } int threshold =6.8; int xval[10]={0}; int yval[10]={0}; int zval[10]={0}; int xavg; int yavg; int zavg; /*int calibratex() { int readings[3] = {0, 0, 0}; led1=1; int sum1 = 0; for (int i=0; i<10; i++) { accelerometer.getOutput(readings); xval[i]=(readings[0] - 345); //nilai x adxl345 sum1 = xval[i]+sum1; } xavg=sum1/10.0; led1=0; return xavg; } int calibratey() { int readings[3] = {0, 0, 0}; led1=1; long int sum2 = 0; for (int i=0; i<10; i++) { accelerometer.getOutput(readings); yval[i]=(readings[1] - 346); //nilai y adxl345 sum2 = yval[i]+sum2; } yavg=sum2/10.0; led1=0; return yavg; } int calibratez() { int readings[3] = {0, 0, 0}; led1=1; long int sum3 = 0; for (int i=0; i<10; i++) { accelerometer.getOutput(readings); zval[i]=(readings[2] - 416); //nilai z adxl345 sum3 = zval[i]+sum3; } zavg=sum3/10.0; led1=0; return zavg; }*/ int main() { uart1.baud(9600); int readings[3] = {0, 0, 0}; char buffer [20]; //inisiliasi int steps=0; int flag=0; int acc=0; int totvect [20] = {0}; int totave [20] = {0}; int totvel [20] = {0}; int totdist [20] = {0}; int totheight [20] = {0}; //float sum1, sum2, sum3 = 0 int xaccl[20]; int yaccl[20]; int zaccl[20]; // Test Daata memset(&buffer, 0, sizeof(buffer)); int16_t reading_1= 0; int16_t reading_2= 0; int16_t reading_3= 0; int16_t avg_1= 0; int16_t avg_2= 0; int16_t avg_3= 0; /* int16_t lang = 0; int16_t perc = 0; int16_t kec = 0; int16_t jar = 0; int16_t ting = 0; snprintf(buffer, 20, "data: %d,%d,%d,%d,%d\n",(int16_t)lang,(int16_t)perc,(int16_t)kec,(int16_t)jar,(int16_t)ting);*/ snprintf(buffer, 20, "data: %d,%d,%d,%d,%d,%d\n",(int16_t)reading_1,(int16_t)reading_2,(int16_t)reading_3,(int16_t)avg_1,(int16_t)avg_2,(int16_t)avg_3); led1 = 1; uart1.baud(9600); Ticker ticker; ticker.attach(periodicCallback, 1); DEBUG("Initialising the nRF51822\n\r"); ble.init(); ble.onDisconnection(disconnectionCallback); ble.onConnection(connectionCallback); ble.onDataWritten(onDataWritten); /* setup advertising */ ble.accumulateAdvertisingPayload(GapAdvertisingData::BREDR_NOT_SUPPORTED); ble.setAdvertisingType(GapAdvertisingParams::ADV_CONNECTABLE_UNDIRECTED); ble.accumulateAdvertisingPayload(GapAdvertisingData::SHORTENED_LOCAL_NAME, (const uint8_t *)"BLE UART", sizeof("BLE UART") - 1); ble.accumulateAdvertisingPayload(GapAdvertisingData::COMPLETE_LIST_128BIT_SERVICE_IDS, (const uint8_t *)UARTServiceUUID_reversed, sizeof(UARTServiceUUID_reversed)); ble.setAdvertisingInterval(1000); /* 1000ms; in multiples of 0.625ms. */ ble.startAdvertising(); UARTService uartService(ble); uartServicePtr = &uartService; uart1.printf("Starting ADXL345 test...\n"); wait(0.1); uart1.printf("Device ID is: 0x%02x\n", accelerometer.getDeviceID()); wait(0.1); //Go into standby mode to configure the device. accelerometer.setPowerControl(0x00); //Full resolution, +/-16g, 4mg/LSB. accelerometer.setDataFormatControl(0x0B); //3.2kHz data rate. accelerometer.setDataRate(ADXL345_3200HZ); //Measurement mode. accelerometer.setPowerControl(0x08); int avg1 = calibratex(); int avg2 = calibratey(); int avg3 = calibratez(); while (1) { ble.waitForEvent(); wait(0.1); accelerometer.getOutput(readings); /* uart1.printf("\n%i, %i, %i\n", (int16_t)readings[0], (int16_t)readings[1], (int16_t)readings[2]); memset(&buffer, 0, sizeof(buffer)); snprintf(buffer, 20, "data: %d,%d,%d\n\n", (int16_t)readings[0],(int16_t)readings[1],(int16_t)readings[0]); ble.updateCharacteristicValue(uartServicePtr->getRXCharacteristicHandle(), (uint8_t*)buffer, sizeof(buffer), false);*/ uart1.printf("\n%i, %i, %i\n", (int16_t)avg1, (int16_t)avg2, (int16_t)avg3); memset(&buffer, 0, sizeof(buffer)); snprintf(buffer, 20, "data: %d,%d,%d\n\n", (int16_t)avg1,(int16_t)avg2,(int16_t)avg3); ble.updateCharacteristicValue(uartServicePtr->getRXCharacteristicHandle(), (uint8_t*)buffer, sizeof(buffer), false); wait(0.1); //float x,y,z for (int i=0; i<10; i++) { xaccl[i]=(readings[0] - 345); wait(0.1); yaccl[i]=(readings[1] - 346); wait(0.1); zaccl[i]=(readings[2] - 416); wait(0.1); //formula //totvect[i] = sqrt((double)((xaccl[i]-xavg)* (xaccl[i]-xavg))+(double) ((yaccl[i] - yavg)*(yaccl[i] - yavg)) +(double) ((zaccl[i] - zavg)*(zaccl[i] - zavg))); totvect[i] = sqrt((double)(xaccl[i]*xaccl[i])+(double)(yaccl[i]*yaccl[i])+(double)(zaccl[i]*zaccl[i])); totave[i] = (totvect[i] + totvect[i-1]) / 2 ; acc=acc+totave[i]; //cal steps if (totave[i] > threshold && flag==0) { steps = steps+1; flag=1; } else if (totave[i] > threshold && flag == 1) { // do nothing } if (totave[i] < threshold && flag == 1) {flag=0;} uart1.printf("\nsteps:%i", (int16_t)steps); memset(&buffer, 0, sizeof(buffer)); snprintf(buffer, 20, "\nsteps:%d", (int16_t)steps); ble.updateCharacteristicValue(uartServicePtr->getRXCharacteristicHandle(), (uint8_t*)buffer, sizeof(buffer), false); uart1.printf("\tacc:%i", (int16_t)totave[i]); memset(&buffer, 0, sizeof(buffer)); snprintf(buffer, 20, "\tacc:%d", (int16_t)totave[i]); ble.updateCharacteristicValue(uartServicePtr->getRXCharacteristicHandle(), (uint8_t*)buffer, sizeof(buffer), false); /* totvel[i]=(totave[i]*0.2); uart1.printf("\tvel:%i", (int16_t)totvel[i]); memset(&buffer, 0, sizeof(buffer)); snprintf(buffer, 20, "\tvel:%d", (int16_t)totvel[i]); ble.updateCharacteristicValue(uartServicePtr->getRXCharacteristicHandle(), (uint8_t*)buffer, sizeof(buffer), false); totdist[i]=(totvect[i]*(0.2*0.2)/2); uart1.printf("\tdist:%i", (int16_t)totdist[i]); memset(&buffer, 0, sizeof(buffer)); snprintf(buffer, 20, "\tdist:%d", (int16_t)totdist[i]); ble.updateCharacteristicValue(uartServicePtr->getRXCharacteristicHandle(), (uint8_t*)buffer, sizeof(buffer), false); totheight[i]=sqrt((double)(xaccl[i]*xaccl[i])+(double)(yaccl[i]*yaccl[i])) * ((0.2*0.2)/2); uart1.printf("\thght:%i", (int16_t)totheight[i]); memset(&buffer, 0, sizeof(buffer)); snprintf(buffer, 20, "\thght:%d", (int16_t)totheight[i]); ble.updateCharacteristicValue(uartServicePtr->getRXCharacteristicHandle(), (uint8_t*)buffer, sizeof(buffer), false);*/ } } }