Diogo Gomes / Mbed 2 deprecated Garagem

BLE Application to open a Garage door

Dependencies:   BLE_API Crypto RNG mbed nRF51822

Fork of BLE_LED by Bluetooth Low Energy

SecurityService.h@11:3de9b542eeac, 2015-08-26 (annotated)

Committer:
dgomes
Date:
Wed Aug 26 00:13:10 2015 +0000
Revision:
11:3de9b542eeac
Child:
12:eaee29bfa1c7
Not working (no Bluetooth)

Who changed what in which revision?

UserRevisionLine numberNew contents of line
dgomes 11:3de9b542eeac 1 #ifndef __BLE_SECURITY_SERVICE_H__
dgomes 11:3de9b542eeac 2 #define __BLE_SECURITY_SERVICE_H__
dgomes 11:3de9b542eeac 3
dgomes 11:3de9b542eeac 4 #include "Crypto.h"
dgomes 11:3de9b542eeac 5 class SecurityService {
dgomes 11:3de9b542eeac 6 public:
dgomes 11:3de9b542eeac 7 const static uint16_t SECURITY_SERVICE_UUID = 0x3000;
dgomes 11:3de9b542eeac 8 const static uint16_t SECURITY_IV_CHARACTERISTIC_UUID = 0x3001;
dgomes 11:3de9b542eeac 9 const static uint16_t SECURITY_KEY_CHARACTERISTIC_UUID = 0x3002;
dgomes 11:3de9b542eeac 10
dgomes 11:3de9b542eeac 11 SecurityService(BLE &_ble, char *shared_key) :
dgomes 11:3de9b542eeac 12 ble(_ble),
dgomes 11:3de9b542eeac 13 SecurityIV(SECURITY_IV_CHARACTERISTIC_UUID, (uint8_t *) 0),
dgomes 11:3de9b542eeac 14 SecurityKey(SECURITY_KEY_CHARACTERISTIC_UUID, (uint8_t *) 0)
dgomes 11:3de9b542eeac 15 {
dgomes 11:3de9b542eeac 16 boot = true;
dgomes 11:3de9b542eeac 17 GattCharacteristic *charTable[] = {&SecurityIV, &SecurityKey};
dgomes 11:3de9b542eeac 18
dgomes 11:3de9b542eeac 19 GattService SecurityService(SECURITY_SERVICE_UUID, charTable, sizeof(charTable) / sizeof(GattCharacteristic *));
dgomes 11:3de9b542eeac 20 ble.gattServer().addService(SecurityService);
dgomes 11:3de9b542eeac 21
dgomes 11:3de9b542eeac 22 //Initialize AES
dgomes 11:3de9b542eeac 23 setKey(shared_key);
dgomes 11:3de9b542eeac 24 genIV();
dgomes 11:3de9b542eeac 25 }
dgomes 11:3de9b542eeac 26
dgomes 11:3de9b542eeac 27 void decode(uint8_t *out, uint8_t *in, uint32_t len) {
dgomes 11:3de9b542eeac 28 AES myAES(AES_128, myKey, iv);
dgomes 11:3de9b542eeac 29 myAES.decrypt(out,in,len);
dgomes 11:3de9b542eeac 30 genIV();
dgomes 11:3de9b542eeac 31 }
dgomes 11:3de9b542eeac 32
dgomes 11:3de9b542eeac 33 void setKey(char *shared_key) {
dgomes 11:3de9b542eeac 34 if(boot) {
dgomes 11:3de9b542eeac 35 DBG("Set shared_key = %s\r\n", shared_key);
dgomes 11:3de9b542eeac 36 MD5::computeHash(myKey, (uint8_t*) shared_key, strlen(shared_key));
dgomes 11:3de9b542eeac 37 }
dgomes 11:3de9b542eeac 38 }
dgomes 11:3de9b542eeac 39
dgomes 11:3de9b542eeac 40 void bootComplete() {
dgomes 11:3de9b542eeac 41 boot = false;
dgomes 11:3de9b542eeac 42 }
dgomes 11:3de9b542eeac 43
dgomes 11:3de9b542eeac 44 void genIV() {
dgomes 11:3de9b542eeac 45 //TODO RANDOM THIS:
dgomes 11:3de9b542eeac 46 uint8_t new_iv[16] = { 0xA2, 0x68, 0x56, 0x36, 0x52, 0x18, 0x71, 0xD0, 0x23, 0x06, 0xE2, 0xEB, 0x8F, 0x70, 0x27, 0xB3 };
dgomes 11:3de9b542eeac 47 memcpy(iv, new_iv,16);
dgomes 11:3de9b542eeac 48 ble.gattServer().write(SecurityIV.getValueHandle(), (uint8_t *)iv, 16*sizeof(uint8_t));
dgomes 11:3de9b542eeac 49 }
dgomes 11:3de9b542eeac 50
dgomes 11:3de9b542eeac 51 GattAttribute::Handle_t getKeyHandle() const {
dgomes 11:3de9b542eeac 52 return SecurityKey.getValueHandle();
dgomes 11:3de9b542eeac 53 }
dgomes 11:3de9b542eeac 54
dgomes 11:3de9b542eeac 55 private:
dgomes 11:3de9b542eeac 56 BLE &ble;
dgomes 11:3de9b542eeac 57 ReadOnlyArrayGattCharacteristic<uint8_t, 16> SecurityIV;
dgomes 11:3de9b542eeac 58 WriteOnlyArrayGattCharacteristic<uint8_t, 16> SecurityKey;
dgomes 11:3de9b542eeac 59 bool boot;
dgomes 11:3de9b542eeac 60
dgomes 11:3de9b542eeac 61 uint8_t iv[16];
dgomes 11:3de9b542eeac 62 //openssl enc -aes-128-cbc -pass pass:********** -nosalt -P
dgomes 11:3de9b542eeac 63 uint8_t myKey[16];
dgomes 11:3de9b542eeac 64
dgomes 11:3de9b542eeac 65 };
dgomes 11:3de9b542eeac 66
dgomes 11:3de9b542eeac 67 #endif /* #ifndef __BLE_SECURITY_SERVICE_H__ */