src/devices/dev_vme.c

/*
 *  Copyright (C) 2007  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_vme.c,v 1.4 2007/06/15 19:57:34 debug Exp $
 *
 *  COMMENT: VME bus
 *
 *  TODO
 */

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

#include "cpu.h"
#include "device.h"
#include "emul.h"
#include "machine.h"
#include "memory.h"
#include "misc.h"


#include "mvme88k_vme.h"


/*  #define debug fatal  */


#define VME_LEN                 0x1000

struct vme_data {
        uint32_t        reg[VME_LEN / sizeof(uint32_t)];
};


DEVICE_ACCESS(vme)
{
        struct vme_data *d = extra;
        uint64_t idata = 0, odata = 0;

        if (writeflag == MEM_WRITE)
                idata = memory_readmax64(cpu, data, len);

        if (writeflag == MEM_READ)
                odata = d->reg[relative_addr / sizeof(uint32_t)];

        switch (relative_addr) {

        case 0: /*  Used by OpenBSD/mvme88k when probing...  */
                break;

        case VME2_T1CMP:
                if (writeflag == MEM_WRITE)
                        d->reg[relative_addr / sizeof(uint32_t)] = idata;
                break;

        case VME2_T1COUNT:
                if (writeflag == MEM_WRITE)
                        d->reg[relative_addr / sizeof(uint32_t)] = idata;
                else {
                        /*  NOTE! This is a quick hack. TODO: Fix!  */
                        d->reg[relative_addr / sizeof(uint32_t)] += 10;
                }
                break;

        case VME2_TCTL:
                if (writeflag == MEM_WRITE)
                        d->reg[relative_addr / sizeof(uint32_t)] = idata;
                /*  TODO  */
                break;

        default:if (writeflag == MEM_READ)
                        debug("[ vme: unimplemented READ from offset 0x%x ]"
                            "\n", (int)relative_addr);
                else
                        debug("[ vme: unimplemented WRITE to offset 0x%x: "
                            "0x%x ]\n", (int)relative_addr, (int)idata);
                /*  exit(1);  */
        }

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

        return 1;
}


DEVINIT(vme)
{
        struct vme_data *d;

        CHECK_ALLOCATION(d = malloc(sizeof(struct vme_data)));
        memset(d, 0, sizeof(struct vme_data));

        memory_device_register(devinit->machine->memory, devinit->name,
            devinit->addr, VME_LEN, dev_vme_access, (void *)d,
            DM_DEFAULT, NULL);

        return 1;
}

1	/*
2	* Copyright (C) 2007 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_vme.c,v 1.4 2007/06/15 19:57:34 debug Exp $
29	*
30	* COMMENT: VME bus
31	*
32	* TODO
33	*/
34
35	#include <stdio.h>
36	#include <stdlib.h>
37	#include <string.h>
38
39	#include "cpu.h"
40	#include "device.h"
41	#include "emul.h"
42	#include "machine.h"
43	#include "memory.h"
44	#include "misc.h"
45
46
47	#include "mvme88k_vme.h"
48
49
50	/* #define debug fatal */
51
52
53	#define VME_LEN 0x1000
54
55	struct vme_data {
56	uint32_t reg[VME_LEN / sizeof(uint32_t)];
57	};
58
59
60	DEVICE_ACCESS(vme)
61	{
62	struct vme_data *d = extra;
63	uint64_t idata = 0, odata = 0;
64
65	if (writeflag == MEM_WRITE)
66	idata = memory_readmax64(cpu, data, len);
67
68	if (writeflag == MEM_READ)
69	odata = d->reg[relative_addr / sizeof(uint32_t)];
70
71	switch (relative_addr) {
72
73	case 0: /* Used by OpenBSD/mvme88k when probing... */
74	break;
75
76	case VME2_T1CMP:
77	if (writeflag == MEM_WRITE)
78	d->reg[relative_addr / sizeof(uint32_t)] = idata;
79	break;
80
81	case VME2_T1COUNT:
82	if (writeflag == MEM_WRITE)
83	d->reg[relative_addr / sizeof(uint32_t)] = idata;
84	else {
85	/* NOTE! This is a quick hack. TODO: Fix! */
86	d->reg[relative_addr / sizeof(uint32_t)] += 10;
87	}
88	break;
89
90	case VME2_TCTL:
91	if (writeflag == MEM_WRITE)
92	d->reg[relative_addr / sizeof(uint32_t)] = idata;
93	/* TODO */
94	break;
95
96	default:if (writeflag == MEM_READ)
97	debug("[ vme: unimplemented READ from offset 0x%x ]"
98	"\n", (int)relative_addr);
99	else
100	debug("[ vme: unimplemented WRITE to offset 0x%x: "
101	"0x%x ]\n", (int)relative_addr, (int)idata);
102	/* exit(1); */
103	}
104
105	if (writeflag == MEM_READ)
106	memory_writemax64(cpu, data, len, odata);
107
108	return 1;
109	}
110
111
112	DEVINIT(vme)
113	{
114	struct vme_data *d;
115
116	CHECK_ALLOCATION(d = malloc(sizeof(struct vme_data)));
117	memset(d, 0, sizeof(struct vme_data));
118
119	memory_device_register(devinit->machine->memory, devinit->name,
120	devinit->addr, VME_LEN, dev_vme_access, (void *)d,
121	DM_DEFAULT, NULL);
122
123	return 1;
124	}
125