Initial Import from SVN

2014-04-09 14:27:18 +01:00
parent 8976e834c4
commit 895f96d2f7
3153 changed files with 748589 additions and 0 deletions
@@ -0,0 +1,123 @@
+/*
+ * RAM-based disk for swap.
+ *
+ * Copyright (C) 2011 Igor Mokos
+ * Copyright (C) 2011 Serge Vakulenko <serge@vak.ru>
+ *
+ * This file is part of the virtualmips distribution.
+ * See LICENSE file for terms of the license.
+ *
+ */
+#define _GNU_SOURCE
+#include <stdlib.h>
+#include <stdio.h>
+#include <assert.h>
+#include <sys/types.h>
+#include <sys/stat.h>
+#include <string.h>
+#include <fcntl.h>
+#include <unistd.h>
+
+#include "vm.h"
+#include "mips_memory.h"
+#include "device.h"
+#include "dev_swap.h"
+
+//#define TRACE       printf
+#ifndef TRACE
+#define TRACE(...)  /*empty*/
+#endif
+
+/*
+ * Reset swap.
+ */
+void dev_swap_reset (cpu_mips_t *cpu)
+{
+    pic32_t *pic32 = (pic32_t*) cpu->vm->hw_data;
+
+    pic32->swap.rd = 0;
+    pic32->swap.wr = 0;
+    pic32->swap.ldaddr = 0;
+    pic32->swap.offset = 0;
+}
+
+/*
+ * Initialize SD card.
+ */
+int dev_swap_init (swap_t *d, char *name)
+{
+    memset (d, 0, sizeof (*d));
+    d->name = name;
+    return (0);
+}
+
+void dev_swap_rd (cpu_mips_t *cpu, int on)
+{
+    pic32_t *pic32 = (pic32_t*) cpu->vm->hw_data;
+    swap_t *d = &pic32->swap;
+
+    if (on && ! d->rd) {
+        d->rd = 1;
+        d->offset %= SWAP_BYTES;
+        d->data = d->buf [d->offset];
+        TRACE ("swap: RD on, %06X -> %02X\n", d->offset, d->data);
+    } else if (! on && d->rd) {
+        d->rd = 0;
+        d->offset++;
+        TRACE ("swap: RD off, offset = %06X\n", d->offset);
+    }
+}
+
+void dev_swap_wr (cpu_mips_t *cpu, int on)
+{
+    pic32_t *pic32 = (pic32_t*) cpu->vm->hw_data;
+    swap_t *d = &pic32->swap;
+
+    if (on && ! d->wr) {
+        d->wr = 1;
+        d->offset %= SWAP_BYTES;
+        d->buf [d->offset] = d->data;
+        TRACE ("swap: WR on, %06X := %02X\n", d->offset, d->data);
+    } else if (! on && d->wr) {
+        d->wr = 0;
+        d->offset++;
+        TRACE ("swap: WR off, offset = %06X\n", d->offset);
+    }
+}
+
+void dev_swap_ldaddr (cpu_mips_t *cpu, int on)
+{
+    pic32_t *pic32 = (pic32_t*) cpu->vm->hw_data;
+    swap_t *d = &pic32->swap;
+
+    if (on && ! d->ldaddr) {
+        d->ldaddr = 1;
+        d->offset >>= 4;
+        d->offset |= d->data << 20;
+        TRACE ("swap: LDADDR on, offset = %06X\n", d->offset);
+    } else if (! on && d->ldaddr) {
+        TRACE ("swap: LDADDR off\n");
+        d->ldaddr = 0;
+    }
+}
+
+/*
+ * Data i/o: send byte to device.
+ * Return received byte.
+ */
+unsigned dev_swap_io (cpu_mips_t *cpu, unsigned char newval, unsigned char rmask)
+{
+    pic32_t *pic32 = (pic32_t*) cpu->vm->hw_data;
+    swap_t *d = &pic32->swap;
+
+    if (rmask == 0) {
+        /* Write mode. */
+        //TRACE ("swap: send %02x\n", newval);
+        d->data = newval;
+    } else {
+        //TRACE ("swap: receive %02x\n", d->data);
+    }
+
+    /* Read mode. */
+    return d->data;
+}