和仁 松葉 / 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@25:40ab1e81ae43, 2017-02-03 (annotated)

Committer:
kazu0o2
Date:
Fri Feb 03 02:32:17 2017 +0000
Revision:
25:40ab1e81ae43
Parent:
24:c0cc460aadef
Child:
26:f3bc0ee1e9b5
Speaker Power saving Overwrite can not cut; add authError and passwordReset

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