src/devices/dev_hammerhead.c

/*
 *  Copyright (C) 2005-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_hammerhead.c,v 1.4 2006/12/30 13:30:58 debug Exp $
 *  
 *  Hammerhead controller, for the secondary CPU on MacPPC machines.
 */

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

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


/*  #define debug fatal  */

void ppc_pc_to_pointers(struct cpu *);
void ppc32_pc_to_pointers(struct cpu *);

#define DEV_HAMMERHEAD_LENGTH           4

struct hammerhead_data {
        int     dummy;
};


/*
 *  dev_hammerhead_access():
 */
DEVICE_ACCESS(hammerhead)
{
        uint64_t idata = 0, odata=0;
        /*  struct hammerhead_data *d = extra;  */

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

        if (writeflag == MEM_WRITE) {
                int my_id = cpu->cpu_id;
                struct cpu *other_cpu = cpu->machine->cpus[!my_id];

                debug("[ HAMMERHEAD: from cpu%i to cpu%i: new pc = 0x%llx ]\n",
                    my_id, !my_id, (long long)idata);

if (idata <= 0x100)
return 1;

                other_cpu->running = 1;
                other_cpu->pc = idata;
#ifdef ENABLE_PPC
                if (other_cpu->is_32bit)
                        ppc32_pc_to_pointers(other_cpu);
                else
                        ppc_pc_to_pointers(other_cpu);
#else
                fatal("Hm. PPC not enabled.\n");
                exit(1);
#endif
        } else {
                fatal("[ HAMMERHEAD read: TODO ]\n");
        }

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

        return 1;
}


DEVINIT(hammerhead)
{
        struct hammerhead_data *d = malloc(sizeof(struct hammerhead_data));

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

        memory_device_register(devinit->machine->memory, devinit->name,
            devinit->addr, DEV_HAMMERHEAD_LENGTH, dev_hammerhead_access, d,
            DM_DEFAULT, NULL);

        return 1;
}

1	/*
2	* Copyright (C) 2005-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_hammerhead.c,v 1.4 2006/12/30 13:30:58 debug Exp $
29	*
30	* Hammerhead controller, for the secondary CPU on MacPPC machines.
31	*/
32
33	#include <stdio.h>
34	#include <stdlib.h>
35	#include <string.h>
36
37	#include "cpu.h"
38	#include "device.h"
39	#include "machine.h"
40	#include "memory.h"
41	#include "misc.h"
42
43
44	/* #define debug fatal */
45
46	void ppc_pc_to_pointers(struct cpu *);
47	void ppc32_pc_to_pointers(struct cpu *);
48
49	#define DEV_HAMMERHEAD_LENGTH 4
50
51	struct hammerhead_data {
52	int dummy;
53	};
54
55
56	/*
57	* dev_hammerhead_access():
58	*/
59	DEVICE_ACCESS(hammerhead)
60	{
61	uint64_t idata = 0, odata=0;
62	/* struct hammerhead_data d = extra; /
63
64	if (writeflag == MEM_WRITE)
65	idata = memory_readmax64(cpu, data, len);
66
67	if (writeflag == MEM_WRITE) {
68	int my_id = cpu->cpu_id;
69	struct cpu *other_cpu = cpu->machine->cpus[!my_id];
70
71	debug("[ HAMMERHEAD: from cpu%i to cpu%i: new pc = 0x%llx ]\n",
72	my_id, !my_id, (long long)idata);
73
74	if (idata <= 0x100)
75	return 1;
76
77	other_cpu->running = 1;
78	other_cpu->pc = idata;
79	#ifdef ENABLE_PPC
80	if (other_cpu->is_32bit)
81	ppc32_pc_to_pointers(other_cpu);
82	else
83	ppc_pc_to_pointers(other_cpu);
84	#else
85	fatal("Hm. PPC not enabled.\n");
86	exit(1);
87	#endif
88	} else {
89	fatal("[ HAMMERHEAD read: TODO ]\n");
90	}
91
92	if (writeflag == MEM_READ)
93	memory_writemax64(cpu, data, len, odata);
94
95	return 1;
96	}
97
98
99	DEVINIT(hammerhead)
100	{
101	struct hammerhead_data *d = malloc(sizeof(struct hammerhead_data));
102
103	if (d == NULL) {
104	fprintf(stderr, "out of memory\n");
105	exit(1);
106	}
107	memset(d, 0, sizeof(struct hammerhead_data));
108
109	memory_device_register(devinit->machine->memory, devinit->name,
110	devinit->addr, DEV_HAMMERHEAD_LENGTH, dev_hammerhead_access, d,
111	DM_DEFAULT, NULL);
112
113	return 1;
114	}
115