xref: /btstack/src/btstack_crypto.c (revision 6015e1edc2e003d8108b1cab8d122222067a4ee9)
1d1a1f6a4SMatthias Ringwald /*
2d1a1f6a4SMatthias Ringwald  * Copyright (C) 2017 BlueKitchen GmbH
3d1a1f6a4SMatthias Ringwald  *
4d1a1f6a4SMatthias Ringwald  * Redistribution and use in source and binary forms, with or without
5d1a1f6a4SMatthias Ringwald  * modification, are permitted provided that the following conditions
6d1a1f6a4SMatthias Ringwald  * are met:
7d1a1f6a4SMatthias Ringwald  *
8d1a1f6a4SMatthias Ringwald  * 1. Redistributions of source code must retain the above copyright
9d1a1f6a4SMatthias Ringwald  *    notice, this list of conditions and the following disclaimer.
10d1a1f6a4SMatthias Ringwald  * 2. Redistributions in binary form must reproduce the above copyright
11d1a1f6a4SMatthias Ringwald  *    notice, this list of conditions and the following disclaimer in the
12d1a1f6a4SMatthias Ringwald  *    documentation and/or other materials provided with the distribution.
13d1a1f6a4SMatthias Ringwald  * 3. Neither the name of the copyright holders nor the names of
14d1a1f6a4SMatthias Ringwald  *    contributors may be used to endorse or promote products derived
15d1a1f6a4SMatthias Ringwald  *    from this software without specific prior written permission.
16d1a1f6a4SMatthias Ringwald  *
17d1a1f6a4SMatthias Ringwald  * THIS SOFTWARE IS PROVIDED BY MATTHIAS RINGWALD AND CONTRIBUTORS
18d1a1f6a4SMatthias Ringwald  * ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT
19d1a1f6a4SMatthias Ringwald  * LIMITED TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS
20d1a1f6a4SMatthias Ringwald  * FOR A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL MATTHIAS
21d1a1f6a4SMatthias Ringwald  * RINGWALD OR CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT,
22d1a1f6a4SMatthias Ringwald  * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING,
23d1a1f6a4SMatthias Ringwald  * BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS
24d1a1f6a4SMatthias Ringwald  * OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED
25d1a1f6a4SMatthias Ringwald  * AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY,
26d1a1f6a4SMatthias Ringwald  * OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF
27d1a1f6a4SMatthias Ringwald  * THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
28d1a1f6a4SMatthias Ringwald  * SUCH DAMAGE.
29d1a1f6a4SMatthias Ringwald  *
30d1a1f6a4SMatthias Ringwald  */
31d1a1f6a4SMatthias Ringwald 
32d1a1f6a4SMatthias Ringwald #define __BTSTACK_FILE__ "btstack_crypto.c"
33d1a1f6a4SMatthias Ringwald 
34d1a1f6a4SMatthias Ringwald /*
35d1a1f6a4SMatthias Ringwald  * btstack_crypto.h
36d1a1f6a4SMatthias Ringwald  *
37d1a1f6a4SMatthias Ringwald  * Central place for all crypto-related functions with completion callbacks to allow
38d1a1f6a4SMatthias Ringwald  * using of MCU crypto peripherals or the Bluetooth controller
39d1a1f6a4SMatthias Ringwald  */
40d1a1f6a4SMatthias Ringwald 
41d1a1f6a4SMatthias Ringwald #include "btstack_crypto.h"
42d1a1f6a4SMatthias Ringwald 
43d1a1f6a4SMatthias Ringwald #include "btstack_debug.h"
44d1a1f6a4SMatthias Ringwald #include "btstack_event.h"
45d1a1f6a4SMatthias Ringwald #include "btstack_linked_list.h"
46d1a1f6a4SMatthias Ringwald #include "btstack_util.h"
47d1a1f6a4SMatthias Ringwald #include "hci.h"
48d1a1f6a4SMatthias Ringwald 
49d1a1f6a4SMatthias Ringwald // backwards-compatitility ENABLE_MICRO_ECC_FOR_LE_SECURE_CONNECTIONS -> ENABLE_MICRO_ECC_P256
50d1a1f6a4SMatthias Ringwald #if defined(ENABLE_MICRO_ECC_FOR_LE_SECURE_CONNECTIONS) && !defined(ENABLE_MICRO_ECC_P256)
51d1a1f6a4SMatthias Ringwald #define ENABLE_MICRO_ECC_P256
52d1a1f6a4SMatthias Ringwald #endif
53d1a1f6a4SMatthias Ringwald 
54d1a1f6a4SMatthias Ringwald // configure ECC implementations
55d1a1f6a4SMatthias Ringwald #if defined(ENABLE_MICRO_ECC_P256) && defined(HAVE_MBEDTLS_ECC_P256)
56d1a1f6a4SMatthias Ringwald #error "If you have mbedTLS (HAVE_MBEDTLS_ECC_P256), please disable uECC (ENABLE_MICRO_ECC_P256) in bstack_config.h"
57d1a1f6a4SMatthias Ringwald #endif
58d1a1f6a4SMatthias Ringwald 
59d1a1f6a4SMatthias Ringwald // Software ECC-P256 implementation provided by micro-ecc
60d1a1f6a4SMatthias Ringwald #ifdef ENABLE_MICRO_ECC_P256
61d1a1f6a4SMatthias Ringwald #define ENABLE_ECC_P256
62d1a1f6a4SMatthias Ringwald #define USE_MICRO_ECC_P256
63d1a1f6a4SMatthias Ringwald #define USE_SOFTWARE_ECC_P256_IMPLEMENTATION
64d1a1f6a4SMatthias Ringwald #include "uECC.h"
65d1a1f6a4SMatthias Ringwald #endif
66d1a1f6a4SMatthias Ringwald 
67d1a1f6a4SMatthias Ringwald // Software ECC-P256 implementation provided by mbedTLS
68d1a1f6a4SMatthias Ringwald #ifdef HAVE_MBEDTLS_ECC_P256
69d1a1f6a4SMatthias Ringwald #define ENABLE_ECC_P256
70d1a1f6a4SMatthias Ringwald #define USE_MBEDTLS_ECC_P256
71d1a1f6a4SMatthias Ringwald #define USE_SOFTWARE_ECC_P256_IMPLEMENTATION
72d1a1f6a4SMatthias Ringwald #include "mbedtls/config.h"
73d1a1f6a4SMatthias Ringwald #include "mbedtls/platform.h"
74d1a1f6a4SMatthias Ringwald #include "mbedtls/ecp.h"
75d1a1f6a4SMatthias Ringwald #endif
76d1a1f6a4SMatthias Ringwald 
77d1a1f6a4SMatthias Ringwald #if defined(ENABLE_LE_SECURE_CONNECTIONS) && !defined(ENABLE_ECC_P256)
78d1a1f6a4SMatthias Ringwald #define ENABLE_ECC_P256
79d1a1f6a4SMatthias Ringwald #endif
80d1a1f6a4SMatthias Ringwald 
81d1a1f6a4SMatthias Ringwald // Software AES128
82d1a1f6a4SMatthias Ringwald #ifdef HAVE_AES128
83d1a1f6a4SMatthias Ringwald #define USE_BTSTACK_AES128
84d1a1f6a4SMatthias Ringwald void btstack_aes128_calc(const uint8_t * key, const uint8_t * plaintext, uint8_t * result);
85d1a1f6a4SMatthias Ringwald #endif
86d1a1f6a4SMatthias Ringwald 
87d1a1f6a4SMatthias Ringwald typedef enum {
88d1a1f6a4SMatthias Ringwald     CMAC_IDLE,
89d1a1f6a4SMatthias Ringwald     CMAC_CALC_SUBKEYS,
90d1a1f6a4SMatthias Ringwald     CMAC_W4_SUBKEYS,
91d1a1f6a4SMatthias Ringwald     CMAC_CALC_MI,
92d1a1f6a4SMatthias Ringwald     CMAC_W4_MI,
93d1a1f6a4SMatthias Ringwald     CMAC_CALC_MLAST,
94d1a1f6a4SMatthias Ringwald     CMAC_W4_MLAST
95d1a1f6a4SMatthias Ringwald } btstack_crypto_cmac_state_t;
96d1a1f6a4SMatthias Ringwald 
97d1a1f6a4SMatthias Ringwald typedef enum {
98d1a1f6a4SMatthias Ringwald     ECC_P256_KEY_GENERATION_IDLE,
99d1a1f6a4SMatthias Ringwald     ECC_P256_KEY_GENERATION_GENERATING_RANDOM,
100d1a1f6a4SMatthias Ringwald     ECC_P256_KEY_GENERATION_ACTIVE,
101d1a1f6a4SMatthias Ringwald     ECC_P256_KEY_GENERATION_W4_KEY,
102d1a1f6a4SMatthias Ringwald     ECC_P256_KEY_GENERATION_DONE,
103d1a1f6a4SMatthias Ringwald } btstack_crypto_ecc_p256_key_generation_state_t;
104d1a1f6a4SMatthias Ringwald 
105d1a1f6a4SMatthias Ringwald static void btstack_crypto_run(void);
106d1a1f6a4SMatthias Ringwald 
107d1a1f6a4SMatthias Ringwald const static uint8_t zero[16] = { 0 };
108d1a1f6a4SMatthias Ringwald 
109d1a1f6a4SMatthias Ringwald static uint8_t btstack_crypto_initialized;
110d1a1f6a4SMatthias Ringwald static btstack_linked_list_t btstack_crypto_operations;
111d1a1f6a4SMatthias Ringwald static btstack_packet_callback_registration_t hci_event_callback_registration;
112d1a1f6a4SMatthias Ringwald static uint8_t btstack_crypto_wait_for_hci_result;
113d1a1f6a4SMatthias Ringwald 
114d1a1f6a4SMatthias Ringwald // state for AES-CMAC
115d1a1f6a4SMatthias Ringwald static btstack_crypto_cmac_state_t btstack_crypto_cmac_state;
116d1a1f6a4SMatthias Ringwald static sm_key_t btstack_crypto_cmac_k;
117d1a1f6a4SMatthias Ringwald static sm_key_t btstack_crypto_cmac_x;
118d1a1f6a4SMatthias Ringwald static sm_key_t btstack_crypto_cmac_m_last;
119d1a1f6a4SMatthias Ringwald static uint8_t  btstack_crypto_cmac_block_current;
120d1a1f6a4SMatthias Ringwald static uint8_t  btstack_crypto_cmac_block_count;
121d1a1f6a4SMatthias Ringwald 
122d1a1f6a4SMatthias Ringwald // state for AES-CCM
123ea478a83SMatthias Ringwald #ifndef USE_BTSTACK_AES128
124d1a1f6a4SMatthias Ringwald static uint8_t btstack_crypto_ccm_s[16];
125ea478a83SMatthias Ringwald #endif
126d1a1f6a4SMatthias Ringwald 
127d1a1f6a4SMatthias Ringwald #ifdef ENABLE_ECC_P256
128d1a1f6a4SMatthias Ringwald 
129d1a1f6a4SMatthias Ringwald static uint8_t  btstack_crypto_ecc_p256_public_key[64];
130d1a1f6a4SMatthias Ringwald static uint8_t  btstack_crypto_ecc_p256_random[64];
131d1a1f6a4SMatthias Ringwald static uint8_t  btstack_crypto_ecc_p256_random_len;
132d1a1f6a4SMatthias Ringwald static uint8_t  btstack_crypto_ecc_p256_random_offset;
133d1a1f6a4SMatthias Ringwald static btstack_crypto_ecc_p256_key_generation_state_t btstack_crypto_ecc_p256_key_generation_state;
134d1a1f6a4SMatthias Ringwald 
135d1a1f6a4SMatthias Ringwald #ifdef USE_SOFTWARE_ECC_P256_IMPLEMENTATION
136d1a1f6a4SMatthias Ringwald static uint8_t btstack_crypto_ecc_p256_d[32];
137d1a1f6a4SMatthias Ringwald #endif
138d1a1f6a4SMatthias Ringwald 
1390b672f43SMatthias Ringwald // Software ECDH implementation provided by mbedtls
1400b672f43SMatthias Ringwald #ifdef USE_MBEDTLS_ECC_P256
1410b672f43SMatthias Ringwald static mbedtls_ecp_group   mbedtls_ec_group;
1420b672f43SMatthias Ringwald #endif
1430b672f43SMatthias Ringwald 
144d1a1f6a4SMatthias Ringwald #endif /* ENABLE_ECC_P256 */
145d1a1f6a4SMatthias Ringwald 
146d1a1f6a4SMatthias Ringwald static void btstack_crypto_done(btstack_crypto_t * btstack_crypto){
147d1a1f6a4SMatthias Ringwald     btstack_linked_list_pop(&btstack_crypto_operations);
148d1a1f6a4SMatthias Ringwald     (*btstack_crypto->context_callback.callback)(btstack_crypto->context_callback.context);
149d1a1f6a4SMatthias Ringwald }
150d1a1f6a4SMatthias Ringwald 
151d1a1f6a4SMatthias Ringwald static inline void btstack_crypto_cmac_next_state(void){
152d1a1f6a4SMatthias Ringwald     btstack_crypto_cmac_state = (btstack_crypto_cmac_state_t) (((int)btstack_crypto_cmac_state) + 1);
153d1a1f6a4SMatthias Ringwald }
154d1a1f6a4SMatthias Ringwald 
155d1a1f6a4SMatthias Ringwald static int btstack_crypto_cmac_last_block_complete(btstack_crypto_aes128_cmac_t * btstack_crypto_cmac){
156d1a1f6a4SMatthias Ringwald 	uint16_t len = btstack_crypto_cmac->size;
157d1a1f6a4SMatthias Ringwald     if (len == 0) return 0;
158d1a1f6a4SMatthias Ringwald     return (len & 0x0f) == 0;
159d1a1f6a4SMatthias Ringwald }
160d1a1f6a4SMatthias Ringwald 
161d1a1f6a4SMatthias Ringwald static void btstack_crypto_aes128_start(const sm_key_t key, const sm_key_t plaintext){
162d1a1f6a4SMatthias Ringwald  	uint8_t key_flipped[16];
163d1a1f6a4SMatthias Ringwald  	uint8_t plaintext_flipped[16];
164d1a1f6a4SMatthias Ringwald     reverse_128(key, key_flipped);
165d1a1f6a4SMatthias Ringwald     reverse_128(plaintext, plaintext_flipped);
166d1a1f6a4SMatthias Ringwald  	btstack_crypto_wait_for_hci_result = 1;
167d1a1f6a4SMatthias Ringwald     hci_send_cmd(&hci_le_encrypt, key_flipped, plaintext_flipped);
168d1a1f6a4SMatthias Ringwald }
169d1a1f6a4SMatthias Ringwald 
170d1a1f6a4SMatthias Ringwald static uint8_t btstack_crypto_cmac_get_byte(btstack_crypto_aes128_cmac_t * btstack_crypto_cmac, uint16_t pos){
171d1a1f6a4SMatthias Ringwald 	if (btstack_crypto_cmac->btstack_crypto.operation == BTSTACK_CRYPTO_CMAC_GENERATOR){
17259ab1655SMatthias Ringwald 		return (*btstack_crypto_cmac->data.get_byte_callback)(pos);
173d1a1f6a4SMatthias Ringwald 	} else {
17459ab1655SMatthias Ringwald 		return btstack_crypto_cmac->data.message[pos];
175d1a1f6a4SMatthias Ringwald 	}
176d1a1f6a4SMatthias Ringwald }
177d1a1f6a4SMatthias Ringwald 
178d1a1f6a4SMatthias Ringwald static void btstack_crypto_cmac_handle_aes_engine_ready(btstack_crypto_aes128_cmac_t * btstack_crypto_cmac){
179d1a1f6a4SMatthias Ringwald     switch (btstack_crypto_cmac_state){
180d1a1f6a4SMatthias Ringwald         case CMAC_CALC_SUBKEYS: {
181d1a1f6a4SMatthias Ringwald             sm_key_t const_zero;
182d1a1f6a4SMatthias Ringwald             memset(const_zero, 0, 16);
183d1a1f6a4SMatthias Ringwald             btstack_crypto_cmac_next_state();
184d1a1f6a4SMatthias Ringwald             btstack_crypto_aes128_start(btstack_crypto_cmac_k, const_zero);
185d1a1f6a4SMatthias Ringwald             break;
186d1a1f6a4SMatthias Ringwald         }
187d1a1f6a4SMatthias Ringwald         case CMAC_CALC_MI: {
188d1a1f6a4SMatthias Ringwald             int j;
189d1a1f6a4SMatthias Ringwald             sm_key_t y;
190d1a1f6a4SMatthias Ringwald             for (j=0;j<16;j++){
191d1a1f6a4SMatthias Ringwald                 y[j] = btstack_crypto_cmac_x[j] ^ btstack_crypto_cmac_get_byte(btstack_crypto_cmac, btstack_crypto_cmac_block_current*16 + j);
192d1a1f6a4SMatthias Ringwald             }
193d1a1f6a4SMatthias Ringwald             btstack_crypto_cmac_block_current++;
194d1a1f6a4SMatthias Ringwald             btstack_crypto_cmac_next_state();
195d1a1f6a4SMatthias Ringwald             btstack_crypto_aes128_start(btstack_crypto_cmac_k, y);
196d1a1f6a4SMatthias Ringwald             break;
197d1a1f6a4SMatthias Ringwald         }
198d1a1f6a4SMatthias Ringwald         case CMAC_CALC_MLAST: {
199d1a1f6a4SMatthias Ringwald             int i;
200d1a1f6a4SMatthias Ringwald             sm_key_t y;
201d1a1f6a4SMatthias Ringwald             for (i=0;i<16;i++){
202d1a1f6a4SMatthias Ringwald                 y[i] = btstack_crypto_cmac_x[i] ^ btstack_crypto_cmac_m_last[i];
203d1a1f6a4SMatthias Ringwald             }
204d1a1f6a4SMatthias Ringwald             btstack_crypto_cmac_block_current++;
205d1a1f6a4SMatthias Ringwald             btstack_crypto_cmac_next_state();
206d1a1f6a4SMatthias Ringwald             btstack_crypto_aes128_start(btstack_crypto_cmac_k, y);
207d1a1f6a4SMatthias Ringwald             break;
208d1a1f6a4SMatthias Ringwald         }
209d1a1f6a4SMatthias Ringwald         default:
210d1a1f6a4SMatthias Ringwald             log_info("btstack_crypto_cmac_handle_aes_engine_ready called in state %u", btstack_crypto_cmac_state);
211d1a1f6a4SMatthias Ringwald             break;
212d1a1f6a4SMatthias Ringwald     }
213d1a1f6a4SMatthias Ringwald }
214d1a1f6a4SMatthias Ringwald 
215d1a1f6a4SMatthias Ringwald static void btstack_crypto_cmac_shift_left_by_one_bit_inplace(int len, uint8_t * data){
216d1a1f6a4SMatthias Ringwald     int i;
217d1a1f6a4SMatthias Ringwald     int carry = 0;
218d1a1f6a4SMatthias Ringwald     for (i=len-1; i >= 0 ; i--){
219d1a1f6a4SMatthias Ringwald         int new_carry = data[i] >> 7;
220d1a1f6a4SMatthias Ringwald         data[i] = data[i] << 1 | carry;
221d1a1f6a4SMatthias Ringwald         carry = new_carry;
222d1a1f6a4SMatthias Ringwald     }
223d1a1f6a4SMatthias Ringwald }
224d1a1f6a4SMatthias Ringwald 
225d1a1f6a4SMatthias Ringwald static void btstack_crypto_cmac_handle_encryption_result(btstack_crypto_aes128_cmac_t * btstack_crypto_cmac, sm_key_t data){
226d1a1f6a4SMatthias Ringwald     switch (btstack_crypto_cmac_state){
227d1a1f6a4SMatthias Ringwald         case CMAC_W4_SUBKEYS: {
228d1a1f6a4SMatthias Ringwald             sm_key_t k1;
229d1a1f6a4SMatthias Ringwald             memcpy(k1, data, 16);
230d1a1f6a4SMatthias Ringwald             btstack_crypto_cmac_shift_left_by_one_bit_inplace(16, k1);
231d1a1f6a4SMatthias Ringwald             if (data[0] & 0x80){
232d1a1f6a4SMatthias Ringwald                 k1[15] ^= 0x87;
233d1a1f6a4SMatthias Ringwald             }
234d1a1f6a4SMatthias Ringwald             sm_key_t k2;
235d1a1f6a4SMatthias Ringwald             memcpy(k2, k1, 16);
236d1a1f6a4SMatthias Ringwald             btstack_crypto_cmac_shift_left_by_one_bit_inplace(16, k2);
237d1a1f6a4SMatthias Ringwald             if (k1[0] & 0x80){
238d1a1f6a4SMatthias Ringwald                 k2[15] ^= 0x87;
239d1a1f6a4SMatthias Ringwald             }
240d1a1f6a4SMatthias Ringwald 
241d1a1f6a4SMatthias Ringwald             log_info_key("k", btstack_crypto_cmac_k);
242d1a1f6a4SMatthias Ringwald             log_info_key("k1", k1);
243d1a1f6a4SMatthias Ringwald             log_info_key("k2", k2);
244d1a1f6a4SMatthias Ringwald 
245d1a1f6a4SMatthias Ringwald             // step 4: set m_last
246d1a1f6a4SMatthias Ringwald             int i;
247d1a1f6a4SMatthias Ringwald             if (btstack_crypto_cmac_last_block_complete(btstack_crypto_cmac)){
248d1a1f6a4SMatthias Ringwald                 for (i=0;i<16;i++){
249d1a1f6a4SMatthias Ringwald                     btstack_crypto_cmac_m_last[i] = btstack_crypto_cmac_get_byte(btstack_crypto_cmac, btstack_crypto_cmac->size - 16 + i) ^ k1[i];
250d1a1f6a4SMatthias Ringwald                 }
251d1a1f6a4SMatthias Ringwald             } else {
252d1a1f6a4SMatthias Ringwald                 int valid_octets_in_last_block = btstack_crypto_cmac->size & 0x0f;
253d1a1f6a4SMatthias Ringwald                 for (i=0;i<16;i++){
254d1a1f6a4SMatthias Ringwald                     if (i < valid_octets_in_last_block){
255d1a1f6a4SMatthias Ringwald                         btstack_crypto_cmac_m_last[i] = btstack_crypto_cmac_get_byte(btstack_crypto_cmac, (btstack_crypto_cmac->size & 0xfff0) + i) ^ k2[i];
256d1a1f6a4SMatthias Ringwald                         continue;
257d1a1f6a4SMatthias Ringwald                     }
258d1a1f6a4SMatthias Ringwald                     if (i == valid_octets_in_last_block){
259d1a1f6a4SMatthias Ringwald                         btstack_crypto_cmac_m_last[i] = 0x80 ^ k2[i];
260d1a1f6a4SMatthias Ringwald                         continue;
261d1a1f6a4SMatthias Ringwald                     }
262d1a1f6a4SMatthias Ringwald                     btstack_crypto_cmac_m_last[i] = k2[i];
263d1a1f6a4SMatthias Ringwald                 }
264d1a1f6a4SMatthias Ringwald             }
265d1a1f6a4SMatthias Ringwald 
266d1a1f6a4SMatthias Ringwald             // next
267d1a1f6a4SMatthias Ringwald             btstack_crypto_cmac_state = btstack_crypto_cmac_block_current < btstack_crypto_cmac_block_count - 1 ? CMAC_CALC_MI : CMAC_CALC_MLAST;
268d1a1f6a4SMatthias Ringwald             break;
269d1a1f6a4SMatthias Ringwald         }
270d1a1f6a4SMatthias Ringwald         case CMAC_W4_MI:
271d1a1f6a4SMatthias Ringwald             memcpy(btstack_crypto_cmac_x, data, 16);
272d1a1f6a4SMatthias Ringwald             btstack_crypto_cmac_state = btstack_crypto_cmac_block_current < btstack_crypto_cmac_block_count - 1 ? CMAC_CALC_MI : CMAC_CALC_MLAST;
273d1a1f6a4SMatthias Ringwald             break;
274d1a1f6a4SMatthias Ringwald         case CMAC_W4_MLAST:
275d1a1f6a4SMatthias Ringwald             // done
276d1a1f6a4SMatthias Ringwald             log_info("Setting CMAC Engine to IDLE");
277d1a1f6a4SMatthias Ringwald             btstack_crypto_cmac_state = CMAC_IDLE;
278d1a1f6a4SMatthias Ringwald             log_info_key("CMAC", data);
279d1a1f6a4SMatthias Ringwald             memcpy(btstack_crypto_cmac->hash, data, 16);
280d1a1f6a4SMatthias Ringwald 			btstack_linked_list_pop(&btstack_crypto_operations);
281d1a1f6a4SMatthias Ringwald 			(*btstack_crypto_cmac->btstack_crypto.context_callback.callback)(btstack_crypto_cmac->btstack_crypto.context_callback.context);
282d1a1f6a4SMatthias Ringwald             break;
283d1a1f6a4SMatthias Ringwald         default:
284d1a1f6a4SMatthias Ringwald             log_info("btstack_crypto_cmac_handle_encryption_result called in state %u", btstack_crypto_cmac_state);
285d1a1f6a4SMatthias Ringwald             break;
286d1a1f6a4SMatthias Ringwald     }
287d1a1f6a4SMatthias Ringwald }
288d1a1f6a4SMatthias Ringwald 
289d1a1f6a4SMatthias Ringwald static void btstack_crypto_cmac_start(btstack_crypto_aes128_cmac_t * btstack_crypto_cmac){
290d1a1f6a4SMatthias Ringwald 
291d1a1f6a4SMatthias Ringwald     memcpy(btstack_crypto_cmac_k, btstack_crypto_cmac->key, 16);
292d1a1f6a4SMatthias Ringwald     memset(btstack_crypto_cmac_x, 0, 16);
293d1a1f6a4SMatthias Ringwald     btstack_crypto_cmac_block_current = 0;
294d1a1f6a4SMatthias Ringwald 
295d1a1f6a4SMatthias Ringwald     // step 2: n := ceil(len/const_Bsize);
296d1a1f6a4SMatthias Ringwald     btstack_crypto_cmac_block_count = (btstack_crypto_cmac->size + 15) / 16;
297d1a1f6a4SMatthias Ringwald 
298d1a1f6a4SMatthias Ringwald     // step 3: ..
299d1a1f6a4SMatthias Ringwald     if (btstack_crypto_cmac_block_count==0){
300d1a1f6a4SMatthias Ringwald         btstack_crypto_cmac_block_count = 1;
301d1a1f6a4SMatthias Ringwald     }
302d1a1f6a4SMatthias Ringwald     log_info("btstack_crypto_cmac_start: len %u, block count %u", btstack_crypto_cmac->size, btstack_crypto_cmac_block_count);
303d1a1f6a4SMatthias Ringwald 
304d1a1f6a4SMatthias Ringwald     // first, we need to compute l for k1, k2, and m_last
305d1a1f6a4SMatthias Ringwald     btstack_crypto_cmac_state = CMAC_CALC_SUBKEYS;
306d1a1f6a4SMatthias Ringwald 
307d1a1f6a4SMatthias Ringwald     // let's go
308d1a1f6a4SMatthias Ringwald     btstack_crypto_cmac_handle_aes_engine_ready(btstack_crypto_cmac);
309d1a1f6a4SMatthias Ringwald }
310d1a1f6a4SMatthias Ringwald 
311ea478a83SMatthias Ringwald #ifndef USE_BTSTACK_AES128
312ea478a83SMatthias Ringwald 
313d1a1f6a4SMatthias Ringwald /*
314d1a1f6a4SMatthias Ringwald   To encrypt the message data we use Counter (CTR) mode.  We first
315d1a1f6a4SMatthias Ringwald   define the key stream blocks by:
316d1a1f6a4SMatthias Ringwald 
317d1a1f6a4SMatthias Ringwald       S_i := E( K, A_i )   for i=0, 1, 2, ...
318d1a1f6a4SMatthias Ringwald 
319d1a1f6a4SMatthias Ringwald   The values A_i are formatted as follows, where the Counter field i is
320d1a1f6a4SMatthias Ringwald   encoded in most-significant-byte first order:
321d1a1f6a4SMatthias Ringwald 
322d1a1f6a4SMatthias Ringwald   Octet Number   Contents
323d1a1f6a4SMatthias Ringwald   ------------   ---------
324d1a1f6a4SMatthias Ringwald   0              Flags
325d1a1f6a4SMatthias Ringwald   1 ... 15-L     Nonce N
326d1a1f6a4SMatthias Ringwald   16-L ... 15    Counter i
327d1a1f6a4SMatthias Ringwald 
328d1a1f6a4SMatthias Ringwald   Bit Number   Contents
329d1a1f6a4SMatthias Ringwald   ----------   ----------------------
330d1a1f6a4SMatthias Ringwald   7            Reserved (always zero)
331d1a1f6a4SMatthias Ringwald   6            Reserved (always zero)
332d1a1f6a4SMatthias Ringwald   5 ... 3      Zero
333d1a1f6a4SMatthias Ringwald   2 ... 0      L'
334d1a1f6a4SMatthias Ringwald */
335d1a1f6a4SMatthias Ringwald 
336d1a1f6a4SMatthias Ringwald static void btstack_crypto_ccm_setup_a_i(btstack_crypto_ccm_t * btstack_crypto_ccm, uint16_t counter){
337d1a1f6a4SMatthias Ringwald     btstack_crypto_ccm_s[0] = 1;  // L' = L - 1
338d1a1f6a4SMatthias Ringwald     memcpy(&btstack_crypto_ccm_s[1], btstack_crypto_ccm->nonce, 13);
339d1a1f6a4SMatthias Ringwald     big_endian_store_16(btstack_crypto_ccm_s, 14, counter);
340d1a1f6a4SMatthias Ringwald }
341d1a1f6a4SMatthias Ringwald 
342d1a1f6a4SMatthias Ringwald /*
343d1a1f6a4SMatthias Ringwald  The first step is to compute the authentication field T.  This is
344d1a1f6a4SMatthias Ringwald    done using CBC-MAC [MAC].  We first define a sequence of blocks B_0,
345d1a1f6a4SMatthias Ringwald    B_1, ..., B_n and then apply CBC-MAC to these blocks.
346d1a1f6a4SMatthias Ringwald 
347d1a1f6a4SMatthias Ringwald    The first block B_0 is formatted as follows, where l(m) is encoded in
348d1a1f6a4SMatthias Ringwald    most-significant-byte first order:
349d1a1f6a4SMatthias Ringwald 
350d1a1f6a4SMatthias Ringwald       Octet Number   Contents
351d1a1f6a4SMatthias Ringwald       ------------   ---------
352d1a1f6a4SMatthias Ringwald       0              Flags
353d1a1f6a4SMatthias Ringwald       1 ... 15-L     Nonce N
354d1a1f6a4SMatthias Ringwald       16-L ... 15    l(m)
355d1a1f6a4SMatthias Ringwald 
356d1a1f6a4SMatthias Ringwald    Within the first block B_0, the Flags field is formatted as follows:
357d1a1f6a4SMatthias Ringwald 
358d1a1f6a4SMatthias Ringwald       Bit Number   Contents
359d1a1f6a4SMatthias Ringwald       ----------   ----------------------
360d1a1f6a4SMatthias Ringwald       7            Reserved (always zero)
361d1a1f6a4SMatthias Ringwald       6            Adata
362d1a1f6a4SMatthias Ringwald       5 ... 3      M'
363d1a1f6a4SMatthias Ringwald       2 ... 0      L'
364d1a1f6a4SMatthias Ringwald  */
365d1a1f6a4SMatthias Ringwald 
366d1a1f6a4SMatthias Ringwald static void btstack_crypto_ccm_setup_b_0(btstack_crypto_ccm_t * btstack_crypto_ccm, uint8_t * b0){
367*6015e1edSMatthias Ringwald     uint8_t m_prime = (btstack_crypto_ccm->auth_len - 2) / 2;
368*6015e1edSMatthias Ringwald     b0[0] = (m_prime << 3) | 1 ;  // Adata = 0, M', L' = L - 1
369d1a1f6a4SMatthias Ringwald     memcpy(&b0[1], btstack_crypto_ccm->nonce, 13);
370d1a1f6a4SMatthias Ringwald     big_endian_store_16(b0, 14, btstack_crypto_ccm->message_len);
371d1a1f6a4SMatthias Ringwald }
372ea478a83SMatthias Ringwald #endif
373d1a1f6a4SMatthias Ringwald 
374d1a1f6a4SMatthias Ringwald #ifdef ENABLE_ECC_P256
375d1a1f6a4SMatthias Ringwald 
376d1a1f6a4SMatthias Ringwald static void btstack_crypto_log_ec_publickey(const uint8_t * ec_q){
377d1a1f6a4SMatthias Ringwald     log_info("Elliptic curve: X");
378d1a1f6a4SMatthias Ringwald     log_info_hexdump(&ec_q[0],32);
379d1a1f6a4SMatthias Ringwald     log_info("Elliptic curve: Y");
380d1a1f6a4SMatthias Ringwald     log_info_hexdump(&ec_q[32],32);
381d1a1f6a4SMatthias Ringwald }
382d1a1f6a4SMatthias Ringwald 
383d1a1f6a4SMatthias Ringwald #if (defined(USE_MICRO_ECC_P256) && !defined(WICED_VERSION)) || defined(USE_MBEDTLS_ECC_P256)
384d1a1f6a4SMatthias Ringwald // @return OK
385d1a1f6a4SMatthias Ringwald static int sm_generate_f_rng(unsigned char * buffer, unsigned size){
386d1a1f6a4SMatthias Ringwald     if (btstack_crypto_ecc_p256_key_generation_state != ECC_P256_KEY_GENERATION_ACTIVE) return 0;
387d1a1f6a4SMatthias Ringwald     log_info("sm_generate_f_rng: size %u - offset %u", (int) size, btstack_crypto_ecc_p256_random_offset);
388d1a1f6a4SMatthias Ringwald     while (size) {
389d1a1f6a4SMatthias Ringwald         *buffer++ = btstack_crypto_ecc_p256_random[btstack_crypto_ecc_p256_random_offset++];
390d1a1f6a4SMatthias Ringwald         size--;
391d1a1f6a4SMatthias Ringwald     }
392d1a1f6a4SMatthias Ringwald     return 1;
393d1a1f6a4SMatthias Ringwald }
394d1a1f6a4SMatthias Ringwald #endif
395d1a1f6a4SMatthias Ringwald #ifdef USE_MBEDTLS_ECC_P256
396d1a1f6a4SMatthias Ringwald // @return error - just wrap sm_generate_f_rng
397d1a1f6a4SMatthias Ringwald static int sm_generate_f_rng_mbedtls(void * context, unsigned char * buffer, size_t size){
398d1a1f6a4SMatthias Ringwald     UNUSED(context);
399d1a1f6a4SMatthias Ringwald     return sm_generate_f_rng(buffer, size) == 0;
400d1a1f6a4SMatthias Ringwald }
401d1a1f6a4SMatthias Ringwald #endif /* USE_MBEDTLS_ECC_P256 */
402d1a1f6a4SMatthias Ringwald 
403d1a1f6a4SMatthias Ringwald static void btstack_crypto_ecc_p256_generate_key_software(void){
404d1a1f6a4SMatthias Ringwald 
405d1a1f6a4SMatthias Ringwald     btstack_crypto_ecc_p256_random_offset = 0;
406d1a1f6a4SMatthias Ringwald 
407d1a1f6a4SMatthias Ringwald     // generate EC key
408d1a1f6a4SMatthias Ringwald #ifdef USE_MICRO_ECC_P256
409d1a1f6a4SMatthias Ringwald 
410d1a1f6a4SMatthias Ringwald #ifndef WICED_VERSION
411d1a1f6a4SMatthias Ringwald     log_info("set uECC RNG for initial key generation with 64 random bytes");
412d1a1f6a4SMatthias Ringwald     // micro-ecc from WICED SDK uses its wiced_crypto_get_random by default - no need to set it
413d1a1f6a4SMatthias Ringwald     uECC_set_rng(&sm_generate_f_rng);
414d1a1f6a4SMatthias Ringwald #endif /* WICED_VERSION */
415d1a1f6a4SMatthias Ringwald 
416d1a1f6a4SMatthias Ringwald #if uECC_SUPPORTS_secp256r1
417d1a1f6a4SMatthias Ringwald     // standard version
418d1a1f6a4SMatthias Ringwald     uECC_make_key(btstack_crypto_ecc_p256_public_key, btstack_crypto_ecc_p256_d, uECC_secp256r1());
419d1a1f6a4SMatthias Ringwald 
420d1a1f6a4SMatthias Ringwald     // disable RNG again, as returning no randmon data lets shared key generation fail
421d1a1f6a4SMatthias Ringwald     log_info("disable uECC RNG in standard version after key generation");
422d1a1f6a4SMatthias Ringwald     uECC_set_rng(NULL);
423d1a1f6a4SMatthias Ringwald #else
424d1a1f6a4SMatthias Ringwald     // static version
425d1a1f6a4SMatthias Ringwald     uECC_make_key(btstack_crypto_ecc_p256_public_key, btstack_crypto_ecc_p256_d);
426d1a1f6a4SMatthias Ringwald #endif
427d1a1f6a4SMatthias Ringwald #endif /* USE_MICRO_ECC_P256 */
428d1a1f6a4SMatthias Ringwald 
429d1a1f6a4SMatthias Ringwald #ifdef USE_MBEDTLS_ECC_P256
430d1a1f6a4SMatthias Ringwald     mbedtls_mpi d;
431d1a1f6a4SMatthias Ringwald     mbedtls_ecp_point P;
432d1a1f6a4SMatthias Ringwald     mbedtls_mpi_init(&d);
433d1a1f6a4SMatthias Ringwald     mbedtls_ecp_point_init(&P);
434d1a1f6a4SMatthias Ringwald     int res = mbedtls_ecp_gen_keypair(&mbedtls_ec_group, &d, &P, &sm_generate_f_rng_mbedtls, NULL);
435d1a1f6a4SMatthias Ringwald     log_info("gen keypair %x", res);
436d1a1f6a4SMatthias Ringwald     mbedtls_mpi_write_binary(&P.X, &btstack_crypto_ecc_p256_public_key[0],  32);
437d1a1f6a4SMatthias Ringwald     mbedtls_mpi_write_binary(&P.Y, &btstack_crypto_ecc_p256_public_key[32], 32);
438d1a1f6a4SMatthias Ringwald     mbedtls_mpi_write_binary(&d, btstack_crypto_ecc_p256_d, 32);
439d1a1f6a4SMatthias Ringwald     mbedtls_ecp_point_free(&P);
440d1a1f6a4SMatthias Ringwald     mbedtls_mpi_free(&d);
441d1a1f6a4SMatthias Ringwald #endif  /* USE_MBEDTLS_ECC_P256 */
442d1a1f6a4SMatthias Ringwald }
443d1a1f6a4SMatthias Ringwald 
444d1a1f6a4SMatthias Ringwald #ifdef USE_SOFTWARE_ECC_P256_IMPLEMENTATION
445d1a1f6a4SMatthias Ringwald static void btstack_crypto_ecc_p256_calculate_dhkey_software(btstack_crypto_ecc_p256_t * btstack_crypto_ec_p192){
446d1a1f6a4SMatthias Ringwald     memset(btstack_crypto_ec_p192->dhkey, 0, 32);
447d1a1f6a4SMatthias Ringwald 
448d1a1f6a4SMatthias Ringwald #ifdef USE_MICRO_ECC_P256
449d1a1f6a4SMatthias Ringwald #if uECC_SUPPORTS_secp256r1
450d1a1f6a4SMatthias Ringwald     // standard version
451d1a1f6a4SMatthias Ringwald     uECC_shared_secret(btstack_crypto_ec_p192->public_key, btstack_crypto_ecc_p256_d, btstack_crypto_ec_p192->dhkey, uECC_secp256r1());
452d1a1f6a4SMatthias Ringwald #else
453d1a1f6a4SMatthias Ringwald     // static version
454d1a1f6a4SMatthias Ringwald     uECC_shared_secret(btstack_crypto_ec_p192->public_key, btstack_crypto_ecc_p256_d, btstack_crypto_ec_p192->dhkey);
455d1a1f6a4SMatthias Ringwald #endif
456d1a1f6a4SMatthias Ringwald #endif
457d1a1f6a4SMatthias Ringwald 
458d1a1f6a4SMatthias Ringwald #ifdef USE_MBEDTLS_ECC_P256
459d1a1f6a4SMatthias Ringwald     // da * Pb
460d1a1f6a4SMatthias Ringwald     mbedtls_mpi d;
461d1a1f6a4SMatthias Ringwald     mbedtls_ecp_point Q;
462d1a1f6a4SMatthias Ringwald     mbedtls_ecp_point DH;
463d1a1f6a4SMatthias Ringwald     mbedtls_mpi_init(&d);
464d1a1f6a4SMatthias Ringwald     mbedtls_ecp_point_init(&Q);
465d1a1f6a4SMatthias Ringwald     mbedtls_ecp_point_init(&DH);
466d1a1f6a4SMatthias Ringwald     mbedtls_mpi_read_binary(&d, btstack_crypto_ecc_p256_d, 32);
467d1a1f6a4SMatthias Ringwald     mbedtls_mpi_read_binary(&Q.X, &btstack_crypto_ec_p192->public_key[0] , 32);
468d1a1f6a4SMatthias Ringwald     mbedtls_mpi_read_binary(&Q.Y, &btstack_crypto_ec_p192->public_key[32], 32);
469d1a1f6a4SMatthias Ringwald     mbedtls_mpi_lset(&Q.Z, 1);
470d1a1f6a4SMatthias Ringwald     mbedtls_ecp_mul(&mbedtls_ec_group, &DH, &d, &Q, NULL, NULL);
471d1a1f6a4SMatthias Ringwald     mbedtls_mpi_write_binary(&DH.X, btstack_crypto_ec_p192->dhkey, 32);
472d1a1f6a4SMatthias Ringwald     mbedtls_ecp_point_free(&DH);
473d1a1f6a4SMatthias Ringwald     mbedtls_mpi_free(&d);
474d1a1f6a4SMatthias Ringwald     mbedtls_ecp_point_free(&Q);
475d1a1f6a4SMatthias Ringwald #endif
476d1a1f6a4SMatthias Ringwald 
477d1a1f6a4SMatthias Ringwald     log_info("dhkey");
478d1a1f6a4SMatthias Ringwald     log_info_hexdump(btstack_crypto_ec_p192->dhkey, 32);
479d1a1f6a4SMatthias Ringwald }
480d1a1f6a4SMatthias Ringwald #endif
481d1a1f6a4SMatthias Ringwald 
482d1a1f6a4SMatthias Ringwald #endif
483d1a1f6a4SMatthias Ringwald 
484ea478a83SMatthias Ringwald #ifdef USE_BTSTACK_AES128
485ea478a83SMatthias Ringwald // CCM not implemented using software AES128 yet
486ea478a83SMatthias Ringwald #else
487d1a1f6a4SMatthias Ringwald 
488d1a1f6a4SMatthias Ringwald static void btstack_crypto_ccm_calc_s0(btstack_crypto_ccm_t * btstack_crypto_ccm){
489d1a1f6a4SMatthias Ringwald     btstack_crypto_ccm->state = CCM_W4_S0;
490d1a1f6a4SMatthias Ringwald     btstack_crypto_ccm_setup_a_i(btstack_crypto_ccm, 0);
491d1a1f6a4SMatthias Ringwald     btstack_crypto_aes128_start(btstack_crypto_ccm->key, btstack_crypto_ccm_s);
492d1a1f6a4SMatthias Ringwald }
493d1a1f6a4SMatthias Ringwald 
494d1a1f6a4SMatthias Ringwald static void btstack_crypto_ccm_calc_sn(btstack_crypto_ccm_t * btstack_crypto_ccm){
495d1a1f6a4SMatthias Ringwald     btstack_crypto_ccm->state = CCM_W4_SN;
496d1a1f6a4SMatthias Ringwald     btstack_crypto_ccm_setup_a_i(btstack_crypto_ccm, btstack_crypto_ccm->counter);
497d1a1f6a4SMatthias Ringwald     btstack_crypto_aes128_start(btstack_crypto_ccm->key, btstack_crypto_ccm_s);
498d1a1f6a4SMatthias Ringwald }
499d1a1f6a4SMatthias Ringwald 
500d1a1f6a4SMatthias Ringwald static void btstack_crypto_ccm_calc_x1(btstack_crypto_ccm_t * btstack_crypto_ccm){
501d1a1f6a4SMatthias Ringwald     uint8_t btstack_crypto_ccm_buffer[16];
502d1a1f6a4SMatthias Ringwald     btstack_crypto_ccm->state = CCM_W4_X1;
503d1a1f6a4SMatthias Ringwald     btstack_crypto_ccm_setup_b_0(btstack_crypto_ccm, btstack_crypto_ccm_buffer);
504d1a1f6a4SMatthias Ringwald     btstack_crypto_aes128_start(btstack_crypto_ccm->key, btstack_crypto_ccm_buffer);
505d1a1f6a4SMatthias Ringwald }
506d1a1f6a4SMatthias Ringwald 
507d1a1f6a4SMatthias Ringwald static void btstack_crypto_ccm_calc_xn(btstack_crypto_ccm_t * btstack_crypto_ccm, const uint8_t * plaintext){
508d1a1f6a4SMatthias Ringwald     int i;
509d1a1f6a4SMatthias Ringwald     int bytes_to_decrypt;
510d1a1f6a4SMatthias Ringwald     uint8_t btstack_crypto_ccm_buffer[16];
511d1a1f6a4SMatthias Ringwald     btstack_crypto_ccm->state = CCM_W4_XN;
512d1a1f6a4SMatthias Ringwald     bytes_to_decrypt = btstack_min(btstack_crypto_ccm->block_len, 16);
513d1a1f6a4SMatthias Ringwald     i = 0;
514d1a1f6a4SMatthias Ringwald     while (i < bytes_to_decrypt){
515d1a1f6a4SMatthias Ringwald         btstack_crypto_ccm_buffer[i] =  btstack_crypto_ccm->x_i[i] ^ plaintext[i];
516d1a1f6a4SMatthias Ringwald         i++;
517d1a1f6a4SMatthias Ringwald     }
518d1a1f6a4SMatthias Ringwald     memcpy(&btstack_crypto_ccm_buffer[i], &btstack_crypto_ccm->x_i[i], 16 - bytes_to_decrypt);
519d1a1f6a4SMatthias Ringwald     btstack_crypto_aes128_start(btstack_crypto_ccm->key, btstack_crypto_ccm_buffer);
520d1a1f6a4SMatthias Ringwald }
521ea478a83SMatthias Ringwald #endif
522d1a1f6a4SMatthias Ringwald 
523d1a1f6a4SMatthias Ringwald static void btstack_crypto_ccm_handle_s0(btstack_crypto_ccm_t * btstack_crypto_ccm, const uint8_t * data){
524d1a1f6a4SMatthias Ringwald     // data is little-endian, flip on the fly
525d1a1f6a4SMatthias Ringwald     int i;
526d1a1f6a4SMatthias Ringwald     for (i=0;i<16;i++){
527d1a1f6a4SMatthias Ringwald         btstack_crypto_ccm->x_i[i] = btstack_crypto_ccm->x_i[i] ^ data[15-i];
528d1a1f6a4SMatthias Ringwald     }
529d1a1f6a4SMatthias Ringwald     btstack_crypto_done(&btstack_crypto_ccm->btstack_crypto);
530d1a1f6a4SMatthias Ringwald }
531d1a1f6a4SMatthias Ringwald 
532d1a1f6a4SMatthias Ringwald static void btstack_crypto_ccm_handle_sn(btstack_crypto_ccm_t * btstack_crypto_ccm, const uint8_t * data){
533d1a1f6a4SMatthias Ringwald     // data is little-endian, flip on the fly
534d1a1f6a4SMatthias Ringwald     int i;
535d1a1f6a4SMatthias Ringwald     uint16_t bytes_to_process = btstack_min(btstack_crypto_ccm->block_len, 16);
536d1a1f6a4SMatthias Ringwald     for (i=0;i<bytes_to_process;i++){
537d1a1f6a4SMatthias Ringwald         btstack_crypto_ccm->output[i] = btstack_crypto_ccm->input[i] ^ data[15-i];
538d1a1f6a4SMatthias Ringwald     }
539d1a1f6a4SMatthias Ringwald }
540d1a1f6a4SMatthias Ringwald 
541d1a1f6a4SMatthias Ringwald static void btstack_crypto_ccm_next_block(btstack_crypto_ccm_t * btstack_crypto_ccm, btstack_crypto_ccm_state_t state_when_done){
542d1a1f6a4SMatthias Ringwald     uint16_t bytes_to_process = btstack_min(btstack_crypto_ccm->block_len, 16);
543d1a1f6a4SMatthias Ringwald     // next block
544d1a1f6a4SMatthias Ringwald     btstack_crypto_ccm->counter++;
545d1a1f6a4SMatthias Ringwald     btstack_crypto_ccm->input      += bytes_to_process;
546d1a1f6a4SMatthias Ringwald     btstack_crypto_ccm->output     += bytes_to_process;
547d1a1f6a4SMatthias Ringwald     btstack_crypto_ccm->block_len  -= bytes_to_process;
548d1a1f6a4SMatthias Ringwald     if (btstack_crypto_ccm->block_len == 0){
549d1a1f6a4SMatthias Ringwald         btstack_crypto_ccm->state = CCM_CALCULATE_S0;
550d1a1f6a4SMatthias Ringwald     }
551d1a1f6a4SMatthias Ringwald     else {
552d1a1f6a4SMatthias Ringwald         btstack_crypto_ccm->state = state_when_done;
553d1a1f6a4SMatthias Ringwald     }
554d1a1f6a4SMatthias Ringwald }
555d1a1f6a4SMatthias Ringwald 
556d1a1f6a4SMatthias Ringwald static void btstack_crypto_run(void){
557d1a1f6a4SMatthias Ringwald 
558d1a1f6a4SMatthias Ringwald     btstack_crypto_aes128_t        * btstack_crypto_aes128;
559d1a1f6a4SMatthias Ringwald     btstack_crypto_ccm_t           * btstack_crypto_ccm;
560d1a1f6a4SMatthias Ringwald     btstack_crypto_aes128_cmac_t   * btstack_crypto_cmac;
561d1a1f6a4SMatthias Ringwald #ifdef ENABLE_ECC_P256
562d1a1f6a4SMatthias Ringwald     btstack_crypto_ecc_p256_t      * btstack_crypto_ec_p192;
563d1a1f6a4SMatthias Ringwald #endif
564d1a1f6a4SMatthias Ringwald 
565d1a1f6a4SMatthias Ringwald     // stack up and running?
566d1a1f6a4SMatthias Ringwald     if (hci_get_state() != HCI_STATE_WORKING) return;
567d1a1f6a4SMatthias Ringwald 
568d1a1f6a4SMatthias Ringwald 	// already active?
569d1a1f6a4SMatthias Ringwald 	if (btstack_crypto_wait_for_hci_result) return;
570d1a1f6a4SMatthias Ringwald 
571d1a1f6a4SMatthias Ringwald 	// anything to do?
572d1a1f6a4SMatthias Ringwald 	if (btstack_linked_list_empty(&btstack_crypto_operations)) return;
573d1a1f6a4SMatthias Ringwald 
574d1a1f6a4SMatthias Ringwald     // can send a command?
575d1a1f6a4SMatthias Ringwald     if (!hci_can_send_command_packet_now()) return;
576d1a1f6a4SMatthias Ringwald 
577d1a1f6a4SMatthias Ringwald 	btstack_crypto_t * btstack_crypto = (btstack_crypto_t*) btstack_linked_list_get_first_item(&btstack_crypto_operations);
578d1a1f6a4SMatthias Ringwald 	switch (btstack_crypto->operation){
579d1a1f6a4SMatthias Ringwald 		case BTSTACK_CRYPTO_RANDOM:
580d1a1f6a4SMatthias Ringwald 			btstack_crypto_wait_for_hci_result = 1;
581d1a1f6a4SMatthias Ringwald 		    hci_send_cmd(&hci_le_rand);
582d1a1f6a4SMatthias Ringwald 		    break;
583d1a1f6a4SMatthias Ringwald 		case BTSTACK_CRYPTO_AES128:
584d1a1f6a4SMatthias Ringwald             btstack_crypto_aes128 = (btstack_crypto_aes128_t *) btstack_crypto;
585d1a1f6a4SMatthias Ringwald #ifdef USE_BTSTACK_AES128
586d1a1f6a4SMatthias Ringwald             btstack_aes128_calc(btstack_crypto_aes128->key, btstack_crypto_aes128->plaintext, btstack_crypto_aes128->ciphertext);
5877909a414SMatthias Ringwald             btstack_crypto_done(btstack_crypto);
588d1a1f6a4SMatthias Ringwald #else
589d1a1f6a4SMatthias Ringwald             btstack_crypto_aes128_start(btstack_crypto_aes128->key, btstack_crypto_aes128->plaintext);
590d1a1f6a4SMatthias Ringwald #endif
591d1a1f6a4SMatthias Ringwald 		    break;
592d1a1f6a4SMatthias Ringwald 		case BTSTACK_CRYPTO_CMAC_MESSAGE:
593d1a1f6a4SMatthias Ringwald 		case BTSTACK_CRYPTO_CMAC_GENERATOR:
594d1a1f6a4SMatthias Ringwald 			btstack_crypto_wait_for_hci_result = 1;
595d1a1f6a4SMatthias Ringwald 			btstack_crypto_cmac = (btstack_crypto_aes128_cmac_t *) btstack_crypto;
596d1a1f6a4SMatthias Ringwald 			if (btstack_crypto_cmac_state == CMAC_IDLE){
597d1a1f6a4SMatthias Ringwald 				btstack_crypto_cmac_start(btstack_crypto_cmac);
598d1a1f6a4SMatthias Ringwald 			} else {
599d1a1f6a4SMatthias Ringwald 				btstack_crypto_cmac_handle_aes_engine_ready(btstack_crypto_cmac);
600d1a1f6a4SMatthias Ringwald 			}
601d1a1f6a4SMatthias Ringwald 			break;
602d1a1f6a4SMatthias Ringwald 
603d1a1f6a4SMatthias Ringwald         case BTSTACK_CRYPTO_CCM_ENCRYPT_BLOCK:
604d1a1f6a4SMatthias Ringwald         case BTSTACK_CRYPTO_CCM_DECRYPT_BLOCK:
605d1a1f6a4SMatthias Ringwald #ifdef USE_BTSTACK_AES128
606ea478a83SMatthias Ringwald             UNUSED(btstack_crypto_ccm);
607d1a1f6a4SMatthias Ringwald             log_error("ccm not implemented for software aes128 yet");
608d1a1f6a4SMatthias Ringwald #else
609d1a1f6a4SMatthias Ringwald             btstack_crypto_ccm = (btstack_crypto_ccm_t *) btstack_crypto;
610d1a1f6a4SMatthias Ringwald             switch (btstack_crypto_ccm->state){
611d1a1f6a4SMatthias Ringwald                 case CCM_CALCULATE_X1:
612d1a1f6a4SMatthias Ringwald                     btstack_crypto_ccm_calc_x1(btstack_crypto_ccm);
613d1a1f6a4SMatthias Ringwald                     break;
614d1a1f6a4SMatthias Ringwald                 case CCM_CALCULATE_S0:
615d1a1f6a4SMatthias Ringwald                     btstack_crypto_ccm_calc_s0(btstack_crypto_ccm);
616d1a1f6a4SMatthias Ringwald                     break;
617d1a1f6a4SMatthias Ringwald                 case CCM_CALCULATE_SN:
618d1a1f6a4SMatthias Ringwald                     btstack_crypto_ccm_calc_sn(btstack_crypto_ccm);
619d1a1f6a4SMatthias Ringwald                     break;
620d1a1f6a4SMatthias Ringwald                 case CCM_CALCULATE_XN:
621d1a1f6a4SMatthias Ringwald                     btstack_crypto_ccm_calc_xn(btstack_crypto_ccm, btstack_crypto->operation == BTSTACK_CRYPTO_CCM_ENCRYPT_BLOCK ? btstack_crypto_ccm->input : btstack_crypto_ccm->output);
622d1a1f6a4SMatthias Ringwald                     break;
623d1a1f6a4SMatthias Ringwald                 default:
624d1a1f6a4SMatthias Ringwald                     break;
625d1a1f6a4SMatthias Ringwald             }
626d1a1f6a4SMatthias Ringwald #endif
627d1a1f6a4SMatthias Ringwald             break;
628d1a1f6a4SMatthias Ringwald 
629d1a1f6a4SMatthias Ringwald #ifdef ENABLE_ECC_P256
630d1a1f6a4SMatthias Ringwald         case BTSTACK_CRYPTO_ECC_P256_GENERATE_KEY:
631d1a1f6a4SMatthias Ringwald             btstack_crypto_ec_p192 = (btstack_crypto_ecc_p256_t *) btstack_crypto;
632d1a1f6a4SMatthias Ringwald             switch (btstack_crypto_ecc_p256_key_generation_state){
633d1a1f6a4SMatthias Ringwald                 case ECC_P256_KEY_GENERATION_DONE:
634d1a1f6a4SMatthias Ringwald                     // done
635d1a1f6a4SMatthias Ringwald                     btstack_crypto_log_ec_publickey(btstack_crypto_ecc_p256_public_key);
636d1a1f6a4SMatthias Ringwald                     memcpy(btstack_crypto_ec_p192->public_key, btstack_crypto_ecc_p256_public_key, 64);
637d1a1f6a4SMatthias Ringwald                     btstack_linked_list_pop(&btstack_crypto_operations);
638d1a1f6a4SMatthias Ringwald                     (*btstack_crypto_ec_p192->btstack_crypto.context_callback.callback)(btstack_crypto_ec_p192->btstack_crypto.context_callback.context);
639d1a1f6a4SMatthias Ringwald                     break;
640d1a1f6a4SMatthias Ringwald                 case ECC_P256_KEY_GENERATION_IDLE:
641d1a1f6a4SMatthias Ringwald #ifdef USE_SOFTWARE_ECC_P256_IMPLEMENTATION
642d1a1f6a4SMatthias Ringwald                     log_info("start ecc random");
643d1a1f6a4SMatthias Ringwald                     btstack_crypto_ecc_p256_key_generation_state = ECC_P256_KEY_GENERATION_GENERATING_RANDOM;
644d1a1f6a4SMatthias Ringwald                     btstack_crypto_ecc_p256_random_offset = 0;
645d1a1f6a4SMatthias Ringwald                     btstack_crypto_wait_for_hci_result = 1;
646d1a1f6a4SMatthias Ringwald                     hci_send_cmd(&hci_le_rand);
647d1a1f6a4SMatthias Ringwald #else
648d1a1f6a4SMatthias Ringwald                     btstack_crypto_ecc_p256_key_generation_state = ECC_P256_KEY_GENERATION_W4_KEY;
649d1a1f6a4SMatthias Ringwald                     btstack_crypto_wait_for_hci_result = 1;
650d1a1f6a4SMatthias Ringwald                     hci_send_cmd(&hci_le_read_local_p256_public_key);
651d1a1f6a4SMatthias Ringwald #endif
652d1a1f6a4SMatthias Ringwald                     break;
653d1a1f6a4SMatthias Ringwald #ifdef USE_SOFTWARE_ECC_P256_IMPLEMENTATION
654d1a1f6a4SMatthias Ringwald                 case ECC_P256_KEY_GENERATION_GENERATING_RANDOM:
655d1a1f6a4SMatthias Ringwald                     log_info("more ecc random");
656d1a1f6a4SMatthias Ringwald                     btstack_crypto_wait_for_hci_result = 1;
657d1a1f6a4SMatthias Ringwald                     hci_send_cmd(&hci_le_rand);
658d1a1f6a4SMatthias Ringwald                     break;
659d1a1f6a4SMatthias Ringwald #endif
660d1a1f6a4SMatthias Ringwald                 default:
661d1a1f6a4SMatthias Ringwald                     break;
662d1a1f6a4SMatthias Ringwald             }
663d1a1f6a4SMatthias Ringwald             break;
664d1a1f6a4SMatthias Ringwald         case BTSTACK_CRYPTO_ECC_P256_CALCULATE_DHKEY:
665d1a1f6a4SMatthias Ringwald             btstack_crypto_ec_p192 = (btstack_crypto_ecc_p256_t *) btstack_crypto;
666d1a1f6a4SMatthias Ringwald #ifdef USE_SOFTWARE_ECC_P256_IMPLEMENTATION
667d1a1f6a4SMatthias Ringwald             btstack_crypto_ecc_p256_calculate_dhkey_software(btstack_crypto_ec_p192);
668d1a1f6a4SMatthias Ringwald             // done
669d1a1f6a4SMatthias Ringwald             btstack_linked_list_pop(&btstack_crypto_operations);
670d1a1f6a4SMatthias Ringwald             (*btstack_crypto_ec_p192->btstack_crypto.context_callback.callback)(btstack_crypto_ec_p192->btstack_crypto.context_callback.context);
671d1a1f6a4SMatthias Ringwald #else
672d1a1f6a4SMatthias Ringwald             btstack_crypto_wait_for_hci_result = 1;
673d1a1f6a4SMatthias Ringwald             hci_send_cmd(&hci_le_generate_dhkey, &btstack_crypto_ec_p192->public_key[0], &btstack_crypto_ec_p192->public_key[32]);
674d1a1f6a4SMatthias Ringwald #endif
675d1a1f6a4SMatthias Ringwald             break;
6764395a000SMatthias Ringwald 
6774395a000SMatthias Ringwald #endif /* ENABLE_ECC_P256 */
6784395a000SMatthias Ringwald 
679d1a1f6a4SMatthias Ringwald         default:
680d1a1f6a4SMatthias Ringwald             break;
681d1a1f6a4SMatthias Ringwald     }
682d1a1f6a4SMatthias Ringwald }
683d1a1f6a4SMatthias Ringwald 
684d1a1f6a4SMatthias Ringwald static void btstack_crypto_handle_random_data(const uint8_t * data, uint16_t len){
685d1a1f6a4SMatthias Ringwald     btstack_crypto_random_t * btstack_crypto_random;
686d1a1f6a4SMatthias Ringwald     btstack_crypto_t * btstack_crypto = (btstack_crypto_t*) btstack_linked_list_get_first_item(&btstack_crypto_operations);
687d1a1f6a4SMatthias Ringwald     uint16_t bytes_to_copy;
688d1a1f6a4SMatthias Ringwald 	if (!btstack_crypto) return;
689d1a1f6a4SMatthias Ringwald     switch (btstack_crypto->operation){
690d1a1f6a4SMatthias Ringwald         case BTSTACK_CRYPTO_RANDOM:
691d1a1f6a4SMatthias Ringwald             btstack_crypto_random = (btstack_crypto_random_t*) btstack_crypto;
692d1a1f6a4SMatthias Ringwald             bytes_to_copy = btstack_min(btstack_crypto_random->size, len);
693d1a1f6a4SMatthias Ringwald             memcpy(btstack_crypto_random->buffer, data, bytes_to_copy);
694d1a1f6a4SMatthias Ringwald             btstack_crypto_random->buffer += bytes_to_copy;
695d1a1f6a4SMatthias Ringwald             btstack_crypto_random->size   -= bytes_to_copy;
696d1a1f6a4SMatthias Ringwald             // data processed, more?
697d1a1f6a4SMatthias Ringwald             if (!btstack_crypto_random->size) {
698d1a1f6a4SMatthias Ringwald                 // done
699d1a1f6a4SMatthias Ringwald                 btstack_linked_list_pop(&btstack_crypto_operations);
700d1a1f6a4SMatthias Ringwald                 (*btstack_crypto_random->btstack_crypto.context_callback.callback)(btstack_crypto_random->btstack_crypto.context_callback.context);
701d1a1f6a4SMatthias Ringwald             }
702d1a1f6a4SMatthias Ringwald             break;
703d1a1f6a4SMatthias Ringwald #ifdef ENABLE_ECC_P256
704d1a1f6a4SMatthias Ringwald         case BTSTACK_CRYPTO_ECC_P256_GENERATE_KEY:
705d1a1f6a4SMatthias Ringwald             memcpy(&btstack_crypto_ecc_p256_random[btstack_crypto_ecc_p256_random_len], data, 8);
706d1a1f6a4SMatthias Ringwald             btstack_crypto_ecc_p256_random_len += 8;
707d1a1f6a4SMatthias Ringwald             if (btstack_crypto_ecc_p256_random_len >= 64) {
708d1a1f6a4SMatthias Ringwald                 btstack_crypto_ecc_p256_key_generation_state = ECC_P256_KEY_GENERATION_ACTIVE;
709d1a1f6a4SMatthias Ringwald                 btstack_crypto_ecc_p256_generate_key_software();
710d1a1f6a4SMatthias Ringwald                 btstack_crypto_ecc_p256_key_generation_state = ECC_P256_KEY_GENERATION_DONE;
711d1a1f6a4SMatthias Ringwald             }
712d1a1f6a4SMatthias Ringwald             break;
713d1a1f6a4SMatthias Ringwald #endif
714d1a1f6a4SMatthias Ringwald         default:
715d1a1f6a4SMatthias Ringwald             break;
716d1a1f6a4SMatthias Ringwald     }
717d1a1f6a4SMatthias Ringwald 	// more work?
718d1a1f6a4SMatthias Ringwald 	btstack_crypto_run();
719d1a1f6a4SMatthias Ringwald }
720d1a1f6a4SMatthias Ringwald 
721d1a1f6a4SMatthias Ringwald static void btstack_crypto_handle_encryption_result(const uint8_t * data){
722d1a1f6a4SMatthias Ringwald 	btstack_crypto_aes128_t      * btstack_crypto_aes128;
723d1a1f6a4SMatthias Ringwald 	btstack_crypto_aes128_cmac_t * btstack_crypto_cmac;
724d1a1f6a4SMatthias Ringwald     btstack_crypto_ccm_t         * btstack_crypto_ccm;
725d1a1f6a4SMatthias Ringwald 	uint8_t result[16];
726d1a1f6a4SMatthias Ringwald 
727d1a1f6a4SMatthias Ringwald     btstack_crypto_t * btstack_crypto = (btstack_crypto_t*) btstack_linked_list_get_first_item(&btstack_crypto_operations);
728d1a1f6a4SMatthias Ringwald 	if (!btstack_crypto) return;
729d1a1f6a4SMatthias Ringwald 	switch (btstack_crypto->operation){
730d1a1f6a4SMatthias Ringwald 		case BTSTACK_CRYPTO_AES128:
731d1a1f6a4SMatthias Ringwald 			btstack_crypto_aes128 = (btstack_crypto_aes128_t*) btstack_linked_list_get_first_item(&btstack_crypto_operations);
732d1a1f6a4SMatthias Ringwald 		    reverse_128(data, btstack_crypto_aes128->ciphertext);
733d1a1f6a4SMatthias Ringwald             btstack_crypto_done(btstack_crypto);
734d1a1f6a4SMatthias Ringwald 			break;
735d1a1f6a4SMatthias Ringwald 		case BTSTACK_CRYPTO_CMAC_GENERATOR:
736d1a1f6a4SMatthias Ringwald 		case BTSTACK_CRYPTO_CMAC_MESSAGE:
737d1a1f6a4SMatthias Ringwald 			btstack_crypto_cmac = (btstack_crypto_aes128_cmac_t*) btstack_linked_list_get_first_item(&btstack_crypto_operations);
738d1a1f6a4SMatthias Ringwald 		    reverse_128(data, result);
739d1a1f6a4SMatthias Ringwald 		    btstack_crypto_cmac_handle_encryption_result(btstack_crypto_cmac, result);
740d1a1f6a4SMatthias Ringwald 			break;
741d1a1f6a4SMatthias Ringwald         case BTSTACK_CRYPTO_CCM_ENCRYPT_BLOCK:
742d1a1f6a4SMatthias Ringwald             btstack_crypto_ccm = (btstack_crypto_ccm_t*) btstack_linked_list_get_first_item(&btstack_crypto_operations);
743d1a1f6a4SMatthias Ringwald             switch (btstack_crypto_ccm->state){
744d1a1f6a4SMatthias Ringwald                 case CCM_W4_X1:
745d1a1f6a4SMatthias Ringwald                     reverse_128(data, btstack_crypto_ccm->x_i);
746d1a1f6a4SMatthias Ringwald                     btstack_crypto_ccm->state = CCM_CALCULATE_XN;
747d1a1f6a4SMatthias Ringwald                     break;
748d1a1f6a4SMatthias Ringwald                 case CCM_W4_XN:
749d1a1f6a4SMatthias Ringwald                     reverse_128(data, btstack_crypto_ccm->x_i);
750d1a1f6a4SMatthias Ringwald                     btstack_crypto_ccm->state = CCM_CALCULATE_SN;
751d1a1f6a4SMatthias Ringwald                     break;
752d1a1f6a4SMatthias Ringwald                 case CCM_W4_S0:
753d1a1f6a4SMatthias Ringwald                     btstack_crypto_ccm_handle_s0(btstack_crypto_ccm, data);
754d1a1f6a4SMatthias Ringwald                     break;
755d1a1f6a4SMatthias Ringwald                 case CCM_W4_SN:
756d1a1f6a4SMatthias Ringwald                     btstack_crypto_ccm_handle_sn(btstack_crypto_ccm, data);
757d1a1f6a4SMatthias Ringwald                     btstack_crypto_ccm_next_block(btstack_crypto_ccm, CCM_CALCULATE_XN);
758d1a1f6a4SMatthias Ringwald                     break;
759d1a1f6a4SMatthias Ringwald                 default:
760d1a1f6a4SMatthias Ringwald                     break;
761d1a1f6a4SMatthias Ringwald             }
762d1a1f6a4SMatthias Ringwald             break;
763d1a1f6a4SMatthias Ringwald         case BTSTACK_CRYPTO_CCM_DECRYPT_BLOCK:
764d1a1f6a4SMatthias Ringwald             btstack_crypto_ccm = (btstack_crypto_ccm_t*) btstack_linked_list_get_first_item(&btstack_crypto_operations);
765d1a1f6a4SMatthias Ringwald             switch (btstack_crypto_ccm->state){
766d1a1f6a4SMatthias Ringwald                 case CCM_W4_X1:
767d1a1f6a4SMatthias Ringwald                     reverse_128(data, btstack_crypto_ccm->x_i);
768d1a1f6a4SMatthias Ringwald                     btstack_crypto_ccm->state = CCM_CALCULATE_SN;
769d1a1f6a4SMatthias Ringwald                     break;
770d1a1f6a4SMatthias Ringwald                 case CCM_W4_XN:
771d1a1f6a4SMatthias Ringwald                     reverse_128(data, btstack_crypto_ccm->x_i);
772d1a1f6a4SMatthias Ringwald                     btstack_crypto_ccm_next_block(btstack_crypto_ccm, CCM_CALCULATE_SN);
773d1a1f6a4SMatthias Ringwald                     break;
774d1a1f6a4SMatthias Ringwald                 case CCM_W4_S0:
775d1a1f6a4SMatthias Ringwald                     btstack_crypto_ccm_handle_s0(btstack_crypto_ccm, data);
776d1a1f6a4SMatthias Ringwald                     break;
777d1a1f6a4SMatthias Ringwald                 case CCM_W4_SN:
778d1a1f6a4SMatthias Ringwald                     btstack_crypto_ccm_handle_sn(btstack_crypto_ccm, data);
779d1a1f6a4SMatthias Ringwald                     btstack_crypto_ccm->state = CCM_CALCULATE_XN;
780d1a1f6a4SMatthias Ringwald                     break;
781d1a1f6a4SMatthias Ringwald                 default:
782d1a1f6a4SMatthias Ringwald                     break;
783d1a1f6a4SMatthias Ringwald             }
784d1a1f6a4SMatthias Ringwald             break;
785d1a1f6a4SMatthias Ringwald 		default:
786d1a1f6a4SMatthias Ringwald 			break;
787d1a1f6a4SMatthias Ringwald 	}
788d1a1f6a4SMatthias Ringwald }
789d1a1f6a4SMatthias Ringwald 
790d1a1f6a4SMatthias Ringwald static void btstack_crypto_event_handler(uint8_t packet_type, uint16_t cid, uint8_t *packet, uint16_t size){
791d1a1f6a4SMatthias Ringwald     UNUSED(cid);         // ok: there is no channel
792d1a1f6a4SMatthias Ringwald     UNUSED(size);        // ok: fixed format events read from HCI buffer
793d1a1f6a4SMatthias Ringwald 
794d1a1f6a4SMatthias Ringwald #ifdef ENABLE_ECC_P256
795d1a1f6a4SMatthias Ringwald #ifndef USE_SOFTWARE_ECC_P256_IMPLEMENTATION
796d1a1f6a4SMatthias Ringwald     btstack_crypto_ecc_p256_t * btstack_crypto_ec_p192;
797d1a1f6a4SMatthias Ringwald #endif
798d1a1f6a4SMatthias Ringwald #endif
799d1a1f6a4SMatthias Ringwald 
800d1a1f6a4SMatthias Ringwald     if (packet_type != HCI_EVENT_PACKET)  return;
801d1a1f6a4SMatthias Ringwald 
802d1a1f6a4SMatthias Ringwald     switch (hci_event_packet_get_type(packet)){
803d1a1f6a4SMatthias Ringwald         case HCI_EVENT_COMMAND_COMPLETE:
804d1a1f6a4SMatthias Ringwald     	    if (HCI_EVENT_IS_COMMAND_COMPLETE(packet, hci_le_encrypt)){
805d1a1f6a4SMatthias Ringwald                 if (hci_get_state() != HCI_STATE_WORKING) return;
806d1a1f6a4SMatthias Ringwald                 if (!btstack_crypto_wait_for_hci_result) return;
807d1a1f6a4SMatthias Ringwald                 btstack_crypto_wait_for_hci_result = 0;
808d1a1f6a4SMatthias Ringwald     	        btstack_crypto_handle_encryption_result(&packet[6]);
809d1a1f6a4SMatthias Ringwald     	    }
810d1a1f6a4SMatthias Ringwald     	    if (HCI_EVENT_IS_COMMAND_COMPLETE(packet, hci_le_rand)){
811d1a1f6a4SMatthias Ringwald                 if (hci_get_state() != HCI_STATE_WORKING) return;
812d1a1f6a4SMatthias Ringwald                 if (!btstack_crypto_wait_for_hci_result) return;
813d1a1f6a4SMatthias Ringwald                 btstack_crypto_wait_for_hci_result = 0;
814d1a1f6a4SMatthias Ringwald     	        btstack_crypto_handle_random_data(&packet[6], 8);
815d1a1f6a4SMatthias Ringwald     	    }
816d1a1f6a4SMatthias Ringwald             if (HCI_EVENT_IS_COMMAND_COMPLETE(packet, hci_read_local_supported_commands)){
817d1a1f6a4SMatthias Ringwald                 int ecdh_operations_supported = (packet[OFFSET_OF_DATA_IN_COMMAND_COMPLETE+1+34] & 0x06) == 0x06;
818d1a1f6a4SMatthias Ringwald                 log_info("controller supports ECDH operation: %u", ecdh_operations_supported);
819d1a1f6a4SMatthias Ringwald #ifdef ENABLE_ECC_P256
820d1a1f6a4SMatthias Ringwald #ifndef USE_SOFTWARE_ECC_P256_IMPLEMENTATION
821d1a1f6a4SMatthias Ringwald                 if (!ecdh_operations_supported){
822d1a1f6a4SMatthias Ringwald                     // mbedTLS can also be used if already available (and malloc is supported)
823ddd7eb8cSMatthias Ringwald                     log_error("ECC-P256 support enabled, but HCI Controller doesn't support it. Please add ENABLE_MICRO_ECC_FOR_LE_SECURE_CONNECTIONS to btstack_config.h");
824d1a1f6a4SMatthias Ringwald                 }
825d1a1f6a4SMatthias Ringwald #endif
826d1a1f6a4SMatthias Ringwald #endif
827d1a1f6a4SMatthias Ringwald             }
828d1a1f6a4SMatthias Ringwald             break;
829d1a1f6a4SMatthias Ringwald 
830d1a1f6a4SMatthias Ringwald #ifdef ENABLE_ECC_P256
831d1a1f6a4SMatthias Ringwald #ifndef USE_SOFTWARE_ECC_P256_IMPLEMENTATION
832d1a1f6a4SMatthias Ringwald         case HCI_EVENT_LE_META:
833d1a1f6a4SMatthias Ringwald             btstack_crypto_ec_p192 = (btstack_crypto_ecc_p256_t*) btstack_linked_list_get_first_item(&btstack_crypto_operations);
834d1a1f6a4SMatthias Ringwald             if (!btstack_crypto_ec_p192) break;
835d1a1f6a4SMatthias Ringwald             switch (hci_event_le_meta_get_subevent_code(packet)){
836d1a1f6a4SMatthias Ringwald                 case HCI_SUBEVENT_LE_READ_LOCAL_P256_PUBLIC_KEY_COMPLETE:
837d1a1f6a4SMatthias Ringwald                     if (btstack_crypto_ec_p192->btstack_crypto.operation != BTSTACK_CRYPTO_ECC_P256_GENERATE_KEY) break;
838d1a1f6a4SMatthias Ringwald                     if (!btstack_crypto_wait_for_hci_result) return;
839d1a1f6a4SMatthias Ringwald                     btstack_crypto_wait_for_hci_result = 0;
840d1a1f6a4SMatthias Ringwald                     if (hci_subevent_le_read_local_p256_public_key_complete_get_status(packet)){
841d1a1f6a4SMatthias Ringwald                         log_error("Read Local P256 Public Key failed");
842d1a1f6a4SMatthias Ringwald                     }
843d1a1f6a4SMatthias Ringwald                     hci_subevent_le_read_local_p256_public_key_complete_get_dhkey_x(packet, &btstack_crypto_ecc_p256_public_key[0]);
844d1a1f6a4SMatthias Ringwald                     hci_subevent_le_read_local_p256_public_key_complete_get_dhkey_y(packet, &btstack_crypto_ecc_p256_public_key[32]);
845d1a1f6a4SMatthias Ringwald                     btstack_crypto_ecc_p256_key_generation_state = ECC_P256_KEY_GENERATION_DONE;
846d1a1f6a4SMatthias Ringwald                     break;
847d1a1f6a4SMatthias Ringwald                 case HCI_SUBEVENT_LE_GENERATE_DHKEY_COMPLETE:
848d1a1f6a4SMatthias Ringwald                     if (btstack_crypto_ec_p192->btstack_crypto.operation != BTSTACK_CRYPTO_ECC_P256_CALCULATE_DHKEY) break;
849d1a1f6a4SMatthias Ringwald                     if (!btstack_crypto_wait_for_hci_result) return;
850d1a1f6a4SMatthias Ringwald                     btstack_crypto_wait_for_hci_result = 0;
851d1a1f6a4SMatthias Ringwald                     if (hci_subevent_le_generate_dhkey_complete_get_status(packet)){
852d1a1f6a4SMatthias Ringwald                         log_error("Generate DHKEY failed -> abort");
853d1a1f6a4SMatthias Ringwald                     }
854d1a1f6a4SMatthias Ringwald                     hci_subevent_le_generate_dhkey_complete_get_dhkey(packet, btstack_crypto_ec_p192->dhkey);
855d1a1f6a4SMatthias Ringwald                     // done
856d1a1f6a4SMatthias Ringwald                     btstack_linked_list_pop(&btstack_crypto_operations);
857d1a1f6a4SMatthias Ringwald                     (*btstack_crypto_ec_p192->btstack_crypto.context_callback.callback)(btstack_crypto_ec_p192->btstack_crypto.context_callback.context);
858d1a1f6a4SMatthias Ringwald                     break;
859d1a1f6a4SMatthias Ringwald                 default:
860d1a1f6a4SMatthias Ringwald                     break;
861d1a1f6a4SMatthias Ringwald             }
862d1a1f6a4SMatthias Ringwald             break;
863d1a1f6a4SMatthias Ringwald #endif
864d1a1f6a4SMatthias Ringwald #endif
865d1a1f6a4SMatthias Ringwald         default:
866d1a1f6a4SMatthias Ringwald             break;
867d1a1f6a4SMatthias Ringwald     }
868d1a1f6a4SMatthias Ringwald 
869d1a1f6a4SMatthias Ringwald     // try processing
870d1a1f6a4SMatthias Ringwald 	btstack_crypto_run();
871d1a1f6a4SMatthias Ringwald }
872d1a1f6a4SMatthias Ringwald 
873d1a1f6a4SMatthias Ringwald void btstack_crypto_init(void){
874d1a1f6a4SMatthias Ringwald 	if (btstack_crypto_initialized) return;
875d1a1f6a4SMatthias Ringwald 	btstack_crypto_initialized = 1;
8760b672f43SMatthias Ringwald 
877d1a1f6a4SMatthias Ringwald 	// register with HCI
878d1a1f6a4SMatthias Ringwald     hci_event_callback_registration.callback = &btstack_crypto_event_handler;
879d1a1f6a4SMatthias Ringwald     hci_add_event_handler(&hci_event_callback_registration);
8800b672f43SMatthias Ringwald 
8810b672f43SMatthias Ringwald #ifdef USE_MBEDTLS_ECC_P256
8820b672f43SMatthias Ringwald 	mbedtls_ecp_group_init(&mbedtls_ec_group);
8830b672f43SMatthias Ringwald 	mbedtls_ecp_group_load(&mbedtls_ec_group, MBEDTLS_ECP_DP_SECP256R1);
8840b672f43SMatthias Ringwald #endif
885d1a1f6a4SMatthias Ringwald }
886d1a1f6a4SMatthias Ringwald 
887d1a1f6a4SMatthias Ringwald void btstack_crypto_random_generate(btstack_crypto_random_t * request, uint8_t * buffer, uint16_t size, void (* callback)(void * arg), void * callback_arg){
888d1a1f6a4SMatthias Ringwald 	request->btstack_crypto.context_callback.callback  = callback;
889d1a1f6a4SMatthias Ringwald 	request->btstack_crypto.context_callback.context   = callback_arg;
890d1a1f6a4SMatthias Ringwald 	request->btstack_crypto.operation         		   = BTSTACK_CRYPTO_RANDOM;
891d1a1f6a4SMatthias Ringwald 	request->buffer = buffer;
892d1a1f6a4SMatthias Ringwald 	request->size   = size;
893d1a1f6a4SMatthias Ringwald 	btstack_linked_list_add_tail(&btstack_crypto_operations, (btstack_linked_item_t*) request);
894d1a1f6a4SMatthias Ringwald 	btstack_crypto_run();
895d1a1f6a4SMatthias Ringwald }
896d1a1f6a4SMatthias Ringwald 
897d1a1f6a4SMatthias Ringwald void btstack_crypto_aes128_encrypt(btstack_crypto_aes128_t * request, const uint8_t * key, const uint8_t * plaintext, uint8_t * ciphertext, void (* callback)(void * arg), void * callback_arg){
898d1a1f6a4SMatthias Ringwald 	request->btstack_crypto.context_callback.callback  = callback;
899d1a1f6a4SMatthias Ringwald 	request->btstack_crypto.context_callback.context   = callback_arg;
900d1a1f6a4SMatthias Ringwald 	request->btstack_crypto.operation         		   = BTSTACK_CRYPTO_AES128;
901d1a1f6a4SMatthias Ringwald 	request->key 									   = key;
902d1a1f6a4SMatthias Ringwald 	request->plaintext      					       = plaintext;
903d1a1f6a4SMatthias Ringwald 	request->ciphertext 							   = ciphertext;
904d1a1f6a4SMatthias Ringwald 	btstack_linked_list_add_tail(&btstack_crypto_operations, (btstack_linked_item_t*) request);
905d1a1f6a4SMatthias Ringwald 	btstack_crypto_run();
906d1a1f6a4SMatthias Ringwald }
907d1a1f6a4SMatthias Ringwald 
908d1a1f6a4SMatthias Ringwald void btstack_crypto_aes128_cmac_generator(btstack_crypto_aes128_cmac_t * request, const uint8_t * key, uint16_t size, uint8_t (*get_byte_callback)(uint16_t pos), uint8_t * hash, void (* callback)(void * arg), void * callback_arg){
909d1a1f6a4SMatthias Ringwald 	request->btstack_crypto.context_callback.callback  = callback;
910d1a1f6a4SMatthias Ringwald 	request->btstack_crypto.context_callback.context   = callback_arg;
911d1a1f6a4SMatthias Ringwald 	request->btstack_crypto.operation         		   = BTSTACK_CRYPTO_CMAC_GENERATOR;
912d1a1f6a4SMatthias Ringwald 	request->key 									   = key;
913d1a1f6a4SMatthias Ringwald 	request->size 									   = size;
91459ab1655SMatthias Ringwald 	request->data.get_byte_callback					   = get_byte_callback;
915d1a1f6a4SMatthias Ringwald 	request->hash 									   = hash;
916d1a1f6a4SMatthias Ringwald 	btstack_linked_list_add_tail(&btstack_crypto_operations, (btstack_linked_item_t*) request);
917d1a1f6a4SMatthias Ringwald 	btstack_crypto_run();
918d1a1f6a4SMatthias Ringwald }
919d1a1f6a4SMatthias Ringwald 
920d1a1f6a4SMatthias Ringwald void btstack_crypto_aes128_cmac_message(btstack_crypto_aes128_cmac_t * request, const uint8_t * key, uint16_t size, const uint8_t * message, uint8_t * hash, void (* callback)(void * arg), void * callback_arg){
921d1a1f6a4SMatthias Ringwald 	request->btstack_crypto.context_callback.callback  = callback;
922d1a1f6a4SMatthias Ringwald 	request->btstack_crypto.context_callback.context   = callback_arg;
923d1a1f6a4SMatthias Ringwald 	request->btstack_crypto.operation         		   = BTSTACK_CRYPTO_CMAC_MESSAGE;
924d1a1f6a4SMatthias Ringwald 	request->key 									   = key;
925d1a1f6a4SMatthias Ringwald 	request->size 									   = size;
92659ab1655SMatthias Ringwald 	request->data.message      						   = message;
927d1a1f6a4SMatthias Ringwald 	request->hash 									   = hash;
928d1a1f6a4SMatthias Ringwald 	btstack_linked_list_add_tail(&btstack_crypto_operations, (btstack_linked_item_t*) request);
929d1a1f6a4SMatthias Ringwald 	btstack_crypto_run();
930d1a1f6a4SMatthias Ringwald }
931d1a1f6a4SMatthias Ringwald 
932d1a1f6a4SMatthias Ringwald void btstack_crypto_aes128_cmac_zero(btstack_crypto_aes128_cmac_t * request, uint16_t len, const uint8_t * message,  uint8_t * hash, void (* callback)(void * arg), void * callback_arg){
933d1a1f6a4SMatthias Ringwald     request->btstack_crypto.context_callback.callback  = callback;
934d1a1f6a4SMatthias Ringwald     request->btstack_crypto.context_callback.context   = callback_arg;
935d1a1f6a4SMatthias Ringwald     request->btstack_crypto.operation                  = BTSTACK_CRYPTO_CMAC_MESSAGE;
936d1a1f6a4SMatthias Ringwald     request->key                                       = zero;
937d1a1f6a4SMatthias Ringwald     request->size                                      = len;
93859ab1655SMatthias Ringwald     request->data.message                              = message;
939d1a1f6a4SMatthias Ringwald     request->hash                                      = hash;
940d1a1f6a4SMatthias Ringwald     btstack_linked_list_add_tail(&btstack_crypto_operations, (btstack_linked_item_t*) request);
941d1a1f6a4SMatthias Ringwald     btstack_crypto_run();
942d1a1f6a4SMatthias Ringwald }
943d1a1f6a4SMatthias Ringwald 
944d1a1f6a4SMatthias Ringwald #ifdef ENABLE_ECC_P256
945d1a1f6a4SMatthias Ringwald void btstack_crypto_ecc_p256_generate_key(btstack_crypto_ecc_p256_t * request, uint8_t * public_key, void (* callback)(void * arg), void * callback_arg){
946e0449ce9SMatthias Ringwald     // reset key generation
947e0449ce9SMatthias Ringwald     if (btstack_crypto_ecc_p256_key_generation_state == ECC_P256_KEY_GENERATION_DONE){
948e0449ce9SMatthias Ringwald         btstack_crypto_ecc_p256_random_len = 0;
949e0449ce9SMatthias Ringwald         btstack_crypto_ecc_p256_key_generation_state = ECC_P256_KEY_GENERATION_IDLE;
950e0449ce9SMatthias Ringwald     }
951d1a1f6a4SMatthias Ringwald     request->btstack_crypto.context_callback.callback  = callback;
952d1a1f6a4SMatthias Ringwald     request->btstack_crypto.context_callback.context   = callback_arg;
953d1a1f6a4SMatthias Ringwald     request->btstack_crypto.operation                  = BTSTACK_CRYPTO_ECC_P256_GENERATE_KEY;
954d1a1f6a4SMatthias Ringwald     request->public_key                                = public_key;
955d1a1f6a4SMatthias Ringwald     btstack_linked_list_add_tail(&btstack_crypto_operations, (btstack_linked_item_t*) request);
956d1a1f6a4SMatthias Ringwald     btstack_crypto_run();
957d1a1f6a4SMatthias Ringwald }
958d1a1f6a4SMatthias Ringwald 
959d1a1f6a4SMatthias Ringwald void btstack_crypto_ecc_p256_calculate_dhkey(btstack_crypto_ecc_p256_t * request, const uint8_t * public_key, uint8_t * dhkey, void (* callback)(void * arg), void * callback_arg){
960d1a1f6a4SMatthias Ringwald     request->btstack_crypto.context_callback.callback  = callback;
961d1a1f6a4SMatthias Ringwald     request->btstack_crypto.context_callback.context   = callback_arg;
962d1a1f6a4SMatthias Ringwald     request->btstack_crypto.operation                  = BTSTACK_CRYPTO_ECC_P256_CALCULATE_DHKEY;
963d1a1f6a4SMatthias Ringwald     request->public_key                                = (uint8_t *) public_key;
964d1a1f6a4SMatthias Ringwald     request->dhkey                                     = dhkey;
965d1a1f6a4SMatthias Ringwald     btstack_linked_list_add_tail(&btstack_crypto_operations, (btstack_linked_item_t*) request);
966d1a1f6a4SMatthias Ringwald     btstack_crypto_run();
967d1a1f6a4SMatthias Ringwald }
968d1a1f6a4SMatthias Ringwald 
969d1a1f6a4SMatthias Ringwald int btstack_crypto_ecc_p256_validate_public_key(const uint8_t * public_key){
970d1a1f6a4SMatthias Ringwald 
971d1a1f6a4SMatthias Ringwald     // validate public key using micro-ecc
972d1a1f6a4SMatthias Ringwald     int err = 0;
973d1a1f6a4SMatthias Ringwald 
974d1a1f6a4SMatthias Ringwald #ifdef USE_MICRO_ECC_P256
975d1a1f6a4SMatthias Ringwald #if uECC_SUPPORTS_secp256r1
976d1a1f6a4SMatthias Ringwald     // standard version
977d1a1f6a4SMatthias Ringwald     err = uECC_valid_public_key(public_key, uECC_secp256r1()) == 0;
978d1a1f6a4SMatthias Ringwald #else
979d1a1f6a4SMatthias Ringwald     // static version
980d1a1f6a4SMatthias Ringwald     err = uECC_valid_public_key(public_key) == 0;
981d1a1f6a4SMatthias Ringwald #endif
982d1a1f6a4SMatthias Ringwald #endif
983d1a1f6a4SMatthias Ringwald 
984d1a1f6a4SMatthias Ringwald #ifdef USE_MBEDTLS_ECC_P256
985d1a1f6a4SMatthias Ringwald     mbedtls_ecp_point Q;
986d1a1f6a4SMatthias Ringwald     mbedtls_ecp_point_init( &Q );
987d1a1f6a4SMatthias Ringwald     mbedtls_mpi_read_binary(&Q.X, &public_key[0], 32);
988d1a1f6a4SMatthias Ringwald     mbedtls_mpi_read_binary(&Q.Y, &public_key[32], 32);
989d1a1f6a4SMatthias Ringwald     mbedtls_mpi_lset(&Q.Z, 1);
990d1a1f6a4SMatthias Ringwald     err = mbedtls_ecp_check_pubkey(&mbedtls_ec_group, &Q);
991d1a1f6a4SMatthias Ringwald     mbedtls_ecp_point_free( & Q);
992d1a1f6a4SMatthias Ringwald #endif
993d1a1f6a4SMatthias Ringwald 
994d1a1f6a4SMatthias Ringwald     if (err){
995d1a1f6a4SMatthias Ringwald         log_error("public key invalid %x", err);
996d1a1f6a4SMatthias Ringwald     }
997d1a1f6a4SMatthias Ringwald     return  err;
998d1a1f6a4SMatthias Ringwald }
999d1a1f6a4SMatthias Ringwald #endif
1000d1a1f6a4SMatthias Ringwald 
1001*6015e1edSMatthias Ringwald void btstack_crypo_ccm_init(btstack_crypto_ccm_t * request, const uint8_t * key, const uint8_t * nonce, uint16_t message_len, uint8_t auth_len){
1002d1a1f6a4SMatthias Ringwald     request->key         = key;
1003d1a1f6a4SMatthias Ringwald     request->nonce       = nonce;
1004d1a1f6a4SMatthias Ringwald     request->message_len = message_len;
1005*6015e1edSMatthias Ringwald     request->auth_len    = auth_len;
1006d1a1f6a4SMatthias Ringwald     request->counter     = 1;
1007d1a1f6a4SMatthias Ringwald }
1008d1a1f6a4SMatthias Ringwald 
1009d1a1f6a4SMatthias Ringwald void btstack_crypo_ccm_get_authentication_value(btstack_crypto_ccm_t * request, uint8_t * authentication_value){
1010d1a1f6a4SMatthias Ringwald     memcpy(authentication_value, request->x_i, 8);
1011d1a1f6a4SMatthias Ringwald }
1012d1a1f6a4SMatthias Ringwald 
1013d1a1f6a4SMatthias Ringwald void btstack_crypto_ccm_encrypt_block(btstack_crypto_ccm_t * request, uint16_t block_len, const uint8_t * plaintext, uint8_t * ciphertext, void (* callback)(void * arg), void * callback_arg){
1014d1a1f6a4SMatthias Ringwald     request->btstack_crypto.context_callback.callback  = callback;
1015d1a1f6a4SMatthias Ringwald     request->btstack_crypto.context_callback.context   = callback_arg;
1016d1a1f6a4SMatthias Ringwald     request->btstack_crypto.operation                  = BTSTACK_CRYPTO_CCM_ENCRYPT_BLOCK;
1017d1a1f6a4SMatthias Ringwald     request->state                                     = CCM_CALCULATE_X1;
1018d1a1f6a4SMatthias Ringwald     request->block_len                                 = block_len;
1019d1a1f6a4SMatthias Ringwald     request->input                                     = plaintext;
1020d1a1f6a4SMatthias Ringwald     request->output                                    = ciphertext;
1021d1a1f6a4SMatthias Ringwald     btstack_linked_list_add_tail(&btstack_crypto_operations, (btstack_linked_item_t*) request);
1022d1a1f6a4SMatthias Ringwald     btstack_crypto_run();
1023d1a1f6a4SMatthias Ringwald }
1024d1a1f6a4SMatthias Ringwald 
1025d1a1f6a4SMatthias Ringwald void btstack_crypto_ccm_decrypt_block(btstack_crypto_ccm_t * request, uint16_t block_len, const uint8_t * ciphertext, uint8_t * plaintext, void (* callback)(void * arg), void * callback_arg){
1026d1a1f6a4SMatthias Ringwald     request->btstack_crypto.context_callback.callback  = callback;
1027d1a1f6a4SMatthias Ringwald     request->btstack_crypto.context_callback.context   = callback_arg;
1028d1a1f6a4SMatthias Ringwald     request->btstack_crypto.operation                  = BTSTACK_CRYPTO_CCM_DECRYPT_BLOCK;
1029d1a1f6a4SMatthias Ringwald     request->state                                     = CCM_CALCULATE_X1;
1030d1a1f6a4SMatthias Ringwald     request->block_len                                 = block_len;
1031d1a1f6a4SMatthias Ringwald     request->input                                     = ciphertext;
1032d1a1f6a4SMatthias Ringwald     request->output                                    = plaintext;
1033d1a1f6a4SMatthias Ringwald     btstack_linked_list_add_tail(&btstack_crypto_operations, (btstack_linked_item_t*) request);
1034d1a1f6a4SMatthias Ringwald     btstack_crypto_run();
1035d1a1f6a4SMatthias Ringwald }
1036d1a1f6a4SMatthias Ringwald 
1037