mirror of
				https://github.com/espressif/esp-idf.git
				synced 2025-10-30 06:31:42 +01:00 
			
		
		
		
	
		
			
	
	
		
			288 lines
		
	
	
		
			11 KiB
		
	
	
	
		
			C
		
	
	
	
	
	
		
		
			
		
	
	
			288 lines
		
	
	
		
			11 KiB
		
	
	
	
		
			C
		
	
	
	
	
	
|   | #include <stdio.h>
 | ||
|  | #include <stdlib.h>
 | ||
|  | #include <string.h>
 | ||
|  | #include "esp_types.h"
 | ||
|  | #include "esp_clk.h"
 | ||
|  | 
 | ||
|  | #include "freertos/FreeRTOS.h"
 | ||
|  | #include "freertos/task.h"
 | ||
|  | #include "freertos/semphr.h"
 | ||
|  | #include "freertos/xtensa_timer.h"
 | ||
|  | #include "soc/cpu.h"
 | ||
|  | #include "unity.h"
 | ||
|  | #include "rom/uart.h"
 | ||
|  | #include "rom/sha.h"
 | ||
|  | #include "soc/uart_reg.h"
 | ||
|  | #include "soc/dport_reg.h"
 | ||
|  | #include "soc/rtc.h"
 | ||
|  | #include "esp_log.h"
 | ||
|  | #include "mbedtls/sha256.h"
 | ||
|  | #include "hwcrypto/sha.h"
 | ||
|  | #include "hwcrypto/aes.h"
 | ||
|  | #include "mbedtls/rsa.h"
 | ||
|  | 
 | ||
|  | static const char *TAG = "test"; | ||
|  | static volatile bool exit_flag = false; | ||
|  | #define TASK_STACK_SIZE (8*1024)
 | ||
|  | 
 | ||
|  | static void aes_task(void *pvParameters) | ||
|  | { | ||
|  |     xSemaphoreHandle *sema = (xSemaphoreHandle *) pvParameters; | ||
|  |     ESP_LOGI(TAG, "aes_task is started"); | ||
|  |     esp_aes_context ctx = { | ||
|  |             .key_bytes = 16, | ||
|  |             .key = {101, 102, 103, 104, 105, 106, 107, 108, 109, 110, 111, 112, 113, 114, 115, 116} | ||
|  |     }; | ||
|  |     const unsigned char input[16] = {1, 2, 3, 4, 5, 6, 7, 8, 9, 10, 11, 12, 13, 14, 15, 16}; | ||
|  |     unsigned char output[16]; | ||
|  |     unsigned char output2[16]; | ||
|  |     while (exit_flag == false) { | ||
|  |         memset(output, 0, sizeof(output)); | ||
|  |         memset(output, 0, sizeof(output2)); | ||
|  |         esp_internal_aes_encrypt(&ctx, input, output); | ||
|  |         esp_internal_aes_decrypt(&ctx, output, output2); | ||
|  |         TEST_ASSERT_EQUAL_MEMORY_MESSAGE(input, output2, sizeof(input), "AES must match"); | ||
|  |     } | ||
|  |     xSemaphoreGive(*sema); | ||
|  |     vTaskDelete(NULL); | ||
|  | } | ||
|  | 
 | ||
|  | static void sha_task(void *pvParameters) | ||
|  | { | ||
|  |     xSemaphoreHandle *sema = (xSemaphoreHandle *) pvParameters; | ||
|  |     ESP_LOGI(TAG, "sha_task is started"); | ||
|  |     const char *input = "Space!#$%&()*+,-.0123456789:;<=>?@ABCDEFGHIJKLMNOPQRSTUVWXYZ[]^_abcdefghijklmnopqrstuvwxyz~DEL0123456789"; | ||
|  |     unsigned char output[64]; | ||
|  |     unsigned char output_origin[64]; | ||
|  |     esp_sha(SHA2_512, (const unsigned char *)input, sizeof(input), output); | ||
|  |     memcpy(output_origin, output, sizeof(output)); | ||
|  |     while (exit_flag == false) { | ||
|  |         memset(output, 0, sizeof(output)); | ||
|  |         esp_sha(SHA2_512, (const unsigned char *)input, sizeof(input), output); | ||
|  |         TEST_ASSERT_EQUAL_MEMORY_MESSAGE(output, output_origin, sizeof(output), "SHA256 must match"); | ||
|  |     } | ||
|  |     xSemaphoreGive(*sema); | ||
|  |     vTaskDelete(NULL); | ||
|  | } | ||
|  | 
 | ||
