和仁 松葉 / Mbed OS USBSec_mbed-os_dev

北海道情報専門学校　ライフハック研究所のエンベデッドUSBチーム松葉和仁により開発されたUSBSecのmbedに使用するソースコード by 和仁

Dependencies:   SDFileSystem MusicEngine

Fork of mbed-os-example-ble-LED by mbed-os-examples

北海道情報専門学校 ライフハック研究所 エンベデッドUSB USBSec用mbedプログラム

松葉和仁

source/main.cpp@14:be4e43ce1578, 2016-12-21 (annotated)

Committer:
kazu0o2
Date:
Wed Dec 21 02:56:24 2016 +0000
Revision:
14:be4e43ce1578
Parent:
11:7404978b24e7
Child:
15:c65fdaa7bfc0
audio;

Who changed what in which revision?

UserRevisionLine numberNew contents of line
mbed_official 11:7404978b24e7 1 #include <events/mbed_events.h>
mbed_official 2:864ddfb70a9c 2 #include <mbed.h>
kazu0o2 14:be4e43ce1578 3 #include "SDFileSystem.h"
mbed_official 2:864ddfb70a9c 4 #include "ble/BLE.h"
kazu0o2 14:be4e43ce1578 5 #include "INITService.h"//初期設定とその状態の送信を行う 0x01
kazu0o2 14:be4e43ce1578 6 #include "PINService.h"//パスワードの認証を行う0x02
kazu0o2 14:be4e43ce1578 7 #include "USBService.h"//USB機器の接続、切断を行う 0x03
kazu0o2 14:be4e43ce1578 8 #include "STATEService.h"//認証、電源、USB状態の送信を行う 0x04
kazu0o2 14:be4e43ce1578 9
kazu0o2 14:be4e43ce1578 10 #define NEED_CONSOLE_OUTPUT 1 /* Set this if you need debug messages on the console;
kazu0o2 14:be4e43ce1578 11 * it will have an impact on code-size and power consumption. */
kazu0o2 14:be4e43ce1578 12 #if NEED_CONSOLE_OUTPUT
kazu0o2 14:be4e43ce1578 13 Serial pc(USBTX, USBRX);
kazu0o2 14:be4e43ce1578 14 #define DEBUG(...) { pc.printf(__VA_ARGS__); }
kazu0o2 14:be4e43ce1578 15 #else
kazu0o2 14:be4e43ce1578 16 #define DEBUG(...) /* nothing */
kazu0o2 14:be4e43ce1578 17 #endif /* #if NEED_CONSOLE_OUTPUT */
mbed_official 2:864ddfb70a9c 18
kazu0o2 14:be4e43ce1578 19 #define mC 261.626
kazu0o2 14:be4e43ce1578 20 #define mD 293.665
kazu0o2 14:be4e43ce1578 21 #define mE 329.628
kazu0o2 14:be4e43ce1578 22 #define mF 349.228
kazu0o2 14:be4e43ce1578 23 #define mG 391.995
kazu0o2 14:be4e43ce1578 24 #define mA 440.000
kazu0o2 14:be4e43ce1578 25 #define mB 493.883
kazu0o2 14:be4e43ce1578 26
kazu0o2 14:be4e43ce1578 27 DigitalOut alivenessLED(LED1, 0);//システム生存確認LED
kazu0o2 14:be4e43ce1578 28 DigitalOut actuatedLED(LED2, 0);//USB用リレーピン
mbed_official 2:864ddfb70a9c 29
kazu0o2 14:be4e43ce1578 30 InterruptIn powerSwitch(p17);//パワー検出コード
kazu0o2 14:be4e43ce1578 31 InterruptIn resetSwitch(p18);//リセットボタン
kazu0o2 14:be4e43ce1578 32
kazu0o2 14:be4e43ce1578 33 PwmOut speaker(LED3);//スピーカ
kazu0o2 14:be4e43ce1578 34
kazu0o2 14:be4e43ce1578 35 //SDFileSystem local("local");//SDカードを定義する
kazu0o2 14:be4e43ce1578 36 SDFileSystem sd(p13,p14,p15,p19,"sd");
kazu0o2 14:be4e43ce1578 37
kazu0o2 14:be4e43ce1578 38 const static char DEVICE_NAME[] = "USBSec";
kazu0o2 14:be4e43ce1578 39 static const uint16_t uuid16_list[] = {USBService::USB_SERVICE_UUID,PINService::PIN_SERVICE_UUID,STATEService::STATE_SERVICE_UUID,INITService::INIT_SERVICE_UUID};//testcode
mbed_official 2:864ddfb70a9c 40
mbed_official 2:864ddfb70a9c 41 static EventQueue eventQueue(
mbed_official 2:864ddfb70a9c 42 /* event count */ 10 * /* event size */ 32
mbed_official 2:864ddfb70a9c 43 );
mbed_official 2:864ddfb70a9c 44
kazu0o2 14:be4e43ce1578 45 USBService *usbServicePtr;
kazu0o2 14:be4e43ce1578 46 PINService *pinServicePtr;
kazu0o2 14:be4e43ce1578 47 STATEService *stateServicePtr;
kazu0o2 14:be4e43ce1578 48 INITService *initServicePtr;
kazu0o2 14:be4e43ce1578 49
kazu0o2 14:be4e43ce1578 50 bool authenticationInformation = false;//パスワードは登録されているか
kazu0o2 14:be4e43ce1578 51 bool authenticated = false;//パスワード認証を行ったか
kazu0o2 14:be4e43ce1578 52
kazu0o2 14:be4e43ce1578 53 char password[] = {0x00,0x00,0x00,0x00,0x00,0x00};//デバッグパスワード
kazu0o2 14:be4e43ce1578 54
kazu0o2 14:be4e43ce1578 55 int connectAlertCount = 0;
kazu0o2 14:be4e43ce1578 56 float connectAlert[]={mE,mF,mG,mA,mB};
kazu0o2 14:be4e43ce1578 57 float disconnectAlert[]={mB,mA,mG,mF,mE};
kazu0o2 14:be4e43ce1578 58
kazu0o2 14:be4e43ce1578 59 void connectAlertOff();
kazu0o2 14:be4e43ce1578 60
kazu0o2 14:be4e43ce1578 61 /**
kazu0o2 14:be4e43ce1578 62 *接続時発音
kazu0o2 14:be4e43ce1578 63 *接続時に発音されるためのキュー
kazu0o2 14:be4e43ce1578 64 */
kazu0o2 14:be4e43ce1578 65 void connectAlertOn() {
kazu0o2 14:be4e43ce1578 66 DEBUG("connectAlertOn\r\n");
kazu0o2 14:be4e43ce1578 67 speaker.period(1.0/connectAlert[connectAlertCount]);
kazu0o2 14:be4e43ce1578 68 speaker.write(0.5f);
kazu0o2 14:be4e43ce1578 69 queue.call_in(600, &connectAlertOff);
kazu0o2 14:be4e43ce1578 70 }
kazu0o2 14:be4e43ce1578 71
kazu0o2 14:be4e43ce1578 72 /**
kazu0o2 14:be4e43ce1578 73 *接続時発音
kazu0o2 14:be4e43ce1578 74 *接続時に発音されるためのキュー
kazu0o2 14:be4e43ce1578 75 */
kazu0o2 14:be4e43ce1578 76 void connectAlertOff() {
kazu0o2 14:be4e43ce1578 77 DEBUG("connectAlertOff\r\n");
kazu0o2 14:be4e43ce1578 78 speaker.write(0.0f);
kazu0o2 14:be4e43ce1578 79 if(connectAlertCount<4){
kazu0o2 14:be4e43ce1578 80 queue.call_in(600, &connectAlertOn);
kazu0o2 14:be4e43ce1578 81 connectAlertCount += 1;
kazu0o2 14:be4e43ce1578 82 }else{
kazu0o2 14:be4e43ce1578 83 DEBUG("connectAlertStop\r\n");
kazu0o2 14:be4e43ce1578 84 }
kazu0o2 14:be4e43ce1578 85 }
kazu0o2 14:be4e43ce1578 86
kazu0o2 14:be4e43ce1578 87 /**
kazu0o2 14:be4e43ce1578 88 *接続時発音
kazu0o2 14:be4e43ce1578 89 *接続時に発音を開始するためのキュー
kazu0o2 14:be4e43ce1578 90 */
kazu0o2 14:be4e43ce1578 91 void connectAlertStart() {
kazu0o2 14:be4e43ce1578 92 DEBUG("connectAlertStart\r\n");
kazu0o2 14:be4e43ce1578 93 connectAlertCount = 0;
kazu0o2 14:be4e43ce1578 94 queue.call(&connectAlertOn);
kazu0o2 14:be4e43ce1578 95 }
kazu0o2 14:be4e43ce1578 96
kazu0o2 14:be4e43ce1578 97 /**
kazu0o2 14:be4e43ce1578 98 *パワー検出コード
kazu0o2 14:be4e43ce1578 99 *タクトスイッチが押されたときに実行されるキュー
kazu0o2 14:be4e43ce1578 100 */
kazu0o2 14:be4e43ce1578 101 void togglePowerUp() {
kazu0o2 14:be4e43ce1578 102 DEBUG("PowerUp\r\n");
kazu0o2 14:be4e43ce1578 103 stateServicePtr->powerStateUpdate(0x01);
kazu0o2 14:be4e43ce1578 104 }
kazu0o2 14:be4e43ce1578 105
kazu0o2 14:be4e43ce1578 106 /**
kazu0o2 14:be4e43ce1578 107 *パワー検出コード
kazu0o2 14:be4e43ce1578 108 *タクトスイッチが離されたときに実行されるキュー
kazu0o2 14:be4e43ce1578 109 */
kazu0o2 14:be4e43ce1578 110 void togglePowerDown() {
kazu0o2 14:be4e43ce1578 111 DEBUG("PowerDown\r\n");
kazu0o2 14:be4e43ce1578 112 stateServicePtr->powerStateUpdate(0x00);
kazu0o2 14:be4e43ce1578 113
kazu0o2 14:be4e43ce1578 114 //USBの無効化
kazu0o2 14:be4e43ce1578 115 actuatedLED = 0x00;
kazu0o2 14:be4e43ce1578 116 stateServicePtr->usbStateUpdate(0x00);
kazu0o2 14:be4e43ce1578 117 }
kazu0o2 14:be4e43ce1578 118
kazu0o2 14:be4e43ce1578 119 /**
kazu0o2 14:be4e43ce1578 120 *パワー検出コード
kazu0o2 14:be4e43ce1578 121 *タクトスイッチが押されたときに実行される関数
kazu0o2 14:be4e43ce1578 122 */
kazu0o2 14:be4e43ce1578 123 void powerUp() {
kazu0o2 14:be4e43ce1578 124 // 即実行されるイベント
kazu0o2 14:be4e43ce1578 125 eventQueue.call(&togglePowerUp);
kazu0o2 14:be4e43ce1578 126 }
mbed_official 2:864ddfb70a9c 127
kazu0o2 14:be4e43ce1578 128 /**
kazu0o2 14:be4e43ce1578 129 *パワー検出コード
kazu0o2 14:be4e43ce1578 130 *タクトスイッチが離されたときに実行される関数
kazu0o2 14:be4e43ce1578 131 */
kazu0o2 14:be4e43ce1578 132 void powerDown() {
kazu0o2 14:be4e43ce1578 133 // 即実行されるイベント
kazu0o2 14:be4e43ce1578 134 eventQueue.call(&togglePowerDown);
kazu0o2 14:be4e43ce1578 135 }
kazu0o2 14:be4e43ce1578 136
kazu0o2 14:be4e43ce1578 137 /**
kazu0o2 14:be4e43ce1578 138 *リセットボタン
kazu0o2 14:be4e43ce1578 139 *タクトスイッチが離されたときに実行されるキュー
kazu0o2 14:be4e43ce1578 140 */
kazu0o2 14:be4e43ce1578 141 void toggleResetDown() {
kazu0o2 14:be4e43ce1578 142 DEBUG("ResetDown\r\n");
kazu0o2 14:be4e43ce1578 143 DEBUG("パスワードのリセットを行います\r\n");
kazu0o2 14:be4e43ce1578 144 //リセットパスワードの書き込み
kazu0o2 14:be4e43ce1578 145 FILE *fp = fopen("/sd/sdtest.txt", "w");
kazu0o2 14:be4e43ce1578 146 if(fp == NULL) {
kazu0o2 14:be4e43ce1578 147 DEBUG("Could not open file for write\n");
kazu0o2 14:be4e43ce1578 148 }else{
kazu0o2 14:be4e43ce1578 149 fprintf(fp, "00\n00\n00\n00\n00\n00\n");
kazu0o2 14:be4e43ce1578 150 fclose(fp);
kazu0o2 14:be4e43ce1578 151 }
kazu0o2 14:be4e43ce1578 152
kazu0o2 14:be4e43ce1578 153 //パスワード登録状態のリセット
kazu0o2 14:be4e43ce1578 154 authenticationInformation = false;
kazu0o2 14:be4e43ce1578 155 initServicePtr->stateUpdate(0x00);
kazu0o2 14:be4e43ce1578 156 //パスワード認証状態のリセット
kazu0o2 14:be4e43ce1578 157 authenticated=false;
kazu0o2 14:be4e43ce1578 158 stateServicePtr->authStateUpdate(0x00);
kazu0o2 14:be4e43ce1578 159 DEBUG("パスワードのリセットが完了しました\r\n");
kazu0o2 14:be4e43ce1578 160 }
kazu0o2 14:be4e43ce1578 161
kazu0o2 14:be4e43ce1578 162 /**
kazu0o2 14:be4e43ce1578 163 *リセットボタン
kazu0o2 14:be4e43ce1578 164 *タクトスイッチが離されたときに実行される関数
kazu0o2 14:be4e43ce1578 165 */
kazu0o2 14:be4e43ce1578 166 void resetDown() {
kazu0o2 14:be4e43ce1578 167 // 即実行されるイベント
kazu0o2 14:be4e43ce1578 168 eventQueue.call(&toggleResetDown);
kazu0o2 14:be4e43ce1578 169 }
kazu0o2 14:be4e43ce1578 170
kazu0o2 14:be4e43ce1578 171 /**
kazu0o2 14:be4e43ce1578 172 * Bluetooth接続時の操作
kazu0o2 14:be4e43ce1578 173 */
kazu0o2 14:be4e43ce1578 174 void connectionCallback(const Gap::ConnectionCallbackParams_t *params)
kazu0o2 14:be4e43ce1578 175 {
kazu0o2 14:be4e43ce1578 176 char mac[6];
kazu0o2 14:be4e43ce1578 177 DEBUG("peerMAC:%d\r\n",params->peerAddr);
kazu0o2 14:be4e43ce1578 178 DEBUG("peerMAC_length:%d\r\n",sizeof(params->peerAddr));
kazu0o2 14:be4e43ce1578 179 DEBUG("peerMAC:");
kazu0o2 14:be4e43ce1578 180 for(int i = 0;i<sizeof(params->peerAddr);i+=1){
kazu0o2 14:be4e43ce1578 181 mac[i]=params->peerAddr[i];
kazu0o2 14:be4e43ce1578 182 DEBUG("%02x ", params->peerAddr[i]);
kazu0o2 14:be4e43ce1578 183 }
kazu0o2 14:be4e43ce1578 184 DEBUG("\r\n");
kazu0o2 14:be4e43ce1578 185
kazu0o2 14:be4e43ce1578 186 /*
kazu0o2 14:be4e43ce1578 187 DEBUG("peerArrayMAC:%d\r\n",mac);
kazu0o2 14:be4e43ce1578 188 DEBUG("peerArrayMAC_length:%d\r\n",sizeof(mac));
kazu0o2 14:be4e43ce1578 189 DEBUG("peerArrayMAC:");
kazu0o2 14:be4e43ce1578 190 for(int i = 0;i<sizeof(mac);i+=1){
kazu0o2 14:be4e43ce1578 191 DEBUG("%d ", mac[i]);
kazu0o2 14:be4e43ce1578 192 }
kazu0o2 14:be4e43ce1578 193 DEBUG("\r\n");
kazu0o2 14:be4e43ce1578 194 */
kazu0o2 14:be4e43ce1578 195
kazu0o2 14:be4e43ce1578 196 DEBUG("ownAddrMAC:%d\r\n",params->ownAddr);
kazu0o2 14:be4e43ce1578 197 DEBUG("ownAddrMAC_length:%d\r\n",sizeof(params->ownAddr));
kazu0o2 14:be4e43ce1578 198 DEBUG("ownAddrMAC:");
kazu0o2 14:be4e43ce1578 199 for(int i = 0;i<sizeof(params->ownAddr);i+=1){
kazu0o2 14:be4e43ce1578 200 DEBUG("%d ", params->ownAddr[i]);
kazu0o2 14:be4e43ce1578 201 }
kazu0o2 14:be4e43ce1578 202 DEBUG("\r\n");
kazu0o2 14:be4e43ce1578 203
kazu0o2 14:be4e43ce1578 204 DEBUG("BluetoothConnection!\r\n");
kazu0o2 14:be4e43ce1578 205 }
kazu0o2 14:be4e43ce1578 206
kazu0o2 14:be4e43ce1578 207 /**
kazu0o2 14:be4e43ce1578 208 * Bluetooth切断時の操作
kazu0o2 14:be4e43ce1578 209 */
mbed_official 2:864ddfb70a9c 210 void disconnectionCallback(const Gap::DisconnectionCallbackParams_t *params)
mbed_official 2:864ddfb70a9c 211 {
mbed_official 2:864ddfb70a9c 212 (void) params;
kazu0o2 14:be4e43ce1578 213 //認証状態の無効化
kazu0o2 14:be4e43ce1578 214 authenticated = false;
kazu0o2 14:be4e43ce1578 215 stateServicePtr->authStateUpdate(0x00);
kazu0o2 14:be4e43ce1578 216 //USBの無効化
kazu0o2 14:be4e43ce1578 217 actuatedLED = 0x00;
kazu0o2 14:be4e43ce1578 218 stateServicePtr->usbStateUpdate(0x00);
kazu0o2 14:be4e43ce1578 219
mbed_official 2:864ddfb70a9c 220 BLE::Instance().gap().startAdvertising();
kazu0o2 14:be4e43ce1578 221 DEBUG("BluetoothDisconnection!\r\n");
mbed_official 2:864ddfb70a9c 222 }
mbed_official 2:864ddfb70a9c 223
kazu0o2 14:be4e43ce1578 224 /**
kazu0o2 14:be4e43ce1578 225 *動作確認ランプの状態変更
kazu0o2 14:be4e43ce1578 226 */
mbed_official 2:864ddfb70a9c 227 void blinkCallback(void)
mbed_official 2:864ddfb70a9c 228 {
mbed_official 2:864ddfb70a9c 229 alivenessLED = !alivenessLED; /* Do blinky on LED1 to indicate system aliveness. */
mbed_official 2:864ddfb70a9c 230 }
mbed_official 2:864ddfb70a9c 231
kazu0o2 14:be4e43ce1578 232
kazu0o2 14:be4e43ce1578 233 /**
kazu0o2 14:be4e43ce1578 234 *パスワードSDカード書き込み
kazu0o2 14:be4e43ce1578 235 *パスワードが変更されたときに実行されるキュー
kazu0o2 14:be4e43ce1578 236 */
kazu0o2 14:be4e43ce1578 237 void writeSD() {
kazu0o2 14:be4e43ce1578 238 //SDへの書き込み処理
kazu0o2 14:be4e43ce1578 239 DEBUG("SDカードを開きます\r\n");
kazu0o2 14:be4e43ce1578 240 FILE *fp = fopen("/sd/sdtest.txt", "w");
kazu0o2 14:be4e43ce1578 241 if(fp == NULL) {
kazu0o2 14:be4e43ce1578 242 DEBUG("Could not open file for write\n");
kazu0o2 14:be4e43ce1578 243 }else{
kazu0o2 14:be4e43ce1578 244 for(int i = 0;i<sizeof(password);i+=1){
kazu0o2 14:be4e43ce1578 245 fprintf(fp,"%02x", password[i]);
kazu0o2 14:be4e43ce1578 246 fprintf(fp, "\n");
kazu0o2 14:be4e43ce1578 247 }
kazu0o2 14:be4e43ce1578 248 fclose(fp);
kazu0o2 14:be4e43ce1578 249 }
kazu0o2 14:be4e43ce1578 250 DEBUG("SDカードを閉じます\r\n");
kazu0o2 14:be4e43ce1578 251 }
kazu0o2 14:be4e43ce1578 252
mbed_official 2:864ddfb70a9c 253 /**
mbed_official 2:864ddfb70a9c 254 * This callback allows the LEDService to receive updates to the ledState Characteristic.
kazu0o2 14:be4e43ce1578 255 * LEDサービスにて状態変更を受信した際に呼び出されるコールバック
mbed_official 2:864ddfb70a9c 256 *
mbed_official 2:864ddfb70a9c 257 * @param[in] params
mbed_official 2:864ddfb70a9c 258 * Information about the characterisitc being updated.
mbed_official 2:864ddfb70a9c 259 */
mbed_official 2:864ddfb70a9c 260 void onDataWrittenCallback(const GattWriteCallbackParams *params) {
kazu0o2 14:be4e43ce1578 261 DEBUG("onDataWrittenCallback:");
kazu0o2 14:be4e43ce1578 262
kazu0o2 14:be4e43ce1578 263 if (params->handle == initServicePtr->getValueHandle()) {
kazu0o2 14:be4e43ce1578 264 DEBUG("INITService\r\n");
kazu0o2 14:be4e43ce1578 265 DEBUG("length:%d\r\n",params->len);
kazu0o2 14:be4e43ce1578 266 for(int i = 0;i<params->len;i+=1){
kazu0o2 14:be4e43ce1578 267 DEBUG("%02x ", params->data[i]);
kazu0o2 14:be4e43ce1578 268 }
kazu0o2 14:be4e43ce1578 269 DEBUG("\r\n");
kazu0o2 14:be4e43ce1578 270
kazu0o2 14:be4e43ce1578 271 //認証情報の確認
kazu0o2 14:be4e43ce1578 272 if(authenticationInformation){
kazu0o2 14:be4e43ce1578 273 //認証情報が登録されていた場合は登録を行わない
kazu0o2 14:be4e43ce1578 274 DEBUG("認証情報登録済みのため、認証情報の登録を中止します\r\n");
kazu0o2 14:be4e43ce1578 275 return;
kazu0o2 14:be4e43ce1578 276 }
kazu0o2 14:be4e43ce1578 277
kazu0o2 14:be4e43ce1578 278 DEBUG("認証情報の登録を開始します\r\n");
kazu0o2 14:be4e43ce1578 279
kazu0o2 14:be4e43ce1578 280 for(int i = 0;i<params->len;i+=1){
kazu0o2 14:be4e43ce1578 281 password[i] = params->data[i];
kazu0o2 14:be4e43ce1578 282 }
kazu0o2 14:be4e43ce1578 283
kazu0o2 14:be4e43ce1578 284 DEBUG("PasswordLength:%d\r\n",sizeof(password));
kazu0o2 14:be4e43ce1578 285 for(int i = 0;i<sizeof(password);i+=1){
kazu0o2 14:be4e43ce1578 286 DEBUG("%02x ", password[i]);
kazu0o2 14:be4e43ce1578 287 }
kazu0o2 14:be4e43ce1578 288 DEBUG("\r\n");
kazu0o2 14:be4e43ce1578 289
kazu0o2 14:be4e43ce1578 290 authenticationInformation = true;
kazu0o2 14:be4e43ce1578 291 initServicePtr->stateUpdate(0x01);
kazu0o2 14:be4e43ce1578 292
kazu0o2 14:be4e43ce1578 293
kazu0o2 14:be4e43ce1578 294 // 即実行されるイベント
kazu0o2 14:be4e43ce1578 295 eventQueue.call(&writeSD);
kazu0o2 14:be4e43ce1578 296
kazu0o2 14:be4e43ce1578 297 DEBUG("認証情報の登録を終了します\r\n");
kazu0o2 14:be4e43ce1578 298 return;
kazu0o2 14:be4e43ce1578 299 }
kazu0o2 14:be4e43ce1578 300
kazu0o2 14:be4e43ce1578 301 if(!authenticationInformation){
kazu0o2 14:be4e43ce1578 302 //認証情報が登録されていない場合は操作を行わない
kazu0o2 14:be4e43ce1578 303 DEBUG("\r\n認証情報未登録のため、操作を中止します\r\n");
kazu0o2 14:be4e43ce1578 304 return;
kazu0o2 14:be4e43ce1578 305 }
kazu0o2 14:be4e43ce1578 306
kazu0o2 14:be4e43ce1578 307 if (params->handle == pinServicePtr->getValueHandle()) {
kazu0o2 14:be4e43ce1578 308 DEBUG("PINService\r\n");
kazu0o2 14:be4e43ce1578 309 DEBUG("length:%d\r\n",params->len);
kazu0o2 14:be4e43ce1578 310 for(int i = 0;i<params->len;i+=1){
kazu0o2 14:be4e43ce1578 311 DEBUG("%02x ", params->data[i]);
kazu0o2 14:be4e43ce1578 312 }
kazu0o2 14:be4e43ce1578 313 DEBUG("\r\n");
kazu0o2 14:be4e43ce1578 314
kazu0o2 14:be4e43ce1578 315 DEBUG("認証を開始します\r\n");
kazu0o2 14:be4e43ce1578 316 DEBUG("VerificationLength:%d\r\n",params->len);
kazu0o2 14:be4e43ce1578 317 DEBUG("RegisterLength:%d\r\n",sizeof(password));
kazu0o2 14:be4e43ce1578 318 if(params->len != sizeof(password)){
kazu0o2 14:be4e43ce1578 319 DEBUG("認証に失敗しました\r\n");
kazu0o2 14:be4e43ce1578 320 return;
kazu0o2 14:be4e43ce1578 321 }
kazu0o2 14:be4e43ce1578 322 DEBUG("Verification:Register\r\n");
kazu0o2 14:be4e43ce1578 323 for(int i = 0;i<params->len;i+=1){
kazu0o2 14:be4e43ce1578 324 DEBUG("%02x", params->data[i]);
kazu0o2 14:be4e43ce1578 325 DEBUG(":");
kazu0o2 14:be4e43ce1578 326 DEBUG("%02x", password[i]);
kazu0o2 14:be4e43ce1578 327 DEBUG("\r\n");
kazu0o2 14:be4e43ce1578 328 if(params->data[i]!= password[i]){
kazu0o2 14:be4e43ce1578 329 DEBUG("認証に失敗しました\r\n");
kazu0o2 14:be4e43ce1578 330 return;
kazu0o2 14:be4e43ce1578 331 }
kazu0o2 14:be4e43ce1578 332 }
kazu0o2 14:be4e43ce1578 333 authenticated=true;
kazu0o2 14:be4e43ce1578 334 stateServicePtr->authStateUpdate(0x01);
kazu0o2 14:be4e43ce1578 335 DEBUG("認証が完了しました\r\n");
kazu0o2 14:be4e43ce1578 336 return;
kazu0o2 14:be4e43ce1578 337 }
kazu0o2 14:be4e43ce1578 338
kazu0o2 14:be4e43ce1578 339 if(!authenticated){
kazu0o2 14:be4e43ce1578 340 //認証が行われていない場合は操作を行わない
kazu0o2 14:be4e43ce1578 341 DEBUG("\r\n認証がされていないため、操作を中止します\r\n");
kazu0o2 14:be4e43ce1578 342 return;
kazu0o2 14:be4e43ce1578 343 }
kazu0o2 14:be4e43ce1578 344
kazu0o2 14:be4e43ce1578 345 if ((params->handle == usbServicePtr->getValueHandle()) && (params->len == 1)) {
kazu0o2 14:be4e43ce1578 346
kazu0o2 14:be4e43ce1578 347 DEBUG("USBService\r\n");
kazu0o2 14:be4e43ce1578 348 DEBUG("length:%d\r\n",params->len);
kazu0o2 14:be4e43ce1578 349 for(int i = 0;i<params->len;i+=1){
kazu0o2 14:be4e43ce1578 350 DEBUG("%d ", params->data[i]);
kazu0o2 14:be4e43ce1578 351 }
kazu0o2 14:be4e43ce1578 352 DEBUG("\r\n");
kazu0o2 14:be4e43ce1578 353
mbed_official 2:864ddfb70a9c 354 actuatedLED = *(params->data);
kazu0o2 14:be4e43ce1578 355 stateServicePtr->usbStateUpdate(*(params->data));
kazu0o2 14:be4e43ce1578 356 return;
mbed_official 2:864ddfb70a9c 357 }
mbed_official 2:864ddfb70a9c 358 }
mbed_official 2:864ddfb70a9c 359
mbed_official 2:864ddfb70a9c 360 /**
mbed_official 2:864ddfb70a9c 361 * This function is called when the ble initialization process has failled
kazu0o2 14:be4e43ce1578 362 * BLEの初期化失敗のコールバック
mbed_official 2:864ddfb70a9c 363 */
mbed_official 2:864ddfb70a9c 364 void onBleInitError(BLE &ble, ble_error_t error)
mbed_official 2:864ddfb70a9c 365 {
kazu0o2 14:be4e43ce1578 366 DEBUG("BluetoothError!\r\n");
mbed_official 2:864ddfb70a9c 367 /* Initialization error handling should go here */
mbed_official 2:864ddfb70a9c 368 }
mbed_official 2:864ddfb70a9c 369
mbed_official 2:864ddfb70a9c 370 /**
mbed_official 2:864ddfb70a9c 371 * Callback triggered when the ble initialization process has finished
kazu0o2 14:be4e43ce1578 372 * BLEの初期化が完了したときに呼び出されるコールバック
mbed_official 2:864ddfb70a9c 373 */
mbed_official 2:864ddfb70a9c 374 void bleInitComplete(BLE::InitializationCompleteCallbackContext *params)
mbed_official 2:864ddfb70a9c 375 {
mbed_official 2:864ddfb70a9c 376 BLE& ble = params->ble;
mbed_official 2:864ddfb70a9c 377 ble_error_t error = params->error;
mbed_official 2:864ddfb70a9c 378
mbed_official 2:864ddfb70a9c 379 if (error != BLE_ERROR_NONE) {
mbed_official 2:864ddfb70a9c 380 /* In case of error, forward the error handling to onBleInitError */
kazu0o2 14:be4e43ce1578 381 /* エラーがあった場合はここから上の'onBleInitError'が呼び出される */
mbed_official 2:864ddfb70a9c 382 onBleInitError(ble, error);
mbed_official 2:864ddfb70a9c 383 return;
mbed_official 2:864ddfb70a9c 384 }
mbed_official 2:864ddfb70a9c 385
mbed_official 2:864ddfb70a9c 386 /* Ensure that it is the default instance of BLE */
kazu0o2 14:be4e43ce1578 387 /* BLEのデフォルトインスタンスであることを確認 */
mbed_official 2:864ddfb70a9c 388 if(ble.getInstanceID() != BLE::DEFAULT_INSTANCE) {
mbed_official 2:864ddfb70a9c 389 return;
mbed_official 2:864ddfb70a9c 390 }
mbed_official 2:864ddfb70a9c 391
mbed_official 2:864ddfb70a9c 392 ble.gap().onDisconnection(disconnectionCallback);
kazu0o2 14:be4e43ce1578 393 ble.gap().onConnection(connectionCallback);
mbed_official 2:864ddfb70a9c 394 ble.gattServer().onDataWritten(onDataWrittenCallback);
mbed_official 2:864ddfb70a9c 395
kazu0o2 14:be4e43ce1578 396 bool initialValueForUSBUSBCharacteristic = false;
kazu0o2 14:be4e43ce1578 397 usbServicePtr = new USBService(ble, initialValueForUSBUSBCharacteristic);
kazu0o2 14:be4e43ce1578 398
kazu0o2 14:be4e43ce1578 399 char initialValueForPINPINCharacteristic[] = {0x00,0x00,0x00,0x00,0x00,0x00};
kazu0o2 14:be4e43ce1578 400 pinServicePtr = new PINService(ble, initialValueForPINPINCharacteristic);
kazu0o2 14:be4e43ce1578 401
kazu0o2 14:be4e43ce1578 402 char initialValueForSTATEAUTHCharacteristic = 0x00;
kazu0o2 14:be4e43ce1578 403 char initialValueForSTATEPOWERCharacteristic = 0x00;
kazu0o2 14:be4e43ce1578 404 char initialValueForSTATEUSBCharacteristic = 0x00;
kazu0o2 14:be4e43ce1578 405 stateServicePtr = new STATEService(ble, initialValueForSTATEAUTHCharacteristic, initialValueForSTATEPOWERCharacteristic, initialValueForSTATEUSBCharacteristic);
kazu0o2 14:be4e43ce1578 406
kazu0o2 14:be4e43ce1578 407 char initialValueForINITSETCharacteristic[] = {0x00,0x00,0x00,0x00,0x00,0x00};
kazu0o2 14:be4e43ce1578 408 char initialValueForINITGETCharacteristic = authenticationInformation;
kazu0o2 14:be4e43ce1578 409 initServicePtr = new INITService(ble, initialValueForINITSETCharacteristic,initialValueForINITGETCharacteristic);
mbed_official 2:864ddfb70a9c 410
mbed_official 2:864ddfb70a9c 411 /* setup advertising */
kazu0o2 14:be4e43ce1578 412 /* BLEクライアントへの広告の設定 */
mbed_official 2:864ddfb70a9c 413 ble.gap().accumulateAdvertisingPayload(GapAdvertisingData::BREDR_NOT_SUPPORTED | GapAdvertisingData::LE_GENERAL_DISCOVERABLE);
kazu0o2 14:be4e43ce1578 414 ble.gap().accumulateAdvertisingPayload(GapAdvertisingData::COMPLETE_LIST_16BIT_SERVICE_IDS, (uint8_t *)uuid16_list, sizeof(uuid16_list));
mbed_official 2:864ddfb70a9c 415 ble.gap().accumulateAdvertisingPayload(GapAdvertisingData::COMPLETE_LOCAL_NAME, (uint8_t *)DEVICE_NAME, sizeof(DEVICE_NAME));
mbed_official 2:864ddfb70a9c 416 ble.gap().setAdvertisingType(GapAdvertisingParams::ADV_CONNECTABLE_UNDIRECTED);
mbed_official 2:864ddfb70a9c 417 ble.gap().setAdvertisingInterval(1000); /* 1000ms. */
mbed_official 2:864ddfb70a9c 418 ble.gap().startAdvertising();
kazu0o2 14:be4e43ce1578 419
kazu0o2 14:be4e43ce1578 420 DEBUG("BluetoothStart!\r\n");
mbed_official 2:864ddfb70a9c 421 }
mbed_official 2:864ddfb70a9c 422
mbed_official 2:864ddfb70a9c 423 void scheduleBleEventsProcessing(BLE::OnEventsToProcessCallbackContext* context) {
mbed_official 2:864ddfb70a9c 424 BLE &ble = BLE::Instance();
mbed_official 11:7404978b24e7 425 eventQueue.call(Callback<void()>(&ble, &BLE::processEvents));
mbed_official 2:864ddfb70a9c 426 }
mbed_official 2:864ddfb70a9c 427
mbed_official 2:864ddfb70a9c 428 int main()
mbed_official 2:864ddfb70a9c 429 {
kazu0o2 14:be4e43ce1578 430 //SDカードパスワードの取得
kazu0o2 14:be4e43ce1578 431 char charpass;//SDカードから取得されたパスワード
kazu0o2 14:be4e43ce1578 432 FILE *fp = fopen("/sd/sdtest.txt", "r");
kazu0o2 14:be4e43ce1578 433 if(fp == NULL) {
kazu0o2 14:be4e43ce1578 434 DEBUG("Could not open file for write\n");
kazu0o2 14:be4e43ce1578 435 }else{
kazu0o2 14:be4e43ce1578 436 int passwordindex = 0;
kazu0o2 14:be4e43ce1578 437 //パスワードを取り出しパスワード変数へ
kazu0o2 14:be4e43ce1578 438 while( fscanf( fp, "%02x",&charpass ) != EOF ){
kazu0o2 14:be4e43ce1578 439 DEBUG("%02x\r\n",charpass);
kazu0o2 14:be4e43ce1578 440 password[passwordindex] = charpass;
kazu0o2 14:be4e43ce1578 441 passwordindex+=1;
kazu0o2 14:be4e43ce1578 442 }
kazu0o2 14:be4e43ce1578 443 fclose(fp);
kazu0o2 14:be4e43ce1578 444 }
kazu0o2 14:be4e43ce1578 445
kazu0o2 14:be4e43ce1578 446 //起動時の認証情報状態の設定
kazu0o2 14:be4e43ce1578 447 authenticationInformation = false;
kazu0o2 14:be4e43ce1578 448 DEBUG("PasswordLength:%d\r\n",sizeof(password));
kazu0o2 14:be4e43ce1578 449 for(int i = 0;i<sizeof(password);i+=1){
kazu0o2 14:be4e43ce1578 450 DEBUG("%d ", password[i]);
kazu0o2 14:be4e43ce1578 451 if(password[i] != 0x00){
kazu0o2 14:be4e43ce1578 452 authenticationInformation = true;
kazu0o2 14:be4e43ce1578 453 }
kazu0o2 14:be4e43ce1578 454 }
kazu0o2 14:be4e43ce1578 455 DEBUG("\r\n");
kazu0o2 14:be4e43ce1578 456
kazu0o2 14:be4e43ce1578 457 powerSwitch.mode(PullUp);//パワー検出コード_スイッチピンをPullUpに
kazu0o2 14:be4e43ce1578 458 powerSwitch.fall(&powerUp);//パワー検出コード_スイッチが押されたときの割り込み処理
kazu0o2 14:be4e43ce1578 459 powerSwitch.rise(&powerDown);//パワー検出コード_スイッチが離されたときの割り込み処理
kazu0o2 14:be4e43ce1578 460
kazu0o2 14:be4e43ce1578 461 resetSwitch.mode(PullUp);//リセットボタン_スイッチピンをPullUpに
kazu0o2 14:be4e43ce1578 462 resetSwitch.rise(&resetDown);//リセットボタン_スイッチが離されたときの割り込み処理
kazu0o2 14:be4e43ce1578 463
mbed_official 11:7404978b24e7 464 eventQueue.call_every(500, blinkCallback);
mbed_official 2:864ddfb70a9c 465
mbed_official 2:864ddfb70a9c 466 BLE &ble = BLE::Instance();
mbed_official 2:864ddfb70a9c 467 ble.onEventsToProcess(scheduleBleEventsProcessing);
mbed_official 2:864ddfb70a9c 468 ble.init(bleInitComplete);
kazu0o2 14:be4e43ce1578 469
kazu0o2 14:be4e43ce1578 470 //パスワード設定情報のBluetoothへの反映
kazu0o2 14:be4e43ce1578 471 if(authenticationInformation){
kazu0o2 14:be4e43ce1578 472 initServicePtr->stateUpdate(0x01);
kazu0o2 14:be4e43ce1578 473 }
mbed_official 2:864ddfb70a9c 474
mbed_official 11:7404978b24e7 475 eventQueue.dispatch_forever();
mbed_official 2:864ddfb70a9c 476
mbed_official 2:864ddfb70a9c 477 return 0;
mbed_official 2:864ddfb70a9c 478 }