From d462dc1bd6657b29b66a94a4e8be138e38d41522 Mon Sep 17 00:00:00 2001 From: Sadeep Madurange Date: Sat, 3 May 2025 07:27:42 +0800 Subject: Move print config to separate function. --- main.c | 28 +++++++++++++++++----------- 1 file changed, 17 insertions(+), 11 deletions(-) (limited to 'main.c') diff --git a/main.c b/main.c index bfebf23..6f351f4 100644 --- a/main.c +++ b/main.c @@ -31,23 +31,13 @@ static inline void uart_write(const char *s) Soft_UART_send_byte('\n'); } -int main(void) +static inline void print_config(void) { const int SLEN = 25; char s[SLEN]; struct fpm_config cfg; - cli(); - Soft_UART_init(); - bit_set(DDRB,5); - sei(); - - if (fpm_init()) - uart_write("FPM detected"); - else - uart_write("FPM not detected"); - if (fpm_get_config(&cfg)) { uart_write("FPM config:"); snprintf(s, SLEN, "\tstatus: 0x%02X", cfg.status); @@ -89,6 +79,22 @@ int main(void) else if (cfg.baud == 12) uart_write("\tbaud: 115200"); } +} + +int main(void) +{ + cli(); + Soft_UART_init(); + bit_set(DDRB,5); + sei(); + + if (fpm_init()) { + uart_write("FPM detected"); + print_config(); + } + else + uart_write("FPM not detected"); + while (1) { -- cgit v1.2.3