/* * mgmt-show.c * ----------- * CLI 'show' 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-keystore.h" #include "stm-fpgacfg.h" #include "stm-uart.h" #include "mgmt-cli.h" #include "mgmt-show.h" #undef HAL_OK #define LIBHAL_OK HAL_OK #include "hal.h" #define HAL_STATIC_PKEY_STATE_BLOCKS 6 #include "hal_internal.h" #undef HAL_OK #include static int cmd_show_cpuspeed(struct cli_def *cli, const char *command, char *argv[], int argc) { volatile uint32_t hclk; hclk = HAL_RCC_GetHCLKFreq(); cli_print(cli, "HSE_VALUE: %li", HSE_VALUE); cli_print(cli, "HCLK: %li (%i MHz)", hclk, (int) hclk / 1000 / 1000); cli_print(cli, "SystemCoreClock: %li (%i MHz)", SystemCoreClock, (int) SystemCoreClock / 1000 / 1000); return CLI_OK; } static int cmd_show_fpga_status(struct cli_def *cli, const char *command, char *argv[], int argc) { cli_print(cli, "FPGA has %sloaded a bitstream", fpgacfg_check_done() ? "":"NOT "); return CLI_OK; } static int cmd_show_fpga_cores(struct cli_def *cli, const char *command, char *argv[], int argc) { hal_core_t *core; const hal_core_info_t *info; if (! fpgacfg_check_done()) { cli_print(cli, "FPGA has not loaded a bitstream"); return CLI_OK; } for (core = hal_core_iterate(NULL); core != NULL; core = hal_core_iterate(core)) { info = hal_core_info(core); cli_print(cli, "%04x: %8.8s %4.4s", (unsigned int)info->base, info->name, info->version); } return CLI_OK; } static int cmd_show_keystore_status(struct cli_def *cli, const char *command, char *argv[], int argc) { cli_print(cli, "Keystore memory is %sonline", (keystore_check_id() != 1) ? "NOT ":""); return CLI_OK; } static int cmd_show_keystore_data(struct cli_def *cli, const char *command, char *argv[], int argc) { uint8_t buf[KEYSTORE_PAGE_SIZE]; uint32_t i; if (keystore_check_id() != 1) { cli_print(cli, "ERROR: The keystore memory is not accessible."); } memset(buf, 0, sizeof(buf)); if ((i = keystore_read_data(0, buf, sizeof(buf))) != 1) { cli_print(cli, "Failed reading first page from keystore memory: %li", i); return CLI_ERROR; } cli_print(cli, "First page from keystore memory:\r\n"); uart_send_hexdump(STM_UART_MGMT, buf, 0, sizeof(buf) - 1); uart_send_string2(STM_UART_MGMT, (char *) "\r\n\r\n"); for (i = 0; i < 8; i++) { if (buf[i] == 0xff) break; /* never written */ if (buf[i] != 0x55) break; /* something other than a tombstone */ } /* As a demo, tombstone byte after byte of the first 8 bytes in the keystore memory * (as long as they do not appear to contain real data). * If all of them are tombstones, erase the first sector to start over. */ if (i < 8) { if (buf[i] == 0xff) { cli_print(cli, "Tombstoning byte %li", i); buf[i] = 0x55; if ((i = keystore_write_data(0, buf, sizeof(buf))) != 1) { cli_print(cli, "Failed writing data at offset 0: %li", i); return CLI_ERROR; } } } else { cli_print(cli, "Erasing first sector since all the first 8 bytes are tombstones"); if ((i = keystore_erase_sector(0)) != 1) { cli_print(cli, "Failed erasing the first sector: %li", i); return CLI_ERROR; } cli_print(cli, "Erase result: %li", i); } return CLI_OK; } void configure_cli_show(struct cli_def *cli) { struct cli_command *c = cli_register_command(cli, NULL, "show", NULL, 0, 0, NULL); /* show cpuspeed */ cli_register_command(cli, c, "cpuspeed", cmd_show_cpuspeed, 0, 0, "Show the speed at which the CPU currently operates"); struct cli_command *c_fpga = cli_register_command(cli, c, "fpga", NULL, 0, 0, NULL); /* show fpga status*/ cli_register_command(cli, c_fpga, "status", cmd_show_fpga_status, 0, 0, "Show status about the FPGA"); /* show fpga cores*/ cli_register_command(cli, c_fpga, "cores", cmd_show_fpga_cores, 0, 0, "Show the currently available FPGA cores"); struct cli_command *c_keystore = cli_register_command(cli, c, "keystore", NULL, 0, 0, NULL); /* show keystore status*/ cli_register_command(cli, c_keystore, "status", cmd_show_keystore_status, 0, 0, "Show status of the keystore memory"); /* show keystore data */ cli_register_command(cli, c_keystore, "data", cmd_show_keystore_data, 0, 0, "Show the first page of the keystore memory"); } > 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
/*
 * Test read/write performance of the fmc bus
 */