|  | static void mbedtls_sha256_task(void *pvParameters) | ||
|  | { | ||
|  |     xSemaphoreHandle *sema = (xSemaphoreHandle *) pvParameters; | ||
|  |     ESP_LOGI(TAG, "mbedtls_sha256_task is started"); | ||
|  |     const char *input = "@ABCDEFGHIJKLMNOPQRSTUVWXYZ[]^_abcdefghijklmnopqrstuvwxyz~DEL0123456789Space!#$%&()*+,-.0123456789:;<=>?"; | ||
|  |     mbedtls_sha256_context sha256_ctx; | ||
|  |     unsigned char output[32]; | ||
|  |     unsigned char output_origin[32]; | ||
|  | 
 | ||
|  |     mbedtls_sha256_init(&sha256_ctx); | ||
|  |     memset(output, 0, sizeof(output)); | ||
|  |     mbedtls_sha256_starts_ret(&sha256_ctx, false); | ||
|  |     for (int i = 0; i < 3; ++i) { | ||
|  |         mbedtls_sha256_update_ret(&sha256_ctx, (unsigned char *)input, 100); | ||
|  |     } | ||
|  |     mbedtls_sha256_finish_ret(&sha256_ctx, output); | ||
|  |     memcpy(output_origin, output, sizeof(output)); | ||
|  | 
 | ||
|  |     while (exit_flag == false) { | ||
|  |         mbedtls_sha256_init(&sha256_ctx); | ||
|  |         memset(output, 0, sizeof(output)); | ||
|  |         mbedtls_sha256_starts_ret(&sha256_ctx, false); | ||
|  |         for (int i = 0; i < 3; ++i) { | ||
|  |             mbedtls_sha256_update_ret(&sha256_ctx, (unsigned char *)input, 100); | ||
|  |         } | ||
|  |         mbedtls_sha256_finish_ret(&sha256_ctx, output); | ||
|  | 
 | ||
|  |         TEST_ASSERT_EQUAL_MEMORY_MESSAGE(output, output_origin, sizeof(output), "MBEDTLS SHA256 must match"); | ||
|  |     } | ||
|  |     xSemaphoreGive(*sema); | ||
|  |     vTaskDelete(NULL); | ||
|  | } | ||
|  | 
 | ||
