From 64045ba0916623ab9e7c2f1eed837a2aae081e63 Mon Sep 17 00:00:00 2001
From: Leo C
Date: Fri, 11 Jul 2014 17:14:53 +0200
Subject: Refactor Tupfiles

---
 avr/z180-stamp-avr.c | 73 ++++++++++++++--------------------------------------
 1 file changed, 19 insertions(+), 54 deletions(-)

(limited to 'avr/z180-stamp-avr.c')

diff --git a/avr/z180-stamp-avr.c b/avr/z180-stamp-avr.c
index 4ea4d47..6871027 100644
--- a/avr/z180-stamp-avr.c
+++ b/avr/z180-stamp-avr.c
@@ -22,52 +22,16 @@
 #undef const
 
 #define FLASH __flash
-//#define FLASH 
 
 #define ESCCHAR		('^'-0x40)
 
 #define S_10MS_TO	(1<<0)
 
 
-volatile int_fast8_t timeout_1s;
-volatile uint_least8_t Stat;
+static volatile int_fast8_t timeout_1s;
+static volatile uint_least8_t Stat;
 
 
-/****************************************************************/
-
-#define P_ADL		PORTA
-#define P_ADH		PORTC
-#define P_ADB		PORTE
-#define PIN_ADB		PINE
-
-#define ADB_WIDTH	3
-#define ADB_SHIFT	2
-//#define ADB_PORT	GPIOE
-
-#define MASK(n)	((1<<(n))-1)
-#define SMASK(w,s) (MASK(w) << (s))
-
-typedef union {
-	uint32_t l;
-	uint16_t w[2];
-	uint8_t b[4];
-} addr_t;
- 
-
-
-void z80_setaddress(uint32_t addr)
-{
-	addr_t x;
-
-	x.l = addr;
-	P_ADL = x.b[0];
-	P_ADH = x.b[1];
-	PIN_ADB = ((x.b[2] << ADB_SHIFT) ^ P_ADB) & MASK(ADB_WIDTH) << ADB_SHIFT ;
-
-}
-
-/****************************************************************/
-
 /*--------------------------------------------------------------------------*/
 
 
@@ -82,10 +46,7 @@ void sys_tick_handler(void)
 	if (tick_10ms == 10)
 	{
 		Stat |= S_10MS_TO;
-
 		tick_10ms = 0;
-		
-		
 		/* Drive timer procedure of low level disk I/O module */
 		//disk_timerproc();
 	}
@@ -101,6 +62,10 @@ void sys_tick_handler(void)
 }
 
 
+static void do_10ms(void) 
+{
+}
+
 /*--------------------------------------------------------------------------*/
 
 static uint32_t z80_sram_cmp(uint32_t addr, uint32_t length, uint8_t wval, int inc)
@@ -108,7 +73,7 @@ static uint32_t z80_sram_cmp(uint32_t addr, uint32_t length, uint8_t wval, int i
 	uint8_t rval;
 	int_fast8_t errors = 0;
 	
-	DBG_P(1, "SRAM: Check %#.5x byte... ", length);
+	DBG_P(1, "SRAM: Check 0x%.5lX byte... ", length);
 	while (length--) {
 		if ((rval = z80_read(addr)) != wval) {
 			if (errors == 0) { 
@@ -176,6 +141,8 @@ const char * const qbcat = "Zhe quick brown fox jumps over the lazy cat!";
 
 #endif
 
+/*--------------------------------------------------------------------------*/
+
 uint8_t z80_get_byte(uint32_t adr)
 {
 	uint8_t data;
@@ -187,13 +154,6 @@ uint8_t z80_get_byte(uint32_t adr)
 	return data;
 }
 
-
-/*--------------------------------------------------------------------------*/
-
-static void do_10ms(void) 
-{
-}
-
 /*--------------------------------------------------------------------------*/
 
 struct msg_item {
@@ -202,6 +162,7 @@ struct msg_item {
 	void (*func)(uint8_t, int, uint8_t *);
 };
 
+static
 uint32_t msg_to_addr(uint8_t *msg)
 {
 	union {
@@ -217,6 +178,7 @@ uint32_t msg_to_addr(uint8_t *msg)
 	return addr.as32;
 }
 
+static
 void do_msg_ini_msgfifo(uint8_t subf, int len, uint8_t * msg)
 {
 	(void)subf; (void)len;
@@ -225,6 +187,7 @@ void do_msg_ini_msgfifo(uint8_t subf, int len, uint8_t * msg)
 }
 
 
+static
 void do_msg_ini_memfifo(uint8_t subf, int len, uint8_t * msg)
 {
 	(void)len;
@@ -233,6 +196,7 @@ void do_msg_ini_memfifo(uint8_t subf, int len, uint8_t * msg)
 }
 
 
+static
 void do_msg_char_out(uint8_t subf, int len, uint8_t * msg)
 {
 	(void)subf;
@@ -242,6 +206,7 @@ void do_msg_char_out(uint8_t subf, int len, uint8_t * msg)
 }
 
 
+static
 const FLASH struct msg_item z80_messages[] =
 {
 	{ 0,			/* fct nr. */
@@ -260,8 +225,7 @@ const FLASH struct msg_item z80_messages[] =
 };
 
 
-
-
+static
 void do_message(int len, uint8_t *msg)
 {
 	uint8_t fct, sub_fct;
@@ -303,9 +267,10 @@ void do_message(int len, uint8_t *msg)
 }
 
 
-
+//TODO:
 #define CTRBUF_LEN 256
 
+static
 void check_msg_fifo(void)
 {
 	int ch;
@@ -344,6 +309,7 @@ void check_msg_fifo(void)
 }
 
 
+static
 void z80_load_mem(void)
 {
 	unsigned sec = 0;
@@ -364,6 +330,7 @@ void z80_load_mem(void)
 		sec++;
 	}
 }
+
 /*--------------------------------------------------------------------------*/
 
 int main(void)
@@ -373,7 +340,6 @@ int main(void)
 
 //	setvbuf(stdout, NULL, _IONBF, 0);
 	serial_setup();
-//	printf("\n(STM32F100+HD64180)_stamp Tester\n");
 	printf("\n(ATMEGA1281+HD64180)_stamp Tester\n");
 
 	DBG_P(1, "z80_setup_bus... ");
@@ -381,7 +347,6 @@ int main(void)
 	z80_setup_bus();
 	DBG_P(1, "done.\n");
 
-
 	DBG_P(1, "Get bus... ");
 	z80_busreq(LOW);
 	z80_reset(HIGH);
-- 
cgit v1.2.3