src/devices/dev_kn230.c

/*
 *  Copyright (C) 2003-2005  Anders Gavare.  All rights reserved.
 *
 *  Redistribution and use in source and binary forms, with or without
 *  modification, are permitted provided that the following conditions are met:
 *
 *  1. Redistributions of source code must retain the above copyright
 *     notice, this list of conditions and the following disclaimer.
 *  2. Redistributions in binary form must reproduce the above copyright  
 *     notice, this list of conditions and the following disclaimer in the 
 *     documentation and/or other materials provided with the distribution.
 *  3. The name of the author may not be used to endorse or promote products
 *     derived from this software without specific prior written permission.
 *
 *  THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND
 *  ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
 *  IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
 *  ARE DISCLAIMED.  IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE   
 *  FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
 *  DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
 *  OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
 *  HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
 *  LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
 *  OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
 *  SUCH DAMAGE.
 *   
 *
 *  $Id: dev_kn230.c,v 1.11 2005/02/26 16:53:32 debug Exp $
 *  
 *  DEC MIPSMATE 5100 (KN230) stuff.
 */

#include <stdio.h>
#include <stdlib.h>
#include <string.h>

#include "device.h"
#include "devices.h"
#include "machine.h"
#include "memory.h"
#include "misc.h"


#define DEV_KN230_LENGTH                0x1c00000


/*
 *  dev_kn230_access():
 */
int dev_kn230_access(struct cpu *cpu, struct memory *mem,
        uint64_t relative_addr, unsigned char *data, size_t len,
        int writeflag, void *extra)
{
        struct kn230_csr *d = extra;
        uint64_t idata = 0, odata = 0;

        idata = memory_readmax64(cpu, data, len);

        switch (relative_addr) {
        case 0:
                if (writeflag==MEM_READ) {
                        odata = d->csr;
                        /* debug("[ kn230: read from CSR: 0x%08x ]\n",
                            (int)odata); */
                } else {
                        /* debug("[ kn230: write to CSR: 0x%08x ]\n",
                            (int)idata); */
                }
                break;
        default:
                if (writeflag==MEM_READ) {
                        debug("[ kn230: read from 0x%08lx ]\n",
                            (long)relative_addr);
                } else {
                        debug("[ kn230: write to  0x%08lx: 0x%08x ]\n",
                            (long)relative_addr, (int)idata);
                }
        }

        if (writeflag == MEM_READ)
                memory_writemax64(cpu, data, len, odata);
  
        return 1;
}


/*
 *  devinit_kn230():
 */
int devinit_kn230(struct devinit *devinit)
{
        struct kn230_csr *d;

        d = malloc(sizeof(struct kn230_csr));
        if (d == NULL) {
                fprintf(stderr, "out of memory\n");
                exit(1);
        }
        memset(d, 0, sizeof(struct kn230_csr));

        memory_device_register(devinit->machine->memory, devinit->name,
            devinit->addr, DEV_KN230_LENGTH, dev_kn230_access, d,
            MEM_DEFAULT, NULL);

        devinit->return_ptr = d;

        return 1;
}

1	dpavlin	4	/*
2			* Copyright (C) 2003-2005 Anders Gavare. All rights reserved.
3			*
4			* Redistribution and use in source and binary forms, with or without
5			* modification, are permitted provided that the following conditions are met:
6			*
7			* 1. Redistributions of source code must retain the above copyright
8			* notice, this list of conditions and the following disclaimer.
9			* 2. Redistributions in binary form must reproduce the above copyright
10			* notice, this list of conditions and the following disclaimer in the
11			* documentation and/or other materials provided with the distribution.
12			* 3. The name of the author may not be used to endorse or promote products
13			* derived from this software without specific prior written permission.
14			*
15			* THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND
16			* ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
17			* IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
18			* ARE DISCLAIMED. IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE
19			* FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
20			* DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
21			* OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
22			* HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
23			* LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
24			* OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
25			* SUCH DAMAGE.
26			*
27			*
28			* $Id: dev_kn230.c,v 1.11 2005/02/26 16:53:32 debug Exp $
29			*
30			* DEC MIPSMATE 5100 (KN230) stuff.
31			*/
32
33			#include <stdio.h>
34			#include <stdlib.h>
35			#include <string.h>
36
37			#include "device.h"
38			#include "devices.h"
39			#include "machine.h"
40			#include "memory.h"
41			#include "misc.h"
42
43
44			#define DEV_KN230_LENGTH 0x1c00000
45
46
47			/*
48			* dev_kn230_access():
49			*/
50			int dev_kn230_access(struct cpu cpu, struct memory mem,
51			uint64_t relative_addr, unsigned char *data, size_t len,
52			int writeflag, void *extra)
53			{
54			struct kn230_csr *d = extra;
55			uint64_t idata = 0, odata = 0;
56
57			idata = memory_readmax64(cpu, data, len);
58
59			switch (relative_addr) {
60			case 0:
61			if (writeflag==MEM_READ) {
62			odata = d->csr;
63			/* debug("[ kn230: read from CSR: 0x%08x ]\n",
64			(int)odata); */
65			} else {
66			/* debug("[ kn230: write to CSR: 0x%08x ]\n",
67			(int)idata); */
68			}
69			break;
70			default:
71			if (writeflag==MEM_READ) {
72			debug("[ kn230: read from 0x%08lx ]\n",
73			(long)relative_addr);
74			} else {
75			debug("[ kn230: write to 0x%08lx: 0x%08x ]\n",
76			(long)relative_addr, (int)idata);
77			}
78			}
79
80			if (writeflag == MEM_READ)
81			memory_writemax64(cpu, data, len, odata);
82
83			return 1;
84			}
85
86
87			/*
88			* devinit_kn230():
89			*/
90			int devinit_kn230(struct devinit *devinit)
91			{
92			struct kn230_csr *d;
93
94			d = malloc(sizeof(struct kn230_csr));
95			if (d == NULL) {
96			fprintf(stderr, "out of memory\n");
97			exit(1);
98			}
99			memset(d, 0, sizeof(struct kn230_csr));
100
101			memory_device_register(devinit->machine->memory, devinit->name,
102			devinit->addr, DEV_KN230_LENGTH, dev_kn230_access, d,
103			MEM_DEFAULT, NULL);
104
105			devinit->return_ptr = d;
106
107			return 1;
108			}
109