|  | TEST_CASE("Test shared using AES SHA512 SHA256", "[hw_crypto]") | ||
|  | { | ||
|  | #ifndef CONFIG_FREERTOS_UNICORE
 | ||
|  |     const int max_tasks = 6; | ||
|  | #else
 | ||
|  |     const int max_tasks = 3; | ||
|  | #endif
 | ||
|  |     xSemaphoreHandle exit_sema[max_tasks]; | ||
|  | 
 | ||
|  |     for (int i = 0; i < max_tasks; ++i) { | ||
|  |         exit_sema[i] = xSemaphoreCreateBinary(); | ||
|  |     } | ||
|  |     exit_flag = false; | ||
|  | #ifndef CONFIG_FREERTOS_UNICORE
 | ||
|  |     xTaskCreatePinnedToCore(&aes_task,            "aes_task",            TASK_STACK_SIZE, &exit_sema[0], UNITY_FREERTOS_PRIORITY - 1, NULL, 1); | ||
|  |     xTaskCreatePinnedToCore(&aes_task,            "aes_task",            TASK_STACK_SIZE, &exit_sema[1], UNITY_FREERTOS_PRIORITY - 1, NULL, 0); | ||
|  |     xTaskCreatePinnedToCore(&sha_task,            "sha_task",            TASK_STACK_SIZE, &exit_sema[2], UNITY_FREERTOS_PRIORITY - 1, NULL, 1); | ||
|  |     xTaskCreatePinnedToCore(&sha_task,            "sha_task",            TASK_STACK_SIZE, &exit_sema[3], UNITY_FREERTOS_PRIORITY - 1, NULL, 0); | ||
|  |     xTaskCreatePinnedToCore(&mbedtls_sha256_task, "mbedtls_sha256_task", TASK_STACK_SIZE, &exit_sema[4], UNITY_FREERTOS_PRIORITY - 1, NULL, 1); | ||
|  |     xTaskCreatePinnedToCore(&mbedtls_sha256_task, "mbedtls_sha256_task", TASK_STACK_SIZE, &exit_sema[5], UNITY_FREERTOS_PRIORITY - 1, NULL, 0); | ||
|  | #else
 | ||
|  |     xTaskCreate(&aes_task,            "aes_task",            TASK_STACK_SIZE, &exit_sema[0], UNITY_FREERTOS_PRIORITY - 1, NULL); | ||
|  |     xTaskCreate(&sha_task,            "sha_task",            TASK_STACK_SIZE, &exit_sema[1], UNITY_FREERTOS_PRIORITY - 1, NULL); | ||
|  |     xTaskCreate(&mbedtls_sha256_task, "mbedtls_sha256_task", TASK_STACK_SIZE, &exit_sema[2], UNITY_FREERTOS_PRIORITY - 1, NULL); | ||
|  | #endif
 | ||
|  | 
 | ||
|  |     ESP_LOGI(TAG, "Waiting for 10s ..."); | ||
|  |     vTaskDelay(10000 / portTICK_PERIOD_MS); | ||
|  | 
 | ||
|  |     // set exit flag to let thread exit
 | ||
|  |     exit_flag = true; | ||
|  |     for (int i = 0; i < max_tasks; ++i) { | ||
|  |         if (!xSemaphoreTake(exit_sema[i], 2000/portTICK_PERIOD_MS)) { | ||
|  |             TEST_FAIL_MESSAGE("exit_sema not released by test task"); | ||
|  |         } | ||
|  |         vSemaphoreDelete(exit_sema[i]); | ||
|  |     } | ||
|  | } | ||
|  | 
 | ||
|  | static void rsa_task(void *pvParameters) | ||
|  | { | ||
|  |     xSemaphoreHandle *sema = (xSemaphoreHandle *) pvParameters; | ||
|  |     ESP_LOGI(TAG, "rsa_task is started"); | ||
|  |     while (exit_flag == false) { | ||
|  |         mbedtls_rsa_self_test(0); | ||
|  |     } | ||
|  |     xSemaphoreGive(*sema); | ||
|  |     vTaskDelete(NULL); | ||
|  | } | ||
|  | 
 | ||
|  | TEST_CASE("Test shared using AES RSA", "[hw_crypto]") | ||
|  | { | ||
|  | #ifndef CONFIG_FREERTOS_UNICORE
 | ||
|  |     const int max_tasks = 2; | ||
|  | #else
 | ||
|  |     const int max_tasks = 2; | ||
|  | #endif
 | ||
|  |     xSemaphoreHandle exit_sema[max_tasks]; | ||
|  | 
 | ||
|  |     for (int i = 0; i < max_tasks; ++i) { | ||
|  |         exit_sema[i] = xSemaphoreCreateBinary(); | ||
|  |     } | ||
|  |     exit_flag = false; | ||
|  | #ifndef CONFIG_FREERTOS_UNICORE
 | ||
|  |     xTaskCreatePinnedToCore(&aes_task, "aes_task", TASK_STACK_SIZE, &exit_sema[0], UNITY_FREERTOS_PRIORITY - 1, NULL, 1); | ||
|  |     xTaskCreatePinnedToCore(&rsa_task, "rsa_task", TASK_STACK_SIZE, &exit_sema[1], UNITY_FREERTOS_PRIORITY - 1, NULL, 0); | ||
|  | #else
 | ||
|  |     xTaskCreate(&aes_task, "aes_task", TASK_STACK_SIZE, &exit_sema[0], UNITY_FREERTOS_PRIORITY - 1, NULL); | ||
|  |     xTaskCreate(&rsa_task, "rsa_task", TASK_STACK_SIZE, &exit_sema[1], UNITY_FREERTOS_PRIORITY - 1, NULL); | ||
|  | #endif
 | ||
|  | 
 | ||
|  |     ESP_LOGI(TAG, "Waiting for 10s ..."); | ||
|  |     vTaskDelay(10000 / portTICK_PERIOD_MS); | ||
|  | 
 | ||
|  |     // set exit flag to let thread exit
 | ||
|  |     exit_flag = true; | ||
|  |     for (int i = 0; i < max_tasks; ++i) { | ||
|  |         if (!xSemaphoreTake(exit_sema[i], 2000/portTICK_PERIOD_MS)) { | ||
|  |             TEST_FAIL_MESSAGE("exit_sema not released by test task"); | ||
|  |         } | ||
|  |         vSemaphoreDelete(exit_sema[i]); | ||
|  |     } | ||
|  | } | ||
|  | 
 | ||
