#![no_main]
#![no_std]

extern crate cortex_m_rt;
extern crate embedded_types;
extern crate s32k144;
extern crate s32k144evb;

use cortex_m_rt::entry;

use embedded_types::io::Read;
use embedded_types::io::Write;

use s32k144evb::{spc, wdog};

use s32k144evb::pcc::{self, Pcc};

#[entry]
fn main() -> ! {
    let peripherals = s32k144::Peripherals::take().unwrap();

    let mut wdog_settings = wdog::WatchdogSettings::default();
    wdog_settings.enable = false;
    let _wdog = wdog::Watchdog::init(&peripherals.WDOG, wdog_settings);

    let pc_config = spc::Config {
        system_oscillator: spc::SystemOscillatorInput::Crystal(8_000_000),
        soscdiv2: spc::SystemOscillatorOutput::Div1,
        ..Default::default()
    };

    let spc = spc::Spc::init(
        &peripherals.SCG,
        &peripherals.SMC,
        &peripherals.PMC,
        pc_config,
    )
    .unwrap();

    let pcc = Pcc::init(&peripherals.PCC);
    let _pcc_lpuart1 = pcc.enable_lpuart1(pcc::ClockSource::Soscdiv2).unwrap();
    let _pcc_portc = pcc.enable_portc().unwrap();

    let portc = peripherals.PORTC;
    portc.pcr6.modify(|_, w| w.mux()._010());
    portc.pcr7.modify(|_, w| w.mux()._010());

    let mut console = s32k144evb::console::LpuartConsole::init(&peripherals.LPUART1, &spc);

    writeln!(console, "Please write something").unwrap();
    let mut buf = [0u8; 64];
    let chars = console.read_until(b'\n', &mut buf).unwrap();

    writeln!(
        console,
        "Your wrote: \"{}\"",
        core::str::from_utf8(&buf[0..chars]).unwrap()
    )
    .unwrap();

    writeln!(
        console,
        "Next a panic will be demonstrated by overflowing an integer"
    )
    .unwrap();
    let mut i: u8 = 0;

    loop {
        writeln!(console, "I count: {}", i).unwrap();
        i += 1;
    }
}