patch-2.1.23 linux/drivers/ap1000/ddv_util.c

• Lines: 117
• Date: Sun Jan 26 12:07:10 1997
• Orig file: v2.1.22/linux/drivers/ap1000/ddv_util.c
• Orig date: Thu Jan 1 02:00:00 1970

diff -u --recursive --new-file v2.1.22/linux/drivers/ap1000/ddv_util.c linux/drivers/ap1000/ddv_util.c
@@ -0,0 +1,116 @@
+  /*
+   * Copyright 1996 The Australian National University.
+   * Copyright 1996 Fujitsu Laboratories Limited
+   * 
+   * This software may be distributed under the terms of the Gnu
+   * Public License version 2 or later
+  */
+#define __NO_VERSION__
+#include <linux/module.h>
+#include <linux/blk.h>
+#include <linux/genhd.h>
+#include <asm/pgtable.h>
+#include <asm/ap1000/apreg.h>
+#include <asm/ap1000/DdvReqTable.h>
+
+
+#define GENDISK_STRUCT ddv_gendisk
+
+struct RequestTable *RTable=NULL;
+struct OPrintBufArray *PrintBufs=NULL;
+struct OAlignBufArray *AlignBufs=NULL;
+struct DiskInfo *DiskInfo=NULL;
+
+extern int ddv_length[];
+
+int ddv_mlist_available(void)
+{
+	int start = RTable->start_mtable;
+	int end = RTable->end_mtable;
+	
+	if (start >= end)
+		return (MTABLE_SIZE - start);
+	return (end+1) - start;
+}
+
+
+int ddv_get_mlist(unsigned mptr[],int bnum)
+{
+	int available = ddv_mlist_available();
+	int i;
+	int start = RTable->start_mtable;
+	
+	if (available < bnum) {
+		return -1;
+	}
+	
+	for (i = 0; i < bnum; i++) {    
+		unsigned phys = (unsigned)mmu_v2p((unsigned)mptr[i]);
+		if (phys == -1)
+			panic("bad address %x in ddv_get_mlist\n",mptr[i]);
+		RTable->mtable[RTable->start_mtable] = phys;
+		RTable->start_mtable = INC_ML(RTable->start_mtable);
+	}
+	
+	return start;
+}
+
+
+
+void ddv_load_kernel(char *opcodep)
+{
+	int tsize;
+	char *p;
+	struct exec *mhead;  
+  
+	mhead = (struct exec *)opcodep;
+	p = opcodep + sizeof(*mhead);
+	
+	tsize = (mhead->a_text + (PAGE_SIZE-1)) & ~(PAGE_SIZE-1);
+	memcpy((char *)OPIBUS_BASE+mhead->a_entry,p,mhead->a_text);
+	memcpy((char *)OPIBUS_BASE+mhead->a_entry+tsize,
+	       p+mhead->a_text,mhead->a_data);
+	memset((char *)OPIBUS_BASE+mhead->a_entry+tsize+mhead->a_data,0,
+	       mhead->a_bss+PAGE_SIZE);
+	
+#ifdef DDV_DEBUG  
+	printk("CELL(%d) loaded opiu kernel of size %ld %ld %ld (%ld)\n",
+	       ap_getcid(),
+	       mhead->a_text,mhead->a_data,mhead->a_bss,mhead->a_entry);
+#endif
+}
+
+
+int ddv_restart_cpu(void)
+{ 
+	unsigned long timeout;
+
+	OPT_IO(OPIU_OP) = OPIU_RESET; 
+	OPT_IO(PRST) = PRST_IRST; 
+	if (OPT_IO(PRST) != PRST_IRST) { 
+		printk("_iu_load reset release error.\n"); 
+		return(-1);
+	}
+	for (timeout=jiffies + 10; 
+	     (jiffies < timeout) || (OPT_IO(PBUF0) == 0);
+	     ) /* wait */ ;
+	if (OPT_IO(PBUF0) == 0) {
+		printk("WARNING: option kernel didn't startup\n");
+		return(-1);
+	} else {
+		printk("option kernel IU running\n");
+		DiskInfo = (struct DiskInfo *)(OPT_IO(PBUF0) + OPIBUS_BASE);
+		RTable = (struct RequestTable *)(DiskInfo->ptrs[0]+OPIBUS_BASE);
+		PrintBufs = (struct OPrintBufArray *)(DiskInfo->ptrs[1]+OPIBUS_BASE);
+		AlignBufs = (struct OAlignBufArray *)(DiskInfo->ptrs[2]+OPIBUS_BASE);
+		
+		printk("Disk capacity: %d blocks of size %d\n",
+		       (int)DiskInfo->blocks,(int)DiskInfo->blk_size);
+		
+		OPT_IO(PBUF0) = 0;
+	}
+	return(0);
+}
+
+
+