|  | TEST_CASE("Test shared using SHA512 RSA", "[hw_crypto]") | ||
|  | { | ||
|  | #ifndef CONFIG_FREERTOS_UNICORE
 | ||
|  |     const int max_tasks = 2; | ||
|  | #else
 | ||
|  |     const int max_tasks = 2; | ||
|  | #endif
 | ||
|  |     xSemaphoreHandle exit_sema[max_tasks]; | ||
|  | 
 | ||
|  |     for (int i = 0; i < max_tasks; ++i) { | ||
|  |         exit_sema[i] = xSemaphoreCreateBinary(); | ||
|  |     } | ||
|  |     exit_flag = false; | ||
|  | #ifndef CONFIG_FREERTOS_UNICORE
 | ||
|  |     xTaskCreatePinnedToCore(&sha_task, "sha_task", TASK_STACK_SIZE, &exit_sema[0], UNITY_FREERTOS_PRIORITY - 2, NULL, 1); | ||
|  |     xTaskCreatePinnedToCore(&rsa_task, "rsa_task", TASK_STACK_SIZE, &exit_sema[1], UNITY_FREERTOS_PRIORITY - 1, NULL, 0); | ||
|  | #else
 | ||
|  |     xTaskCreate(&sha_task, "sha_task", TASK_STACK_SIZE, &exit_sema[0], UNITY_FREERTOS_PRIORITY - 1, NULL); | ||
|  |     xTaskCreate(&rsa_task, "rsa_task", TASK_STACK_SIZE, &exit_sema[1], UNITY_FREERTOS_PRIORITY - 1, NULL); | ||
|  | #endif
 | ||
|  | 
 | ||
|  |     ESP_LOGI(TAG, "Waiting for 10s ..."); | ||
|  |     vTaskDelay(10000 / portTICK_PERIOD_MS); | ||
|  | 
 | ||
|  |     // set exit flag to let thread exit
 | ||
|  |     exit_flag = true; | ||
|  |     for (int i = 0; i < max_tasks; ++i) { | ||
|  |         if (!xSemaphoreTake(exit_sema[i], 2000/portTICK_PERIOD_MS)) { | ||
|  |             TEST_FAIL_MESSAGE("exit_sema not released by test task"); | ||
|  |         } | ||
|  |         vSemaphoreDelete(exit_sema[i]); | ||
|  |     } | ||
|  | } | ||
|  | 
 | ||
