wolfBoot-examples/sim-OTA/app/app_sim.c

213 lines
5.7 KiB
C

/* app_sim.c
*
* Test bare-metal boot-led-on application
*
* Copyright (C) 2025 wolfSSL Inc.
*
* This file is part of wolfBoot.
*
* wolfBoot is free software; you can redistribute it and/or modify
* it under the terms of the GNU General Public License as published by
* the Free Software Foundation; either version 3 of the License, or
* (at your option) any later version.
*
* wolfBoot is distributed in the hope that it will be useful,
* but WITHOUT ANY WARRANTY; without even the implied warranty of
* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
* GNU General Public License for more details.
*
* You should have received a copy of the GNU General Public License
* along with this program; if not, write to the Free Software
* Foundation, Inc., 51 Franklin Street, Fifth Floor, Boston, MA 02110-1335, USA
*/
#include <stdlib.h>
#include <stdint.h>
#include <string.h>
#include <stdio.h>
#include <unistd.h>
#include "target.h"
#include "wolfboot/wolfboot.h"
#ifdef WOLFBOOT_SELF_HEADER
#include "image.h"
#endif
#include "tpm_handler.h"
#include "fwclient.h"
#ifdef DUALBANK_SWAP
uint32_t hal_sim_get_dualbank_state(void);
#endif
#ifdef TARGET_sim
/* Matches all keys:
* - chacha (32 + 12)
* - aes128 (16 + 16)
* - aes256 (32 + 16)
*/
/* Longest key possible: AES256 (32 key + 16 IV = 48) */
char enc_key[] = "0123456789abcdef0123456789abcdef"
"0123456789abcdef";
#ifdef TEST_DELTA_DATA
static volatile char __attribute__((used)) garbage[TEST_DELTA_DATA] = {0x01, 0x02, 0x03, 0x04 };
#endif
void hal_init(void);
int do_cmd(const char *cmd)
{
if (strcmp(cmd, "powerfail") == 0) {
return 1;
}
/* forces a bad write of the boot partition to trigger and test the
* emergency fallback feature */
if (strcmp(cmd, "emergency") == 0) {
return 1;
}
if (strcmp(cmd, "get_version") == 0) {
printf("%d\n", wolfBoot_current_firmware_version());
wolfBoot_success();
return 0;
}
if (strcmp(cmd, "get_state") == 0) {
uint8_t st = 0;
wolfBoot_get_partition_state(PART_UPDATE, &st);
printf("%02x\n", st);
return 0;
}
if (strcmp(cmd, "success") == 0) {
wolfBoot_success();
return 0;
}
#ifdef DUALBANK_SWAP
if (strcmp(cmd, "get_swap_state") == 0) {
printf("%u\n", hal_sim_get_dualbank_state());
return 0;
}
#endif
if (strcmp(cmd, "update_trigger") == 0) {
#if EXT_ENCRYPTED
wolfBoot_set_encrypt_key((uint8_t *)enc_key,(uint8_t *)(enc_key + 32));
#endif
wolfBoot_update_trigger();
return 0;
}
if (strcmp(cmd, "reset") == 0) {
exit(0);
}
if (strncmp(cmd, "get_tlv",7) == 0) {
/* boot partition and skip the image header offset (8 bytes) */
uint8_t* imageHdr = (uint8_t*)WOLFBOOT_PARTITION_BOOT_ADDRESS + IMAGE_HEADER_OFFSET;
uint8_t* ptr = NULL;
uint16_t tlv = 0x34; /* default */
int size;
int i;
const char* tlvStr = strstr(cmd, "get_tlv=");
if (tlvStr) {
tlvStr += strlen("get_tlv=");
tlv = (uint16_t)atoi(tlvStr);
}
size = wolfBoot_find_header(imageHdr, tlv, &ptr);
if (size > 0 && ptr != NULL) {
/* From here, the value 0xAABBCCDD is at ptr */
printf("TLV 0x%x: found (size %d):\n", tlv, size);
for (i=0; i<size; i++) {
printf("%02X", ptr[i]);
}
printf("\n");
return 0;
} else {
printf("TLV 0x%x: not found!\r\n", tlv);
}
}
#ifdef WOLFBOOT_SELF_HEADER
if (strcmp(cmd, "verify_self") == 0) {
struct wolfBoot_image img;
int ret;
printf("=== Self-Header Verification Test ===\n");
/* Open bootloader image using persisted self-header */
ret = wolfBoot_open_self(&img);
if (ret != 0) {
printf("FAIL: wolfBoot_open_self returned %d\n", ret);
return -1;
}
printf("open_self: OK (fw_size=%u, part=%d)\n", (unsigned)img.fw_size,
img.part);
/* Verify integrity (hash check) */
ret = wolfBoot_verify_integrity(&img);
if (ret != 0) {
printf("FAIL: wolfBoot_verify_integrity returned %d\n", ret);
return -1;
}
printf("verify_integrity: OK\n");
/* Verify authenticity (signature check) */
ret = wolfBoot_verify_authenticity(&img);
if (ret != 0) {
printf("FAIL: wolfBoot_verify_authenticity returned %d\n", ret);
return -1;
}
printf("verify_authenticity: OK\n");
printf("=== Self-header verification PASSED ===\n");
return 0;
}
#endif
if (strcmp(cmd, "attestation") == 0) {
int ret=0;
/* Call tpm handler for attestation */
ret = tpm_handler();
if (ret != 0){
printf("attestation command is failed.\n");
return -1;
}
return 0;
}
if (strcmp(cmd, "ota") == 0) {
int ret = 0;
/* Call ota handoer */
ret = fwclient_main();
if (ret != 0) {
printf("ota command is failed. \n");
return -1;
} else {
printf("Firmware Download is finished. Trigger the Update.\n");
wolfBoot_update_trigger();
return 0;
}
}
/* wrong command */
printf("wrong command\n");
return -1;
}
int main(int argc, char *argv[]) {
int i;
int ret;
printf("Simulator app is running...\n");
hal_init();
for (i = 1; i < argc; ++i) {
ret = do_cmd(argv[i]);
if (ret < 0)
return -1;
i+= ret;
}
return 0;
}
#endif /** TARGET_sim **/