shunpei kataoka / Mbed 2 deprecated 01

mbed final

Dependencies:   ADXL345_I2C BLE_API SDFileSystem mbed-rtos mbed nRF51822

Fork of 01 by Shuta Nakamae

main.cpp@3:ca3f581d4a0b, 2017-01-24 (annotated)

Committer:
kataokashunpei
Date:
Tue Jan 24 23:45:58 2017 +0000
Revision:
3:ca3f581d4a0b
Parent:
2:e103492f1a0b 
push final

Who changed what in which revision?

UserRevisionLine numberNew contents of line
nakamae 0:07880269e91a 1 #include "mbed.h"
nakamae 0:07880269e91a 2 #include "ble/BLE.h"
nakamae 0:07880269e91a 3 #include "ble/services/HeartRateService.h"
nakamae 0:07880269e91a 4 #include "ble/services/BatteryService.h"
nakamae 0:07880269e91a 5 #include "ble/services/DeviceInformationService.h"
nakamae 0:07880269e91a 6 #include "rtos.h"
nakamae 0:07880269e91a 7 #include "ADXL345_I2C.h"
nakamae 0:07880269e91a 8 #include <string.h>
nakamae 0:07880269e91a 9 #include "SDFileSystem.h"
nakamae 0:07880269e91a 10 #define N 100//addressを保存する個数
nakamae 0:07880269e91a 11 #define M 6//addressとtimeを入れる
nakamae 0:07880269e91a 12 #define GET_TIME 10000
nakamae 0:07880269e91a 13 #define SEND_TIME 20000
kataokashunpei 3:ca3f581d4a0b 14 #define AD 0xEE
nakamae 2:e103492f1a0b 15
nakamae 0:07880269e91a 16 DigitalOut myled3(LED3);
nakamae 0:07880269e91a 17 Semaphore one_slot(1);
nakamae 0:07880269e91a 18 Timer timer;
nakamae 0:07880269e91a 19 BLE ble;
nakamae 0:07880269e91a 20 char address[N][M]={};//保存する配列を初期化
nakamae 0:07880269e91a 21 const GapScanningParams scanningParams;
nakamae 0:07880269e91a 22 int wt;//threadの時間
nakamae 0:07880269e91a 23 int wt1=0;//central mode の時間
nakamae 0:07880269e91a 24 int ran;
nakamae 2:e103492f1a0b 25 int countfp=0;
kataokashunpei 3:ca3f581d4a0b 26 char id[] = "/sd/a.csv";
kataokashunpei 3:ca3f581d4a0b 27 char acc[] = "/sd/a_acc.csv";
nakamae 0:07880269e91a 28
nakamae 0:07880269e91a 29 //加速度センサー
nakamae 0:07880269e91a 30 ADXL345_I2C accelerometer(p7, p30);
nakamae 0:07880269e91a 31 SDFileSystem sd(p25, p28, p29, p21, "sd"); // the pinout on the mbed Cool Components workshop board
nakamae 0:07880269e91a 32 FILE *fp, *kp;
nakamae 0:07880269e91a 33 int counter=0,i,b,flag;
nakamae 0:07880269e91a 34 int readings[3] = {0, 0, 0};
nakamae 0:07880269e91a 35
nakamae 0:07880269e91a 36 void onScanCallback(const Gap::AdvertisementCallbackParams_t *params){
nakamae 0:07880269e91a 37 flag=0;//重複確認のためのフラグ
nakamae 0:07880269e91a 38 for(i=0;i<counter;i++){
nakamae 0:07880269e91a 39 if(address[i][0] == params->peerAddr[0]){
nakamae 0:07880269e91a 40 flag=1;
nakamae 0:07880269e91a 41 break;
nakamae 0:07880269e91a 42 }
nakamae 0:07880269e91a 43 }
nakamae 0:07880269e91a 44 if(flag==0){
nakamae 0:07880269e91a 45 for(i=0; i<6; i++){
nakamae 0:07880269e91a 46 address[counter][i]=params->peerAddr[i];
nakamae 0:07880269e91a 47 }
nakamae 0:07880269e91a 48 time_t seconds = time(NULL);
nakamae 0:07880269e91a 49
nakamae 0:07880269e91a 50 char buff[10]={};
nakamae 0:07880269e91a 51 sprintf(buff, "%d", seconds);
nakamae 0:07880269e91a 52 strcat(address[counter],buff);
nakamae 0:07880269e91a 53
nakamae 0:07880269e91a 54 for(b=0; b<6 ; b++){
nakamae 0:07880269e91a 55 fprintf(fp,"%02x", address[counter][b]);
nakamae 2:e103492f1a0b 56 //printf("%02x", address[counter][b]);
nakamae 0:07880269e91a 57 }
nakamae 0:07880269e91a 58 fprintf(fp, ",%d\r\n",seconds);
nakamae 2:e103492f1a0b 59 //printf(" %d\r\n",seconds);
nakamae 0:07880269e91a 60 counter++;
nakamae 0:07880269e91a 61
nakamae 0:07880269e91a 62 /* printf("DEV:");
nakamae 0:07880269e91a 63 for(b=0; b<6 ; b++)printf("%02x ", address[counter][b]);
nakamae 0:07880269e91a 64 printf("%04d/%02d/%02d %02d:%02d:%02d \r\n",address[counter][6],address[counter][7],address[counter][8],address[counter][9],address[counter][10],address[counter][11]);*/
nakamae 0:07880269e91a 65
nakamae 0:07880269e91a 66
nakamae 0:07880269e91a 67 }
nakamae 0:07880269e91a 68 }
nakamae 0:07880269e91a 69
nakamae 0:07880269e91a 70 void test_thread(void const *name) {
nakamae 0:07880269e91a 71
nakamae 0:07880269e91a 72 while (true) {
nakamae 0:07880269e91a 73 //Timer timer;
nakamae 0:07880269e91a 74 one_slot.wait();
nakamae 0:07880269e91a 75
nakamae 0:07880269e91a 76 if(!strcmp((const char*)name, "1")){
nakamae 0:07880269e91a 77 //printf("**startAdvertising thread**\n\r");
nakamae 0:07880269e91a 78 wt=1000;
nakamae 0:07880269e91a 79 ble.gap().stopAdvertising();
nakamae 0:07880269e91a 80 ble.startScan(&onScanCallback);
nakamae 0:07880269e91a 81 }
nakamae 0:07880269e91a 82 //2
nakamae 0:07880269e91a 83 if(!strcmp((const char*)name, "2")){
nakamae 2:e103492f1a0b 84 memset(address, 0, sizeof(address));//配列の初期化
nakamae 0:07880269e91a 85 counter = 0;
nakamae 2:e103492f1a0b 86 //printf("**get**\n\r");
nakamae 0:07880269e91a 87 myled3 = 0;
nakamae 0:07880269e91a 88 wt=0;//central modeの際はthreadの時間は0sec
nakamae 0:07880269e91a 89 wt1 = GET_TIME ;//centralmode の時間はこっち
nakamae 0:07880269e91a 90
kataokashunpei 3:ca3f581d4a0b 91 if(countfp == 0){
nakamae 2:e103492f1a0b 92 fp = fopen( id , "w");
nakamae 2:e103492f1a0b 93 fclose(fp);
nakamae 2:e103492f1a0b 94 kp = fopen( acc , "w");
nakamae 2:e103492f1a0b 95 fclose(kp);
nakamae 2:e103492f1a0b 96 countfp = 1;
nakamae 2:e103492f1a0b 97 }
nakamae 0:07880269e91a 98
nakamae 2:e103492f1a0b 99 fp = fopen( id , "a");
nakamae 2:e103492f1a0b 100 kp = fopen( acc , "a");
nakamae 2:e103492f1a0b 101
nakamae 2:e103492f1a0b 102 //printf("%d seconds receive\n\r",wt1/1000);
nakamae 0:07880269e91a 103 timer.start();
nakamae 2:e103492f1a0b 104
nakamae 0:07880269e91a 105 while(1){
nakamae 0:07880269e91a 106 myled3 = !myled3;
nakamae 0:07880269e91a 107 time_t seconds = time(NULL);
nakamae 0:07880269e91a 108 accelerometer.getOutput(readings);
nakamae 0:07880269e91a 109 //13-bit, sign extended values.
nakamae 0:07880269e91a 110 // printf("%f, %f, %f",(int16_t)readings[0]*(9.8/256), (int16_t)readings[1]*(9.8/256), (int16_t)readings[2]*(9.8/256));
nakamae 0:07880269e91a 111 // printf(": %d\r\n",seconds);
nakamae 0:07880269e91a 112 fprintf(kp,"%f,%f,%f",(int16_t)readings[0]*(9.8/256), (int16_t)readings[1]*(9.8/256), (int16_t)readings[2]*(9.8/256));
nakamae 0:07880269e91a 113 fprintf(kp, ",%d\n",seconds);
nakamae 0:07880269e91a 114
nakamae 0:07880269e91a 115 ble.waitForEvent();
nakamae 0:07880269e91a 116 if(timer.read() > wt1/1000){
nakamae 0:07880269e91a 117 timer.stop();
nakamae 0:07880269e91a 118 timer.reset();
nakamae 0:07880269e91a 119 ble.stopScan();
nakamae 0:07880269e91a 120 fclose(fp);
nakamae 0:07880269e91a 121 fclose(kp);
nakamae 0:07880269e91a 122
nakamae 0:07880269e91a 123 break;
nakamae 0:07880269e91a 124 }
nakamae 0:07880269e91a 125 }
nakamae 0:07880269e91a 126
nakamae 0:07880269e91a 127 }
nakamae 0:07880269e91a 128
nakamae 0:07880269e91a 129 //3
nakamae 0:07880269e91a 130 if(!strcmp((const char*)name, "3")){
nakamae 2:e103492f1a0b 131 //printf("**send**\n\r");
nakamae 0:07880269e91a 132 ran = rand() % 10;
nakamae 0:07880269e91a 133 wt= 0;
nakamae 0:07880269e91a 134 wt1 = SEND_TIME - ran*1000;
nakamae 2:e103492f1a0b 135 //printf("%d seconds sendin\n\r",wt1/1000);
nakamae 2:e103492f1a0b 136 // ble.setAdvertisingInterval(1600); /* 1000ms; in multiples of 0.625ms. */
nakamae 0:07880269e91a 137 ble.gap().startAdvertising();//BLEの送信
nakamae 0:07880269e91a 138
nakamae 0:07880269e91a 139 timer.start();
nakamae 0:07880269e91a 140 while(1){
nakamae 0:07880269e91a 141 myled3 = !myled3;
nakamae 0:07880269e91a 142 time_t seconds = time(NULL);
nakamae 0:07880269e91a 143 accelerometer.getOutput(readings);
nakamae 0:07880269e91a 144 //13-bit, sign extended values.
nakamae 0:07880269e91a 145 printf("%f, %f, %f",(int16_t)readings[0]*(9.8/256), (int16_t)readings[1]*(9.8/256), (int16_t)readings[2]*(9.8/256));
nakamae 0:07880269e91a 146 printf(": %d\r\n",seconds);
nakamae 0:07880269e91a 147 fprintf(kp,"%f,%f,%f",(int16_t)readings[0]*(9.8/256), (int16_t)readings[1]*(9.8/256), (int16_t)readings[2]*(9.8/256));
nakamae 0:07880269e91a 148 fprintf(kp, ",%d\n",seconds);
nakamae 0:07880269e91a 149
nakamae 0:07880269e91a 150
nakamae 0:07880269e91a 151 if(timer.read() > wt1/1000){
nakamae 0:07880269e91a 152 timer.stop();
nakamae 0:07880269e91a 153 timer.reset();
nakamae 0:07880269e91a 154 fclose(kp);
nakamae 0:07880269e91a 155 break;
nakamae 0:07880269e91a 156 }
nakamae 0:07880269e91a 157 }
nakamae 0:07880269e91a 158
nakamae 0:07880269e91a 159 }
nakamae 0:07880269e91a 160 Thread::wait(wt);
nakamae 0:07880269e91a 161 one_slot.release();
nakamae 0:07880269e91a 162 }
nakamae 0:07880269e91a 163 }
nakamae 0:07880269e91a 164
nakamae 0:07880269e91a 165 // const static char DEVICE_NAME[] = "BLE1";
nakamae 0:07880269e91a 166
nakamae 0:07880269e91a 167 void bleInitComplete(BLE::InitializationCompleteCallbackContext *params)
nakamae 0:07880269e91a 168 {
nakamae 0:07880269e91a 169 BLE &ble= params->ble;
nakamae 0:07880269e91a 170 ble_error_t error = params->error;
nakamae 0:07880269e91a 171
nakamae 0:07880269e91a 172 if (error != BLE_ERROR_NONE) {
nakamae 0:07880269e91a 173 return;
nakamae 0:07880269e91a 174 }
nakamae 2:e103492f1a0b 175 const uint8_t address1[] = {AD,AD,AD,AD,AD,AD};
nakamae 0:07880269e91a 176 ble.gap().setAddress(BLEProtocol::AddressType::PUBLIC, address1);
nakamae 0:07880269e91a 177 /* ble.gap().accumulateAdvertisingPayload(GapAdvertisingData::COMPLETE_LOCAL_NAME, (uint8_t *)DEVICE_NAME, sizeof(DEVICE_NAME));
nakamae 0:07880269e91a 178 ble.gap().setAdvertisingType(GapAdvertisingParams::ADV_CONNECTABLE_UNDIRECTED);
nakamae 0:07880269e91a 179 ble.gap().setAdvertisingInterval(1000);*/
nakamae 0:07880269e91a 180 }
nakamae 0:07880269e91a 181
nakamae 0:07880269e91a 182
nakamae 0:07880269e91a 183 int main (void) {
nakamae 0:07880269e91a 184 //------------------------------------------------------
nakamae 0:07880269e91a 185 //加速度センサーの初期化
nakamae 0:07880269e91a 186
nakamae 0:07880269e91a 187 //Go into standby mode to configure the device.
nakamae 0:07880269e91a 188 accelerometer.setPowerControl(0x00);
nakamae 0:07880269e91a 189 //Full resolution, +/-16g, 4mg/LSB.
nakamae 0:07880269e91a 190 accelerometer.setDataFormatControl(0x0B);
nakamae 0:07880269e91a 191 //3.2kHz data rate.
nakamae 0:07880269e91a 192 accelerometer.setDataRate(ADXL345_3200HZ);
nakamae 0:07880269e91a 193 //Measurement mode.
nakamae 0:07880269e91a 194 accelerometer.setPowerControl(0x08);
nakamae 0:07880269e91a 195 //-------------------------------------------------------
nakamae 0:07880269e91a 196
nakamae 0:07880269e91a 197 ble.init(bleInitComplete);
nakamae 0:07880269e91a 198 ble.setScanParams(GapScanningParams::SCAN_INTERVAL_MAX,GapScanningParams::SCAN_WINDOW_MAX,0);
nakamae 0:07880269e91a 199
nakamae 0:07880269e91a 200 Thread t2(test_thread, (void *)"2");
nakamae 0:07880269e91a 201 Thread t3(test_thread, (void *)"3");
nakamae 0:07880269e91a 202
nakamae 0:07880269e91a 203 test_thread((void *)"1");
nakamae 0:07880269e91a 204 }