124 lines
3.8 KiB
C++
124 lines
3.8 KiB
C++
/*
|
|
* Copyright (C) 2020 Max Regan
|
|
*
|
|
* Permission is hereby granted, free of charge, to any person obtaining a copy
|
|
* of this software and associated documentation files (the "Software"), to deal
|
|
* in the Software without restriction, including without limitation the rights
|
|
* to use, copy, modify, merge, publish, distribute, sublicense, and/or sell
|
|
* copies of the Software, and to permit persons to whom the Software is
|
|
* furnished to do so, subject to the following conditions:
|
|
* The above copyright notice and this permission notice shall be included in
|
|
* all copies or substantial portions of the Software.
|
|
*
|
|
* THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
|
|
* IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
|
|
* FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL THE
|
|
* AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER
|
|
* LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM,
|
|
* OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN
|
|
* THE SOFTWARE.
|
|
*/
|
|
|
|
#include <cinttypes>
|
|
#include "printf.h"
|
|
|
|
#include "Bsp/Drivers/GpioDriver.h"
|
|
#include "Bsp/Drivers/RtcDriver.h"
|
|
#include "Bsp/Drivers/UsartDriver.h"
|
|
#include "Bsp/Drivers/LowPower.h"
|
|
#include "Bsp/LowPowerTaskScheduler.h"
|
|
#include "Bsp/macros.h"
|
|
|
|
#include "test.h"
|
|
|
|
#include "Mcu.h"
|
|
|
|
using BSP::Time;
|
|
using BSP::ReturnCode;
|
|
using BSP::SystemTimer;
|
|
using BSP::time_t;
|
|
|
|
static BSP::Schedule::LowPowerTaskScheduler<1> g_sched;
|
|
#if defined(BOARD_WATCH)
|
|
static BSP::UsartDriver g_test_uart(USART2, g_sched);
|
|
#elif defined(BOARD_DEVBOARD)
|
|
static BSP::UsartDriver g_test_uart(USART1, g_sched);
|
|
#endif
|
|
static BSP::GpioDriver g_gpioa(GPIOA);
|
|
static BSP::GpioPin g_test_pin(g_gpioa, 6);
|
|
|
|
static time_t get_time() {
|
|
time_t time;
|
|
ReturnCode rc = SystemTimer::get_time(time);
|
|
if (rc != ReturnCode::OK) {
|
|
g_test_uart.tx_blocking("Failed while getting the time\r\n");
|
|
g_test_uart.tx_blocking(test_fail_text);
|
|
TEST_SPIN();
|
|
}
|
|
return time;
|
|
}
|
|
|
|
static void stop_for(time_t delay) {
|
|
|
|
ReturnCode rc = BSP::RtcDriver::set_wakeup_in(delay);
|
|
if (rc != ReturnCode::OK) {
|
|
g_test_uart.tx_blocking("Failed to set wakeup delay\r\n");
|
|
g_test_uart.tx_blocking(test_fail_text);
|
|
TEST_SPIN();
|
|
}
|
|
|
|
|
|
uint32_t pre_wakeups = BSP::RtcDriver::get_wakeup_count();
|
|
uint32_t pre_alarms = BSP::RtcDriver::get_alarm_count();
|
|
time_t before = get_time();
|
|
|
|
while (pre_wakeups == BSP::RtcDriver::get_wakeup_count()) {
|
|
BSP::LowPower::stop();
|
|
}
|
|
|
|
time_t after = get_time();
|
|
uint32_t post_wakeups = BSP::RtcDriver::get_wakeup_count();
|
|
uint32_t post_alarms = BSP::RtcDriver::get_alarm_count();
|
|
|
|
static char buffer[128] = { 0 };
|
|
snprintf(buffer, sizeof(buffer),
|
|
"Requested=%" PRIu32 " Actual=%" PRIu32
|
|
" Wakeups=%" PRId32 " Alarms=%" PRId32 "\r\n",
|
|
(uint32_t) Time::to_millis(delay),
|
|
(uint32_t) Time::to_millis(after - before),
|
|
post_wakeups - pre_wakeups,
|
|
post_alarms - pre_alarms);
|
|
|
|
g_test_uart.tx_blocking(buffer);
|
|
}
|
|
|
|
[[noreturn]] void main() {
|
|
|
|
BSP::RtcDriver::init();
|
|
SystemTimer::set_timer(BSP::RtcDriver::get_system_timer());
|
|
BSP::LowPower::init();
|
|
|
|
g_gpioa.enable();
|
|
g_test_pin.configure_alternate_function(1);
|
|
g_test_uart.init();
|
|
|
|
g_test_uart.tx_blocking(test_start_text);
|
|
|
|
for (uint32_t i = 0; i <= 1000; i++) {
|
|
stop_for(Time::millis(5));
|
|
}
|
|
|
|
for (uint32_t delay_millis = 1; delay_millis <= 1024; delay_millis *= 2) {
|
|
stop_for(Time::millis(delay_millis));
|
|
}
|
|
|
|
stop_for(Time::seconds(1));
|
|
stop_for(Time::seconds(2));
|
|
stop_for(Time::seconds(4));
|
|
stop_for(Time::seconds(60));
|
|
|
|
g_test_uart.tx_blocking(test_pass_text);
|
|
|
|
TEST_SPIN();
|
|
}
|