From 6dd4f30eb7b647bccf089477ab7690a01b68c4b5 Mon Sep 17 00:00:00 2001
From: John Tsiombikas <nuclear@member.fsf.org>
Date: Fri, 8 Jan 2021 03:47:23 +0200
Subject: [PATCH] firmware

---
 fw/src/main.c |   24 +++++++++++++++++++++++-
 1 file changed, 23 insertions(+), 1 deletion(-)

diff --git a/fw/src/main.c b/fw/src/main.c
index e658870..a5d7900 100644
--- a/fw/src/main.c
+++ b/fw/src/main.c
@@ -197,10 +197,32 @@ static void proc_cmd(char *input)
 
 static void update_display(void)
 {
+	show_number(number);
 }
 
-static void show_number(uint32_t xnum)
+static void set_digit(int idx, unsigned int d)
 {
+	int i;
+	unsigned int clkbit = 1 << idx;
+
+	for(i=0; i<8; i++) {
+		PORTC = (PORTC & 0xfe) | (d >> 7);
+		PORTB = (PORTB & 0xf8) | clkbit;
+		PORTB &= 0xf8;
+		d <<= 1;
+	}
+}
+
+static void show_number(uint32_t n)
+{
+	int i, d;
+
+	for(i=0; i<6; i++) {
+		d = n % 10;
+		n /= 10;
+
+		set_digit(i, d);
+	}
 }
 
 static void setclock(int hr, int min, int sec)
-- 
1.7.10.4