/* * test-bus.c * ---------- * Test raw read/write performance across the EIM or FMC bus. * * Copyright (c) 2015, NORDUnet A/S All rights reserved. * * Redistribution and use in source and binary forms, with or without * modification, are permitted provided that the following conditions are * met: * - Redistributions of source code must retain the above copyright notice, * this list of conditions and the following disclaimer. * * - Redistributions in binary form must reproduce the above copyright * notice, this list of conditions and the following disclaimer in the * documentation and/or other materials provided with the distribution. * * - Neither the name of the NORDUnet nor the names of its contributors may * be used to endorse or promote products derived from this software * without specific prior written permission. * * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS * IS" AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED * TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A * PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT * HOLDER OR CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, * SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED * TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR * PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF * LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING * NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS * SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE. */ #include #include #include #include #include #include #include #define TEST_NUM_ROUNDS 2000000 /* * Sanity test - can we read and write the dummy register? */ static int sanity(const hal_core_t *board_core) { uint32_t rnd = 0xdeadbeef, data; hal_error_t err; if (board_core == NULL) { printf("initialization failed (is the bitstream loaded?)\n"); return 1; } if ((err = hal_io_write(board_core, 0xFF, (const uint8_t *) &rnd, sizeof(rnd))) != HAL_OK) { printf("writing dummy: %s\n", hal_error_string(err)); return 1; } if ((err = hal_io_read(board_core, 0xFF, (uint8_t *) &data, sizeof(data))) != HAL_OK) { printf("reading dummy: %s\n", hal_error_string(err)); return 1; } if (data != rnd) { printf("Data bus fail: expected %08x, got %08x, diff %08x\n", rnd, data, data ^ rnd); return 1; } return 0; } /* * Time a test. */ static void _time_check(char *label, const struct timeval t0, const int err) { struct timeval t; float rounds; gettimeofday(&t, NULL); t.tv_sec -= t0.tv_sec; t.tv_usec -= t0.tv_usec; if (t.tv_usec < 0) { t.tv_usec += 1000000; t.tv_sec -= 1; } rounds = (float)TEST_NUM_ROUNDS/((float)t.tv_sec + ((float)t.tv_usec / 1000000)); printf("%s%lu.%06lu seconds, %u/sec\n", label, t.tv_sec, t.tv_usec, (unsigned)rounds); } #define time_check(_label_, _expr_) \ do { \ struct timeval _t; \ gettimeofday(&_t, NULL); \ int _err = (_expr_); \ _time_check(_label_, _t, _err); \ err |= _err; \ } while (0) /* * Read and write over and over again. */ static int test_read(const hal_core_t *board_core) { uint32_t i, data; hal_error_t err; for (i = 0; i < TEST_NUM_ROUNDS; ++i) { if ((err = hal_io_read(board_core, 0xFF, (uint8_t *) &data, sizeof(data))) != HAL_OK) { printf("reading dummy: %s\n", hal_error_string(err)); return 1; } } return 0; } static int test_write(const hal_core_t *board_core) { uint32_t i; hal_error_t err; for (i = 0; i < TEST_NUM_ROUNDS; ++i) { if ((err = hal_io_write(board_core, 0xFF, (const uint8_t *) &i, sizeof(i))) != HAL_OK) { printf("writing dummy: %s\n", hal_error_string(err)); return 1; } } return 0; } int main(void) { const hal_core_t *board_core = hal_core_find(NOVENA_BOARD_NAME, NULL); int err = 0; if (sanity(board_core) != 0) return 1; time_check("read ", test_read(board_core)); time_check("write ", test_write(board_core)); return err; } 'author Fredrik Thulin <fredrik@thulin.net> 2016-06-24 13:13:37 +0200 committer Fredrik Thulin <fredrik@thulin.net> 2016-06-24 13:13:37 +0200 Masterkey functions now return hal_error_t as suggested by Rob.' href='/sw/stm32/commit/projects/hsm/mgmt-masterkey.c?h=rsa_timing&id=76a0f707cd0bd10fc96bc50fb81ba0248915b5e2'>76a0f70 
f66d4bc




76a0f70

76a0f70



4b5afd6


76a0f70

f66d4bc



76a0f70

f66d4bc


76a0f70

f66d4bc

76a0f70

f66d4bc

















ab32270

f66d4bc








76a0f70

f66d4bc

b159bf0




f66d4bc


4b5afd6

76a0f70

f66d4bc

4b5afd6

76a0f70

f66d4bc

f66d4bc



ab32270

4b5afd6

f66d4bc


76a0f70

f66d4bc


ab32270







03b14b4

ab32270

f66d4bc


ab32270







03b14b4

ab32270