|  | TEST_CASE("Test shared using SHA256 RSA", "[hw_crypto]") | ||
|  | { | ||
|  | #ifndef CONFIG_FREERTOS_UNICORE
 | ||
|  |     const int max_tasks = 2; | ||
|  | #else
 | ||
|  |     const int max_tasks = 2; | ||
|  | #endif
 | ||
|  |     xSemaphoreHandle exit_sema[max_tasks]; | ||
|  | 
 | ||
|  |     for (int i = 0; i < max_tasks; ++i) { | ||
|  |         exit_sema[i] = xSemaphoreCreateBinary(); | ||
|  |     } | ||
|  |     exit_flag = false; | ||
|  | #ifndef CONFIG_FREERTOS_UNICORE
 | ||
|  |     xTaskCreatePinnedToCore(&mbedtls_sha256_task, "mbedtls_sha256_task", TASK_STACK_SIZE, &exit_sema[0], UNITY_FREERTOS_PRIORITY - 1, NULL, 1); | ||
|  |     xTaskCreatePinnedToCore(&rsa_task, "rsa_task", TASK_STACK_SIZE, &exit_sema[1], UNITY_FREERTOS_PRIORITY - 1, NULL, 0); | ||
|  | #else
 | ||
|  |     xTaskCreate(&mbedtls_sha256_task, "mbedtls_sha256_task", TASK_STACK_SIZE, &exit_sema[0], UNITY_FREERTOS_PRIORITY - 1, NULL); | ||
|  |     xTaskCreate(&rsa_task,            "rsa_task",            TASK_STACK_SIZE, &exit_sema[1], UNITY_FREERTOS_PRIORITY - 1, NULL); | ||
|  | #endif
 | ||
|  | 
 | ||
|  |     ESP_LOGI(TAG, "Waiting for 10s ..."); | ||
|  |     vTaskDelay(10000 / portTICK_PERIOD_MS); | ||
|  | 
 | ||
|  |     // set exit flag to let thread exit
 | ||
|  |     exit_flag = true; | ||
|  |     for (int i = 0; i < max_tasks; ++i) { | ||
|  |         if (!xSemaphoreTake(exit_sema[i], 2000/portTICK_PERIOD_MS)) { | ||
|  |             TEST_FAIL_MESSAGE("exit_sema not released by test task"); | ||
|  |         } | ||
|  |         vSemaphoreDelete(exit_sema[i]); | ||
|  |     } | ||
|  | } | ||
|  | 
 | ||
|  | TEST_CASE("Test shared using AES SHA RSA", "[hw_crypto]") | ||
|  | { | ||
|  | #ifndef CONFIG_FREERTOS_UNICORE
 | ||
|  |     const int max_tasks = 3; | ||
|  | #else
 | ||
|  |     const int max_tasks = 3; | ||
|  | #endif
 | ||
|  |     xSemaphoreHandle exit_sema[max_tasks]; | ||
|  | 
 | ||
|  |     for (int i = 0; i < max_tasks; ++i) { | ||
|  |         exit_sema[i] = xSemaphoreCreateBinary(); | ||
|  |     } | ||
|  |     exit_flag = false; | ||
|  | #ifndef CONFIG_FREERTOS_UNICORE
 | ||
|  |     xTaskCreatePinnedToCore(&aes_task, "aes_task", TASK_STACK_SIZE, &exit_sema[0], UNITY_FREERTOS_PRIORITY - 1, NULL, 0); | ||
|  |     xTaskCreatePinnedToCore(&sha_task, "sha_task", TASK_STACK_SIZE, &exit_sema[1], UNITY_FREERTOS_PRIORITY - 1, NULL, 0); | ||
|  |     xTaskCreatePinnedToCore(&rsa_task, "rsa_task", TASK_STACK_SIZE, &exit_sema[2], UNITY_FREERTOS_PRIORITY - 1, NULL, 1); | ||
|  | #else
 | ||
|  |     xTaskCreate(&aes_task, "aes_task", TASK_STACK_SIZE, &exit_sema[0], UNITY_FREERTOS_PRIORITY - 1, NULL); | ||
|  |     xTaskCreate(&sha_task, "sha_task", TASK_STACK_SIZE, &exit_sema[1], UNITY_FREERTOS_PRIORITY - 1, NULL); | ||
|  |     xTaskCreate(&rsa_task, "rsa_task", TASK_STACK_SIZE, &exit_sema[2], UNITY_FREERTOS_PRIORITY - 1, NULL); | ||
|  | #endif
 | ||
|  | 
 | ||
|  |     ESP_LOGI(TAG, "Waiting for 10s ..."); | ||
|  |     vTaskDelay(10000 / portTICK_PERIOD_MS); | ||
|  | 
 | ||
|  |     // set exit flag to let thread exit
 | ||
|  |     exit_flag = true; | ||
|  |     for (int i = 0; i < max_tasks; ++i) { | ||
|  |         if (!xSemaphoreTake(exit_sema[i], 2000/portTICK_PERIOD_MS)) { | ||
|  |             TEST_FAIL_MESSAGE("exit_sema not released by test task"); | ||
|  |         } | ||
|  |         vSemaphoreDelete(exit_sema[i]); | ||
|  |     } | ||
|  | } |