3225f40870
* furi-hal-bt: add mutex guarding core2 state * ble-glue: configure ble keys storage in SRAM2 * bt: add load and save ble keys in internal storage * bt: improve work furi_hal_bt API * bt: rework app_entry -> ble_glue * bt: apply changes for f6 target * desktop: remove furi check * ble-glue: comment NVM in SRAM2 configuration * FuriHal: fix flash controller state corruption, fix incorrect semaphore release, implement C1-C2 flash controller access according to spec. Gui: change logging level. * Libs: better lfs integration with lfs_config. * Ble: switch C2 NVM to RAM. * FuriHalCrypto: ensure that core2 is alive before sending shci commands * Ble: fix incorrect nvm buffer size Co-authored-by: あく <alleteam@gmail.com>
90 lines
2.5 KiB
C
90 lines
2.5 KiB
C
#include <furi-hal-crypto.h>
|
|
#include <furi-hal-bt.h>
|
|
#include <furi.h>
|
|
#include <shci.h>
|
|
|
|
CRYP_HandleTypeDef crypt;
|
|
|
|
void furi_hal_crypto_init() {
|
|
FURI_LOG_I("FuriHalCrypto", "Init OK");
|
|
}
|
|
|
|
bool furi_hal_crypto_store_add_key(FuriHalCryptoKey* key, uint8_t* slot) {
|
|
furi_assert(key);
|
|
furi_assert(slot);
|
|
|
|
if(!furi_hal_bt_is_alive()) {
|
|
return false;
|
|
}
|
|
|
|
SHCI_C2_FUS_StoreUsrKey_Cmd_Param_t pParam;
|
|
size_t key_data_size = 0;
|
|
|
|
if(key->type == FuriHalCryptoKeyTypeMaster) {
|
|
pParam.KeyType = KEYTYPE_MASTER;
|
|
} else if(key->type == FuriHalCryptoKeyTypeSimple) {
|
|
pParam.KeyType = KEYTYPE_SIMPLE;
|
|
} else if(key->type == FuriHalCryptoKeyTypeEncrypted) {
|
|
pParam.KeyType = KEYTYPE_ENCRYPTED;
|
|
key_data_size += 12;
|
|
} else {
|
|
furi_crash("Incorrect key type");
|
|
}
|
|
|
|
if(key->size == FuriHalCryptoKeySize128) {
|
|
pParam.KeySize = KEYSIZE_16;
|
|
key_data_size += 16;
|
|
} else if(key->size == FuriHalCryptoKeySize256) {
|
|
pParam.KeySize = KEYSIZE_32;
|
|
key_data_size += 32;
|
|
} else {
|
|
furi_crash("Incorrect key size");
|
|
}
|
|
|
|
memcpy(pParam.KeyData, key->data, key_data_size);
|
|
|
|
return SHCI_C2_FUS_StoreUsrKey(&pParam, slot) == SHCI_Success;
|
|
}
|
|
|
|
bool furi_hal_crypto_store_load_key(uint8_t slot, const uint8_t* iv) {
|
|
furi_assert(slot > 0 && slot <= 100);
|
|
|
|
if(!furi_hal_bt_is_alive()) {
|
|
return false;
|
|
}
|
|
|
|
crypt.Instance = AES1;
|
|
crypt.Init.DataType = CRYP_DATATYPE_32B;
|
|
crypt.Init.KeySize = CRYP_KEYSIZE_256B;
|
|
crypt.Init.Algorithm = CRYP_AES_CBC;
|
|
crypt.Init.pInitVect = (uint32_t*)iv;
|
|
crypt.Init.KeyIVConfigSkip = CRYP_KEYIVCONFIG_ONCE;
|
|
crypt.Init.pKey = NULL;
|
|
|
|
furi_check(HAL_CRYP_Init(&crypt) == HAL_OK);
|
|
|
|
if(SHCI_C2_FUS_LoadUsrKey(slot) == SHCI_Success) {
|
|
return true;
|
|
} else {
|
|
furi_check(HAL_CRYP_DeInit(&crypt) == HAL_OK);
|
|
return false;
|
|
}
|
|
}
|
|
|
|
bool furi_hal_crypto_store_unload_key(uint8_t slot) {
|
|
if(!furi_hal_bt_is_alive()) {
|
|
return false;
|
|
}
|
|
|
|
furi_check(HAL_CRYP_DeInit(&crypt) == HAL_OK);
|
|
return SHCI_C2_FUS_UnloadUsrKey(slot) == SHCI_Success;
|
|
}
|
|
|
|
bool furi_hal_crypto_encrypt(const uint8_t* input, uint8_t* output, size_t size) {
|
|
return HAL_CRYP_Encrypt(&crypt, (uint32_t*)input, size / 4, (uint32_t*)output, 1000) == HAL_OK;
|
|
}
|
|
|
|
bool furi_hal_crypto_decrypt(const uint8_t* input, uint8_t* output, size_t size) {
|
|
return HAL_CRYP_Decrypt(&crypt, (uint32_t*)input, size / 4, (uint32_t*)output, 1000) == HAL_OK;
|
|
}
|