From bf08c90e746efbe0dfa1aabc6af27282566b5409 Mon Sep 17 00:00:00 2001
From: Ben Gras <ben@minix3.org>
Date: Fri, 23 Feb 2007 18:21:19 +0000
Subject: [PATCH] Slew of debugging / sanity check features.

---
 drivers/at_wini/at_wini.c | 87 +++++++++++++++++++++++++++++++++++++--
 1 file changed, 83 insertions(+), 4 deletions(-)

diff --git a/drivers/at_wini/at_wini.c b/drivers/at_wini/at_wini.c
index a24c358e5..f2f100cda 100644
--- a/drivers/at_wini/at_wini.c
+++ b/drivers/at_wini/at_wini.c
@@ -378,6 +378,30 @@ FORWARD _PROTOTYPE( int atapi_transfer, (int proc_nr, int opcode,
 #define panic(f,m,n) at_panic(__LINE__, (f), (m), (n))
 FORWARD _PROTOTYPE( void at_panic, (int line, char *h, char *msg, int n));
 
+#define sys_voutb(out, n) at_voutb(__LINE__, (out), (n))
+FORWARD _PROTOTYPE( int at_voutb, (int line, pvb_pair_t *, int n));
+#define sys_vinb(in, n) at_vinb(__LINE__, (in), (n))
+FORWARD _PROTOTYPE( int at_vinb, (int line, pvb_pair_t *, int n));
+
+#undef sys_outb
+#undef sys_inb
+#undef sys_outw
+#undef sys_inw
+#undef sys_outl
+#undef sys_inl
+
+FORWARD _PROTOTYPE( int at_out, (int line, u32_t port, u32_t value,
+	char *typename, int type));
+FORWARD _PROTOTYPE( int at_in, (int line, u32_t port, u32_t *value,
+	char *typename, int type));
+
+#define sys_outb(p, v) at_out(__LINE__, (p), (v), "outb", _DIO_BYTE)
+#define sys_inb(p, v) at_in(__LINE__, (p), (v), "inb", _DIO_BYTE)
+#define sys_outw(p, v) at_out(__LINE__, (p), (v), "outw", _DIO_WORD)
+#define sys_inw(p, v) at_in(__LINE__, (p), (v), "inw", _DIO_WORD)
+#define sys_outl(p, v) at_out(__LINE__, (p), (v), "outl", _DIO_LONG)
+#define sys_inl(p, v) at_in(__LINE__, (p), (v), "inl", _DIO_LONG)
+
 /* Entry points to this driver. */
 PRIVATE struct driver w_dtab = {
   w_name,		/* current device's name */
@@ -442,6 +466,9 @@ PRIVATE void init_params()
 
   w_identify_wakeup_ticks = wakeup_secs * HZ;
 
+  if(atapi_debug)
+	panic("at_wini", "atapi_debug", NO_NUM);
+
   if(w_identify_wakeup_ticks <= 0) {
 	printf("changing wakeup from %d to %d ticks.\n",
 		w_identify_wakeup_ticks, WAKEUP_TICKS);
@@ -633,6 +660,9 @@ PRIVATE void init_params_pci(int skip)
 
   	base_dma = pci_attr_r32(devind, PCI_BAR_5) & 0xfffffffc;
 
+	printf("at_wini%d: dev %d: base_dma = %x\n",
+		w_instance, devind, base_dma);
+
   	/* Primary channel not in compatability mode? */
   	if (raid || (interface & ATA_IF_NOTCOMPAT1)) {
   		u32_t base_cmd, base_ctl;
@@ -2636,15 +2666,64 @@ PRIVATE int atapi_intr_wait()
 
 #endif /* ENABLE_ATAPI */
 
-#undef panic
+#undef sys_voutb
+#undef sys_vinb
+
+PRIVATE int at_voutb(int line, pvb_pair_t *pvb, int n)
+{
+  int s, i;
+  if ((s=sys_voutb(pvb,n)) == OK)
+	return OK;
+  printf("at_wini%d: sys_voutb failed: %d pvb (%d):\n", w_instance, s, n);
+  for(i = 0; i < n; i++)
+	printf("%2d: %4x -> %4x\n", i, pvb[i].value, pvb[i].port);
+  panic(w_name(), "sys_voutb failed", NO_NUM);
+}
+
+PRIVATE int at_vinb(int line, pvb_pair_t *pvb, int n)
+{
+  int s, i;
+  if ((s=sys_vinb(pvb,n)) == OK)
+	return OK;
+  printf("at_wini%d: sys_vinb failed: %d pvb (%d):\n", w_instance, s, n);
+  for(i = 0; i < n; i++)
+	printf("%2d: %4x\n", i, pvb[i].port);
+  panic(w_name(), "sys_vinb failed", NO_NUM);
+}
 
+PRIVATE int at_out(int line, u32_t port, u32_t value,
+	char *typename, int type)
+{
+	int s;
+	s = sys_out(port, value, type);
+	if(s == OK)
+		return OK;
+	printf("at_wini%d: line %d: %s failed: %d; %x -> %x\n", 
+		w_instance, line, typename, s, value, port);
+        panic(w_name(), "sys_out failed", NO_NUM);
+}
+
+
+PRIVATE int at_in(int line, u32_t port, u32_t *value,
+	char *typename, int type)
+{
+	int s;
+	s = sys_in(port, value, type);
+	if(s == OK)
+		return OK;
+	printf("at_wini%d: line %d: %s failed: %d; port %x\n", 
+		w_instance, line, typename, s, value, port);
+        panic(w_name(), "sys_out failed", NO_NUM);
+}
+
+#undef panic
 PRIVATE void at_panic(line, h, msg, n)
 int line;
 char *h;
 char *msg;
 int n;
 {
-	printf("at_wini%d: panic at line %d: ", w_instance, line);
-	panic(h, msg, n);
+	printf("at_wini%d: panic at line %d: %s: %s %d\n",
+		w_instance, line, h, msg, n);
+	while(1);
 }
-
-- 
2.44.0