#include "stm32f4xx_hal.h"
#include "stm-init.h"
#include "stm-led.h"
#include "stm-fmc.h"
#include "stm-uart.h"

#define TEST_NUM_ROUNDS		2000000

RNG_HandleTypeDef rng_inst;

static void MX_RNG_Init(void)
{
    rng_inst.Instance = RNG;
    HAL_RNG_Init(&rng_inst);
}

static uint32_t random(void)
{
    uint32_t rnd;
    if (HAL_RNG_GenerateRandomNumber(&rng_inst, &rnd) != HAL_OK) {
	uart_send_string("HAL_RNG_GenerateRandomNumber failed\r\n");
	Error_Handler();
    }
    return rnd;
}

static void sanity(void)
{
    uint32_t rnd, data;
  
    rnd = random();  
    if (fmc_write_32(0, &rnd) != 0) {
	uart_send_string("fmc_write_32 failed\r\n");
	Error_Handler();
    }
    if (fmc_read_32(0, &data) != 0) {
	uart_send_string("fmc_read_32 failed\r\n");
	Error_Handler();
    }
    if (data != rnd) {
	uart_send_string("Data bus fail: expected ");
	uart_send_hex(rnd, 8);
	uart_send_string(", got ");
	uart_send_hex(data, 8);
	uart_send_string(", diff ");
	uart_send_hex(data ^ rnd, 8);
	uart_send_string("\r\n");
	Error_Handler();
    }
}

static void _time_check(char *label, const uint32_t t0)
{
    uint32_t t = HAL_GetTick() - t0;

    uart_send_string(label);
    uart_send_integer(t / 1000, 0);
    uart_send_char('.');
    uart_send_integer(t % 1000, 3);
    uart_send_string(" seconds, ");
    uart_send_integer(((1000 * TEST_NUM_ROUNDS) / t), 0);
    uart_send_string("/sec\r\n");
}

#define time_check(_label_, _expr_)		\
    do {					\
	uint32_t _t = HAL_GetTick();		\
	(_expr_);				\
	_time_check(_label_, _t);		\
    } while (0)

static void test_read(void)
{
    uint32_t i, data;
    
    for (i = 0; i < TEST_NUM_ROUNDS; ++i) {
	if (fmc_read_32(0, &data) != 0) {
	    uart_send_string("fmc_read_32 failed\r\n");
	    Error_Handler();
	}
    }
}

static void test_write(void)
{
    uint32_t i;
    
    for (i = 0; i < TEST_NUM_ROUNDS; ++i) {
	if (fmc_write_32(0, &i) != 0) {
	    uart_send_string("fmc_write_32 failed\r\n");
	    Error_Handler();
	}
    }
}

int main(void)
{
    stm_init();

    uart_send_string("Keep calm for Novena boot...\r\n");

    // Blink blue LED for six seconds to not upset the Novena at boot.
    led_on(LED_BLUE);
    for (int i = 0; i < 12; i++) {
	HAL_Delay(500);
	led_toggle(LED_BLUE);
    }
    led_off(LED_BLUE);

    // initialize rng
    MX_RNG_Init();

    // prepare fmc interface
    fmc_init();

    sanity();

    time_check("read  ", test_read());
    time_check("write ", test_write());

    uart_send_string("Done.\r\n\r\n");
    return 0;
}