kopia lustrzana https://github.com/espressif/esp-idf
437 wiersze
14 KiB
C
437 wiersze
14 KiB
C
/*
|
|
* SPDX-FileCopyrightText: 2010-2022 Espressif Systems (Shanghai) CO LTD
|
|
*
|
|
* SPDX-License-Identifier: Apache-2.0
|
|
*/
|
|
|
|
#include <stdio.h>
|
|
#include <string.h>
|
|
#include <inttypes.h>
|
|
#include "esp_sleep.h"
|
|
#include "soc/rtc_cntl_reg.h"
|
|
#include "soc/sens_reg.h"
|
|
#include "soc/rtc_periph.h"
|
|
#include "ulp_riscv.h"
|
|
#include "ulp_riscv_lock.h"
|
|
#include "ulp_test_app.h"
|
|
#include "ulp_test_app2.h"
|
|
#include "ulp_test_shared.h"
|
|
#include "unity.h"
|
|
#include <sys/time.h>
|
|
#include "freertos/FreeRTOS.h"
|
|
#include "freertos/task.h"
|
|
#include "freertos/semphr.h"
|
|
|
|
#define ULP_WAKEUP_PERIOD 1000000 // 1 second
|
|
|
|
// First ULP firmware
|
|
extern const uint8_t ulp_main_bin_start[] asm("_binary_ulp_test_app_bin_start");
|
|
extern const size_t ulp_main_bin_length asm("ulp_test_app_bin_length");
|
|
static bool firmware_loaded = false;
|
|
|
|
// Second ULP firmware
|
|
extern const uint8_t ulp_test_app2_bin_start[] asm("_binary_ulp_test_app2_bin_start");
|
|
extern const size_t ulp_test_app2_bin_length asm("ulp_test_app2_bin_length");
|
|
|
|
// Faulty ULP firmware
|
|
extern const uint8_t ulp_test_app3_bin_start[] asm("_binary_ulp_test_app3_bin_start");
|
|
extern const size_t ulp_test_app3_bin_length asm("ulp_test_app3_bin_length");
|
|
|
|
static void load_and_start_ulp_firmware(const uint8_t* ulp_bin, size_t ulp_bin_len)
|
|
{
|
|
if (!firmware_loaded) {
|
|
TEST_ASSERT(ulp_riscv_load_binary(ulp_bin, ulp_bin_len) == ESP_OK);
|
|
TEST_ASSERT(ulp_set_wakeup_period(0, ULP_WAKEUP_PERIOD) == ESP_OK);
|
|
TEST_ASSERT(ulp_riscv_run() == ESP_OK);
|
|
|
|
firmware_loaded = true;
|
|
printf("New ULP firmware loaded\n");
|
|
}
|
|
}
|
|
|
|
TEST_CASE("ULP-RISC-V and main CPU are able to exchange data", "[ulp]")
|
|
{
|
|
const uint32_t test_data = 0x12345678;
|
|
struct timeval start, end;
|
|
|
|
/* Load ULP RISC-V firmware and start the ULP RISC-V Coprocessor */
|
|
load_and_start_ulp_firmware(ulp_main_bin_start, ulp_main_bin_length);
|
|
|
|
/* Setup wakeup triggers */
|
|
TEST_ASSERT(esp_sleep_enable_ulp_wakeup() == ESP_OK);
|
|
|
|
/* Setup test data */
|
|
ulp_riscv_test_data_in = test_data ^ XOR_MASK;
|
|
ulp_main_cpu_command = RISCV_READ_WRITE_TEST;
|
|
|
|
/* Enter Light Sleep */
|
|
esp_light_sleep_start();
|
|
|
|
/* Wait till we receive the correct command response */
|
|
gettimeofday(&start, NULL);
|
|
while (ulp_command_resp != RISCV_READ_WRITE_TEST)
|
|
;
|
|
gettimeofday(&end, NULL);
|
|
printf("Response time %jd ms\n", ((intmax_t)end.tv_sec - (intmax_t)start.tv_sec) * 1000 + (end.tv_usec - start.tv_usec) / 1000);
|
|
|
|
/* Verify test data */
|
|
TEST_ASSERT(ulp_command_resp == RISCV_READ_WRITE_TEST);
|
|
TEST_ASSERT(ulp_main_cpu_reply == RISCV_COMMAND_OK);
|
|
printf("data out: 0x%" PRIx32 ", expected: 0x%" PRIx32 " \n", ulp_riscv_test_data_out, test_data);
|
|
TEST_ASSERT(test_data == ulp_riscv_test_data_out);
|
|
|
|
/* Clear test data */
|
|
ulp_main_cpu_command = RISCV_NO_COMMAND;
|
|
}
|
|
|
|
TEST_CASE("ULP-RISC-V is able to wakeup main CPU from light sleep", "[ulp]")
|
|
{
|
|
struct timeval start, end;
|
|
|
|
/* Load ULP RISC-V firmware and start the ULP RISC-V Coprocessor */
|
|
load_and_start_ulp_firmware(ulp_main_bin_start, ulp_main_bin_length);
|
|
|
|
/* Setup wakeup triggers */
|
|
TEST_ASSERT(esp_sleep_enable_ulp_wakeup() == ESP_OK);
|
|
|
|
/* Setup test data */
|
|
ulp_main_cpu_command = RISCV_LIGHT_SLEEP_WAKEUP_TEST;
|
|
|
|
/* Enter Light Sleep */
|
|
esp_light_sleep_start();
|
|
|
|
/* Wait till we receive the correct command response */
|
|
gettimeofday(&start, NULL);
|
|
while (ulp_command_resp != RISCV_LIGHT_SLEEP_WAKEUP_TEST)
|
|
;
|
|
gettimeofday(&end, NULL);
|
|
printf("Response time 1st: %jd ms\n", ((intmax_t)end.tv_sec - (intmax_t)start.tv_sec) * 1000 + (end.tv_usec - start.tv_usec) / 1000);
|
|
|
|
/* Verify test data */
|
|
TEST_ASSERT(ulp_command_resp == RISCV_LIGHT_SLEEP_WAKEUP_TEST);
|
|
TEST_ASSERT(ulp_main_cpu_reply == RISCV_COMMAND_OK);
|
|
|
|
/* Enter Light Sleep again */
|
|
esp_light_sleep_start();
|
|
|
|
/* Wait till we receive the correct command response */
|
|
gettimeofday(&start, NULL);
|
|
while (ulp_command_resp != RISCV_LIGHT_SLEEP_WAKEUP_TEST)
|
|
;
|
|
gettimeofday(&end, NULL);
|
|
printf("Response time 2nd: %jd ms\n", ((intmax_t)end.tv_sec - (intmax_t)start.tv_sec) * 1000 + (end.tv_usec - start.tv_usec) / 1000);
|
|
|
|
/* Verify test data */
|
|
TEST_ASSERT(ulp_command_resp == RISCV_LIGHT_SLEEP_WAKEUP_TEST);
|
|
TEST_ASSERT(ulp_main_cpu_reply == RISCV_COMMAND_OK);
|
|
|
|
/* Clear test data */
|
|
ulp_main_cpu_command = RISCV_NO_COMMAND;
|
|
}
|
|
|
|
static bool ulp_riscv_is_running(uint32_t *counter_variable)
|
|
{
|
|
uint32_t start_cnt = *counter_variable;
|
|
|
|
/* Wait a few ULP wakeup cycles to ensure ULP has run */
|
|
vTaskDelay((5 * ULP_WAKEUP_PERIOD / 1000) / portTICK_PERIOD_MS);
|
|
|
|
uint32_t end_cnt = *counter_variable;
|
|
printf("start run count: %" PRIu32 ", end run count %" PRIu32 "\n", start_cnt, end_cnt);
|
|
|
|
/* If the ulp is running the counter should have been incremented */
|
|
return (start_cnt != end_cnt);
|
|
}
|
|
|
|
TEST_CASE("ULP-RISC-V can be stopped and resumed from main CPU", "[ulp]")
|
|
{
|
|
/* Load ULP RISC-V firmware and start the ULP RISC-V Coprocessor */
|
|
load_and_start_ulp_firmware(ulp_main_bin_start, ulp_main_bin_length);
|
|
|
|
TEST_ASSERT(ulp_riscv_is_running(&ulp_riscv_counter));
|
|
|
|
printf("Stopping the ULP\n");
|
|
ulp_riscv_timer_stop();
|
|
ulp_riscv_halt();
|
|
|
|
TEST_ASSERT(!ulp_riscv_is_running(&ulp_riscv_counter));
|
|
|
|
printf("Resuming the ULP\n");
|
|
ulp_riscv_timer_resume();
|
|
|
|
TEST_ASSERT(ulp_riscv_is_running(&ulp_riscv_counter));
|
|
}
|
|
|
|
TEST_CASE("ULP-RISC-V can be loaded with and run multiple firmwares", "[ulp]")
|
|
{
|
|
/* Load ULP RISC-V firmware and start the ULP RISC-V Coprocessor */
|
|
load_and_start_ulp_firmware(ulp_main_bin_start, ulp_main_bin_length);
|
|
|
|
TEST_ASSERT(ulp_riscv_is_running(&ulp_riscv_counter));
|
|
|
|
printf("Stopping the ULP\n");
|
|
ulp_riscv_timer_stop();
|
|
ulp_riscv_halt();
|
|
|
|
TEST_ASSERT(!ulp_riscv_is_running(&ulp_riscv_counter));
|
|
|
|
printf("Loading second firmware on the ULP\n");
|
|
firmware_loaded = false;
|
|
load_and_start_ulp_firmware(ulp_test_app2_bin_start, ulp_test_app2_bin_length);
|
|
|
|
TEST_ASSERT(ulp_riscv_is_running(&ulp_riscv_counter2));
|
|
|
|
printf("Stopping the ULP\n");
|
|
ulp_riscv_timer_stop();
|
|
ulp_riscv_halt();
|
|
|
|
TEST_ASSERT(!ulp_riscv_is_running(&ulp_riscv_counter2));
|
|
|
|
printf("Loading the first firmware again on the ULP\n");
|
|
firmware_loaded = false;
|
|
load_and_start_ulp_firmware(ulp_main_bin_start, ulp_main_bin_length);
|
|
|
|
TEST_ASSERT(ulp_riscv_is_running(&ulp_riscv_counter));
|
|
}
|
|
|
|
TEST_CASE("ULP-RISC-V can be reloaded with a good fimware after a crash", "[ulp]")
|
|
{
|
|
/* Load ULP RISC-V firmware and start the ULP RISC-V Coprocessor */
|
|
load_and_start_ulp_firmware(ulp_main_bin_start, ulp_main_bin_length);
|
|
|
|
TEST_ASSERT(ulp_riscv_is_running(&ulp_riscv_counter));
|
|
|
|
printf("Stopping the ULP\n");
|
|
ulp_riscv_timer_stop();
|
|
ulp_riscv_halt();
|
|
|
|
TEST_ASSERT(!ulp_riscv_is_running(&ulp_riscv_counter));
|
|
|
|
/* Enable ULP wakeup */
|
|
TEST_ASSERT(esp_sleep_enable_ulp_wakeup() == ESP_OK);
|
|
|
|
printf("Loading faulty firmware on the ULP and go into light sleep\n");
|
|
firmware_loaded = false;
|
|
load_and_start_ulp_firmware(ulp_test_app3_bin_start, ulp_test_app3_bin_length);
|
|
esp_light_sleep_start();
|
|
|
|
/* Verify that main CPU wakes up by a COCPU trap signal trigger */
|
|
esp_sleep_wakeup_cause_t cause = esp_sleep_get_wakeup_cause();
|
|
TEST_ASSERT(cause != ESP_SLEEP_WAKEUP_COCPU);
|
|
|
|
printf("Resetting the ULP\n");
|
|
ulp_riscv_reset();
|
|
|
|
esp_rom_delay_us(20);
|
|
|
|
printf("Loading the good firmware on ULP\n");
|
|
firmware_loaded = false;
|
|
load_and_start_ulp_firmware(ulp_main_bin_start, ulp_main_bin_length);
|
|
|
|
TEST_ASSERT(ulp_riscv_is_running(&ulp_riscv_counter));
|
|
}
|
|
|
|
TEST_CASE("ULP-RISC-V can stop itself and be resumed from the main CPU", "[ulp]")
|
|
{
|
|
volatile riscv_test_commands_t *command_resp = (riscv_test_commands_t*)&ulp_command_resp;
|
|
|
|
/* Load ULP RISC-V firmware and start the ULP RISC-V Coprocessor */
|
|
load_and_start_ulp_firmware(ulp_main_bin_start, ulp_main_bin_length);
|
|
|
|
TEST_ASSERT(ulp_riscv_is_running(&ulp_riscv_counter));
|
|
|
|
printf("Stopping the ULP\n");
|
|
/* Setup test data */
|
|
ulp_main_cpu_command = RISCV_STOP_TEST;
|
|
|
|
while (*command_resp != RISCV_STOP_TEST) {
|
|
}
|
|
|
|
/* Wait a bit to ensure ULP finished shutting down */
|
|
vTaskDelay(100 / portTICK_PERIOD_MS);
|
|
|
|
TEST_ASSERT(!ulp_riscv_is_running(&ulp_riscv_counter));
|
|
|
|
printf("Resuming the ULP\n");
|
|
ulp_main_cpu_command = RISCV_NO_COMMAND;
|
|
ulp_riscv_timer_resume();
|
|
|
|
TEST_ASSERT(ulp_riscv_is_running(&ulp_riscv_counter));
|
|
}
|
|
|
|
|
|
|
|
TEST_CASE("ULP-RISC-V mutex", "[ulp]")
|
|
{
|
|
/* Load ULP RISC-V firmware and start the ULP RISC-V Coprocessor */
|
|
load_and_start_ulp_firmware(ulp_main_bin_start, ulp_main_bin_length);
|
|
|
|
/* Setup test data */
|
|
ulp_riscv_incrementer = 0;
|
|
ulp_main_cpu_reply = RISCV_NO_COMMAND;
|
|
ulp_main_cpu_command = RISCV_MUTEX_TEST;
|
|
|
|
ulp_riscv_lock_t *lock = (ulp_riscv_lock_t*)&ulp_lock;
|
|
|
|
for (int i = 0; i < MUTEX_TEST_ITERATIONS; i++) {
|
|
ulp_riscv_lock_acquire(lock);
|
|
ulp_riscv_incrementer++;
|
|
ulp_riscv_lock_release(lock);
|
|
}
|
|
|
|
while(ulp_main_cpu_reply != RISCV_COMMAND_OK) {
|
|
// Wait for ULP to finish
|
|
}
|
|
|
|
/* If the variable is protected there should be no race conditions
|
|
results should be the sum of increments made by ULP and by main CPU
|
|
*/
|
|
TEST_ASSERT_EQUAL(2*MUTEX_TEST_ITERATIONS, ulp_riscv_incrementer);
|
|
}
|
|
|
|
|
|
static void do_ulp_wakeup_deepsleep(riscv_test_commands_t ulp_cmd, bool rtc_periph_pd)
|
|
{
|
|
if (!rtc_periph_pd) {
|
|
// Force RTC peripheral power domain to be on
|
|
esp_sleep_pd_config(ESP_PD_DOMAIN_RTC_PERIPH, ESP_PD_OPTION_ON);
|
|
}
|
|
|
|
/* Load ULP RISC-V firmware and start the ULP RISC-V Coprocessor */
|
|
load_and_start_ulp_firmware(ulp_main_bin_start, ulp_main_bin_length);
|
|
|
|
/* Setup wakeup triggers */
|
|
TEST_ASSERT(esp_sleep_enable_ulp_wakeup() == ESP_OK);
|
|
|
|
/* Setup test data */
|
|
ulp_main_cpu_command = ulp_cmd;
|
|
|
|
/* Enter Deep Sleep */
|
|
esp_deep_sleep_start();
|
|
UNITY_TEST_FAIL(__LINE__, "Should not get here!");
|
|
}
|
|
|
|
static void check_reset_reason_ulp_wakeup(void)
|
|
{
|
|
TEST_ASSERT_EQUAL(ESP_SLEEP_WAKEUP_ULP, esp_sleep_get_wakeup_cause());
|
|
}
|
|
|
|
static void do_ulp_wakeup_after_long_delay_deepsleep(void)
|
|
{
|
|
do_ulp_wakeup_deepsleep(RISCV_DEEP_SLEEP_WAKEUP_LONG_DELAY_TEST, true);
|
|
}
|
|
|
|
/* Certain erroneous wake-up triggers happen only after sleeping for a few seconds */
|
|
TEST_CASE_MULTIPLE_STAGES("ULP-RISC-V is able to wakeup main CPU from deep sleep after a long delay", "[ulp]",
|
|
do_ulp_wakeup_after_long_delay_deepsleep,
|
|
check_reset_reason_ulp_wakeup);
|
|
|
|
|
|
static void do_ulp_wakeup_after_long_delay_deepsleep_rtc_perip_on(void)
|
|
{
|
|
do_ulp_wakeup_deepsleep(RISCV_DEEP_SLEEP_WAKEUP_LONG_DELAY_TEST, false);
|
|
}
|
|
|
|
TEST_CASE_MULTIPLE_STAGES("ULP-RISC-V is able to wakeup main CPU from deep sleep after a long delay, RTC periph powerup", "[ulp]",
|
|
do_ulp_wakeup_after_long_delay_deepsleep_rtc_perip_on,
|
|
check_reset_reason_ulp_wakeup);
|
|
|
|
static void do_ulp_wakeup_after_short_delay_deepsleep(void)
|
|
{
|
|
do_ulp_wakeup_deepsleep(RISCV_DEEP_SLEEP_WAKEUP_SHORT_DELAY_TEST, true);
|
|
}
|
|
|
|
TEST_CASE_MULTIPLE_STAGES("ULP-RISC-V is able to wakeup main CPU from deep sleep after a short delay", "[ulp]",
|
|
do_ulp_wakeup_after_short_delay_deepsleep,
|
|
check_reset_reason_ulp_wakeup);
|
|
|
|
|
|
static void do_ulp_wakeup_after_short_delay_deepsleep_rtc_perip_on(void)
|
|
{
|
|
do_ulp_wakeup_deepsleep(RISCV_DEEP_SLEEP_WAKEUP_SHORT_DELAY_TEST, false);
|
|
}
|
|
|
|
TEST_CASE_MULTIPLE_STAGES("ULP-RISC-V is able to wakeup main CPU from deep sleep after a short delay, RTC periph powerup", "[ulp]",
|
|
do_ulp_wakeup_after_short_delay_deepsleep_rtc_perip_on,
|
|
check_reset_reason_ulp_wakeup);
|
|
|
|
typedef struct {
|
|
SemaphoreHandle_t ulp_isr_sw_sem;
|
|
SemaphoreHandle_t ulp_isr_trap_sem;
|
|
} TestSemaphore_t;
|
|
|
|
static void ulp_riscv_isr(void *arg)
|
|
{
|
|
BaseType_t yield = 0;
|
|
TestSemaphore_t *sem = (TestSemaphore_t *)arg;
|
|
|
|
uint32_t status = READ_PERI_REG(RTC_CNTL_INT_ST_REG);
|
|
|
|
if (status & ULP_RISCV_SW_INT) {
|
|
xSemaphoreGiveFromISR(sem->ulp_isr_sw_sem, &yield);
|
|
} else if (status & ULP_RISCV_TRAP_INT) {
|
|
xSemaphoreGiveFromISR(sem->ulp_isr_trap_sem, &yield);
|
|
}
|
|
|
|
if (yield) {
|
|
portYIELD_FROM_ISR();
|
|
}
|
|
}
|
|
|
|
TEST_CASE("ULP-RISC-V interrupt signals can be handled via ISRs on the main core", "[ulp]")
|
|
{
|
|
/* Create test semaphores */
|
|
TestSemaphore_t test_sem_cfg;
|
|
|
|
test_sem_cfg.ulp_isr_sw_sem = xSemaphoreCreateBinary();
|
|
TEST_ASSERT_NOT_NULL(test_sem_cfg.ulp_isr_sw_sem);
|
|
|
|
test_sem_cfg.ulp_isr_trap_sem = xSemaphoreCreateBinary();
|
|
TEST_ASSERT_NOT_NULL(test_sem_cfg.ulp_isr_trap_sem);
|
|
|
|
/* Register ULP RISC-V signal ISR */
|
|
TEST_ASSERT_EQUAL(ESP_OK, ulp_riscv_isr_register(ulp_riscv_isr, (void *)&test_sem_cfg,
|
|
(ULP_RISCV_SW_INT | ULP_RISCV_TRAP_INT)));
|
|
|
|
/* Load ULP RISC-V firmware and start the ULP RISC-V Coprocessor */
|
|
printf("Loading good ULP firmware\n");
|
|
firmware_loaded = false;
|
|
load_and_start_ulp_firmware(ulp_main_bin_start, ulp_main_bin_length);
|
|
|
|
/* Setup test data. We only need the ULP to send a wakeup signal to the main CPU. */
|
|
ulp_main_cpu_command = RISCV_READ_WRITE_TEST;
|
|
|
|
/* Wait for the ISR to be called */
|
|
printf("Waiting for ULP wakeup signal ...\n");
|
|
TEST_ASSERT_EQUAL(pdTRUE, xSemaphoreTake(test_sem_cfg.ulp_isr_sw_sem, portMAX_DELAY));
|
|
printf("ULP wakeup signal interrupt triggered\n");
|
|
|
|
/* Reset the ULP command */
|
|
ulp_main_cpu_command = RISCV_NO_COMMAND;
|
|
|
|
/* Load ULP RISC-V with faulty firmware and restart the ULP RISC-V Coprocessor.
|
|
* This should cause a cocpu trap signal interrupt.
|
|
*/
|
|
printf("Loading faulty ULP firmware\n");
|
|
firmware_loaded = false;
|
|
load_and_start_ulp_firmware(ulp_test_app3_bin_start, ulp_test_app3_bin_length);
|
|
|
|
/* Wait for the ISR to be called */
|
|
printf("Waiting for ULP trap signal ...\n");
|
|
TEST_ASSERT_EQUAL(pdTRUE, xSemaphoreTake(test_sem_cfg.ulp_isr_trap_sem, portMAX_DELAY));
|
|
printf("ULP trap signal interrupt triggered\n");
|
|
|
|
/* Deregister the ISR */
|
|
TEST_ASSERT_EQUAL(ESP_OK, ulp_riscv_isr_deregister(ulp_riscv_isr, (void *)&test_sem_cfg,
|
|
(ULP_RISCV_SW_INT | ULP_RISCV_TRAP_INT)));
|
|
|
|
/* Delete test semaphores */
|
|
vSemaphoreDelete(test_sem_cfg.ulp_isr_sw_sem);
|
|
vSemaphoreDelete(test_sem_cfg.ulp_isr_trap_sem);
|
|
|
|
/* Make sure ULP has a good firmware running before exiting the test */
|
|
ulp_riscv_reset();
|
|
firmware_loaded = false;
|
|
load_and_start_ulp_firmware(ulp_main_bin_start, ulp_main_bin_length);
|
|
}
|