f66d4bc

ab32270


f66d4bc

ab32270

f66d4bc




ab32270


b159bf0


4b5afd6

ab32270


f66d4bc


76a0f70


b159bf0




4b5afd6

f66d4bc


76a0f70

f66d4bc






b159bf0


4b5afd6

f66d4bc




76a0f70


b159bf0




4b5afd6

f66d4bc


76a0f70

f66d4bc






e3fe7d8


f66d4bc

e3fe7d8

f66d4bc


e3fe7d8


f66d4bc

e3fe7d8



f66d4bc

f66d4bc

e3fe7d8


f66d4bc

e3fe7d8

f66d4bc

1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34

35

36

37
38
39
40

41

42
43
44

45
46

47

48
49
50

51

52
53

54

55

56

57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73

74

75
76
77
78
79
80
81
82

83

84

85
86
87
88

89
90

91

92

93

94

95

96

97
98
99

100

101

102
103

104

105
106

107
108
109
110
111
112
113

114

115

116
117

118
119
120
121
122
123
124

125

126
127

128

129
130

131

132

133
134
135
136

137
138

139
140

141

142
143

144
145

146
147

148
149
150
151

152

153
154

155

156
157
158
159
160
161

162
163

164

165
166
167
168

169
170

171
172
173
174

175

176
177

178

179
180
181
182
183
184

185
186

187

188

189
190

191
192

193

194
195
196

197

198

199
200

201

202

203


































                                                                           
                                                                
                           



                           
 


                        

                                                                  
             


                   
                                                   

                     
                   
                              
                                     
















                                                                              
                                                







                                                                                                 
                       
 



                      

                                              
                                            
                                                                                         
 
                                         
                                                                                         
 


                  
                                                                      
                                                                                                  

                                  
                    

          






                                                                                  
                                                   
                             

     






                                                                                                             
                                                   

                             
 

                                                             
            
                                                                                            



                  

                                                                                              

                      
                                                                               

 

                                                                                                

                    



                      
                                                                  

                                                                 
                                                                                                    





                                                                                                       

                      
                                                                         



                                                                                                         

                    



                      
                                                               

                                                                
                                                                                                   





                                                 

                                                                                           
                          
                                                                                                                 

                       

                                                                                                                         
                         


                                                                                                                                 
 
                                

                                                                                                                                                    
                                  
                                                                                                                                         
 
/*
 * mgmt-masterkey.c
 * ----------------
 * Masterkey CLI functions.
 *
 * Copyright (c) 2016, NORDUnet A/S All rights reserved.
 *
 * Redistribution and use in source and binary forms, with or without
 * modification, are permitted provided that the following conditions are
 * met:
 * - Redistributions of source code must retain the above copyright notice,
 *   this list of conditions and the following disclaimer.
 *
 * - Redistributions in binary form must reproduce the above copyright
 *   notice, this list of conditions and the following disclaimer in the
 *   documentation and/or other materials provided with the distribution.
 *
 * - Neither the name of the NORDUnet nor the names of its contributors may
 *   be used to endorse or promote products derived from this software
 *   without specific prior written permission.
 *
 * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS
 * IS" AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED
 * TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A
 * PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT
 * HOLDER OR CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL,
 * SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED
 * TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR
 * PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF
 * LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING
 * NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS
 * SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
 */

/* Rename both CMSIS HAL_OK and libhal HAL_OK to disambiguate */
#define HAL_OK CMSIS_HAL_OK
#include "stm-init.h"
#include "stm-uart.h"
#include "mgmt-cli.h"
#include "mgmt-masterkey.h"

#undef HAL_OK
#define LIBHAL_OK HAL_OK
#include <hal.h>
#warning Refactor so we do not need to include hal_internal.h here
#include <hal_internal.h>
#undef HAL_OK

#include <stdlib.h>

static char * _status2str(const hal_error_t status)
{
    switch (status) {
    case LIBHAL_OK:
	return (char *) "Set";
    case HAL_ERROR_MASTERKEY_NOT_SET:
	return (char *) "Not set";
    default:
	return (char *) "Unknown";
    }
}

static int _parse_hex_groups(uint8_t *buf, size_t len, char *argv[], int argc)
{
    int i;
    uint32_t *dst = (uint32_t *) buf;
    uint32_t *end = (uint32_t *) buf + len - 1;
    char *err_ptr = NULL;

    if (! argc) return 0;

    for (i = 0; i < argc; i++) {
	if (dst >= end) return -1;
	*dst++ = strtoul(argv[i], &err_ptr, 16);
	if (*err_ptr) return -2;
    }

    return 1;
}

