// required-features: stop,chrono

#![no_std]
#![no_main]
#[path = "../common.rs"]
mod common;

use chrono::NaiveDate;
use common::*;
use embassy_executor::Spawner;
use embassy_stm32::low_power::{StopMode, stop_ready};
use embassy_stm32::rcc::LsConfig;
use embassy_stm32::rtc::Rtc;
use embassy_stm32::{Config, low_power};
use embassy_time::Timer;

#[embassy_executor::task]
async fn task_1() {
    for _ in 0..9 {
        info!("task 1: waiting for 500ms...");
        defmt::assert!(stop_ready(StopMode::Stop2));
        Timer::after_millis(500).await;
    }
}

#[embassy_executor::task]
async fn task_2() {
    for _ in 0..5 {
        info!("task 2: waiting for 1000ms...");
        defmt::assert!(stop_ready(StopMode::Stop2));
        Timer::after_millis(1000).await;
    }

    info!("Test OK");
    cortex_m::asm::bkpt();
}

#[embassy_executor::main(executor = "low_power::Executor")]
async fn async_main(spawner: Spawner) {
    let _ = config();

    let mut config = Config::default();
    config.rcc.ls = LsConfig::default_lse();
    config.rtc._disable_rtc = false;

    // System Clock seems cannot be greater than 16 MHz
    #[cfg(any(feature = "stm32h563zi", feature = "stm32h503rb"))]
    {
        use embassy_stm32::rcc::HSIPrescaler;
        config.rcc.hsi = Some(HSIPrescaler::DIV4); // 64 MHz HSI will need a /4
    }

    let p = init_with_config(config);
    info!("Hello World!");

    let now = NaiveDate::from_ymd_opt(2020, 5, 15)
        .unwrap()
        .and_hms_opt(10, 30, 15)
        .unwrap();

    let (rtc, _time_provider) = Rtc::new(p.RTC);

    critical_section::with(|cs| {
        rtc.borrow_mut(cs).set_datetime(now.into()).expect("datetime not set");
    });

    spawner.spawn(task_1().unwrap());
    spawner.spawn(task_2().unwrap());
}