static int cmd_masterkey_status(struct cli_def *cli, const char *command, char *argv[], int argc)
{
    hal_error_t status;

    command = command;
    argv = argv;
    argc = argc;

    cli_print(cli, "Status of master key:\n");

    status = hal_mkm_volatile_read(NULL, 0);
    cli_print(cli, "  volatile: %s / %s", _status2str(status), hal_error_string(status));

    status = hal_mkm_flash_read(NULL, 0);
    cli_print(cli, "     flash: %s / %s", _status2str(status), hal_error_string(status));

    return CLI_OK;
}

static int _masterkey_set(struct cli_def *cli, char *argv[], int argc,
                          char *label, hal_error_t (*writer)(const uint8_t * const, const size_t))
{
    uint8_t buf[KEK_LENGTH] = {0};
    hal_error_t err;
    int i;

    if (argc == 0) {
        /* fill master key with yummy randomness */
        if ((err = hal_get_random(NULL, buf, sizeof(buf))) != LIBHAL_OK) {
            cli_print(cli, "Error getting random key: %s", hal_error_string(err));
            return CLI_ERROR;
        }
        cli_print(cli, "Random key:\n");
        uart_send_hexdump(buf, 0, sizeof(buf) - 1);
        cli_print(cli, "\n");
    }

    else {
        if ((i = _parse_hex_groups(&buf[0], sizeof(buf), argv, argc)) != 1) {
            cli_print(cli, "Failed parsing master key, expected up to 8 groups of 32-bit hex chars (%i)", i);
            return CLI_ERROR;
        }

        cli_print(cli, "Parsed key:\n");
        uart_send_hexdump(buf, 0, sizeof(buf) - 1);
        cli_print(cli, "\n");
    }

    if ((err = writer(buf, sizeof(buf))) == LIBHAL_OK) {
	cli_print(cli, "Master key set in %s memory", label);
    } else {
	cli_print(cli, "Failed writing key to %s memory: %s", label, hal_error_string(err));
    }
    return CLI_OK;
}

static int cmd_masterkey_set(struct cli_def *cli, const char *command, char *argv[], int argc)
{
    command = command;

    return _masterkey_set(cli, argv, argc, "volatile", hal_mkm_volatile_write);
}

static int cmd_masterkey_erase(struct cli_def *cli, const char *command, char *argv[], int argc)
{
    hal_error_t err;

    command = command;
    argv = argv;
    argc = argc;

    if ((err = hal_mkm_volatile_erase(KEK_LENGTH)) == LIBHAL_OK) {
	cli_print(cli, "Erased master key from volatile memory");
    } else {
	cli_print(cli, "Failed erasing master key from volatile memory: %s", hal_error_string(err));
    }
    return CLI_OK;
}

static int cmd_masterkey_unsecure_set(struct cli_def *cli, const char *command, char *argv[], int argc)
{
    command = command;

    return _masterkey_set(cli, argv, argc, "flash", hal_mkm_flash_write);
}

static int cmd_masterkey_unsecure_erase(struct cli_def *cli, const char *command, char *argv[], int argc)
{
    hal_error_t err;

    command = command;
    argv = argv;
    argc = argc;

    if ((err = hal_mkm_flash_erase(KEK_LENGTH)) == LIBHAL_OK) {
	cli_print(cli, "Erased unsecure master key from flash");
    } else {
	cli_print(cli, "Failed erasing unsecure master key from flash: %s", hal_error_string(err));
    }
    return CLI_OK;
}

void configure_cli_masterkey(struct cli_def *cli)
{
    struct cli_command *c = cli_register_command(cli, NULL, "masterkey", NULL, 0, 0, NULL);

    /* masterkey status */
    cli_register_command(cli, c, "status", cmd_masterkey_status, 0, 0, "Show status of master key in RAM/flash");

    /* masterkey set */
    cli_register_command(cli, c, "set", cmd_masterkey_set, 0, 0, "Set the master key in the volatile Master Key Memory");

    /* masterkey erase */
    cli_register_command(cli, c, "erase", cmd_masterkey_erase, 0, 0, "Erase the master key from the volatile Master Key Memory");

    struct cli_command *c_unsecure = cli_register_command(cli, c, "unsecure", NULL, 0, 0, NULL);

    /* masterkey unsecure set */
    cli_register_command(cli, c_unsecure, "set", cmd_masterkey_unsecure_set, 0, 0, "Set master key in unprotected flash memory (if unsure, DON'T)");

    /* masterkey unsecure erase */
    cli_register_command(cli, c_unsecure, "erase", cmd_masterkey_unsecure_erase, 0, 0, "Erase master key from unprotected flash memory");
}
generated by cgit v1.2.3 (git 2.25.1) at 2024-09-20 16:42:34 +0000