src/devices/dev_ps2_spd.c

/*
 *  Copyright (C) 2004-2006  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_ps2_spd.c,v 1.14 2006/01/01 13:17:17 debug Exp $
 *  
 *  Playstation 2 "SPD" harddisk controller.
 *
 *  TODO
 */

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

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


struct ps2_spd_data {
        uint64_t                wdcaddr;
};


/*
 *  dev_ps2_spd_access():
 */
DEVICE_ACCESS(ps2_spd)
{
        struct ps2_spd_data *d = extra;
        uint64_t idata = 0, odata = 0;

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

        switch (relative_addr) {
        case 0x40:
        case 0x42:
        case 0x44:
        case 0x46:
        case 0x48:
        case 0x4a:
        case 0x4c:
        case 0x4e:
                debug("[ ps2_spd: wdc access ]\n");
                cpu->memory_rw(cpu, mem, (relative_addr - 0x40) / 2 +
                    d->wdcaddr, data, len, writeflag, PHYSICAL);
                return 1;
        case 0x5c:      /*  aux control  */
                debug("[ ps2_spd: wdc access (2) ]\n");
                cpu->memory_rw(cpu, mem, d->wdcaddr + 0x206, data, len,
                    writeflag, PHYSICAL);
                return 1;
        default:
                if (writeflag==MEM_READ) {
                        debug("[ ps2_spd: read from addr 0x%x: 0x%llx ]\n",
                            (int)relative_addr, (long long)odata);
                } else {
                        debug("[ ps2_spd: write to addr 0x%x: 0x%llx ]\n",
                            (int)relative_addr, (long long)idata);
                }
        }

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

        return 1;
}


/*
 *  dev_ps2_spd_init():
 */
void dev_ps2_spd_init(struct machine *machine, struct memory *mem,
        uint64_t baseaddr)
{
        struct ps2_spd_data *d;
        char tmpstr[200];

        d = malloc(sizeof(struct ps2_spd_data));
        if (d == NULL) {
                fprintf(stderr, "out of memory\n");
                exit(1);
        }
        memset(d, 0, sizeof(struct ps2_spd_data));
        d->wdcaddr = baseaddr + DEV_PS2_SPD_LENGTH;

        memory_device_register(mem, "ps2_spd", baseaddr, DEV_PS2_SPD_LENGTH,
            dev_ps2_spd_access, d, DM_DEFAULT, NULL);

        /*  Register a generic wdc device at a bogus address:  */
        /*  (irq 8 + 32 + 0 means SBUS/PCMCIA)  */
        snprintf(tmpstr, sizeof(tmpstr), "wdc addr=0x%llx irq=%i",
            (long long)d->wdcaddr, 8 + 32 + 0);
        device_add(machine, tmpstr);
}

1	/*
2	* Copyright (C) 2004-2006 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_ps2_spd.c,v 1.14 2006/01/01 13:17:17 debug Exp $
29	*
30	* Playstation 2 "SPD" harddisk controller.
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 "devices.h"
42	#include "memory.h"
43	#include "misc.h"
44
45
46	struct ps2_spd_data {
47	uint64_t wdcaddr;
48	};
49
50
51	/*
52	* dev_ps2_spd_access():
53	*/
54	DEVICE_ACCESS(ps2_spd)
55	{
56	struct ps2_spd_data *d = extra;
57	uint64_t idata = 0, odata = 0;
58
59	if (writeflag == MEM_WRITE)
60	idata = memory_readmax64(cpu, data, len);
61
62	switch (relative_addr) {
63	case 0x40:
64	case 0x42:
65	case 0x44:
66	case 0x46:
67	case 0x48:
68	case 0x4a:
69	case 0x4c:
70	case 0x4e:
71	debug("[ ps2_spd: wdc access ]\n");
72	cpu->memory_rw(cpu, mem, (relative_addr - 0x40) / 2 +
73	d->wdcaddr, data, len, writeflag, PHYSICAL);
74	return 1;
75	case 0x5c: /* aux control */
76	debug("[ ps2_spd: wdc access (2) ]\n");
77	cpu->memory_rw(cpu, mem, d->wdcaddr + 0x206, data, len,
78	writeflag, PHYSICAL);
79	return 1;
80	default:
81	if (writeflag==MEM_READ) {
82	debug("[ ps2_spd: read from addr 0x%x: 0x%llx ]\n",
83	(int)relative_addr, (long long)odata);
84	} else {
85	debug("[ ps2_spd: write to addr 0x%x: 0x%llx ]\n",
86	(int)relative_addr, (long long)idata);
87	}
88	}
89
90	if (writeflag == MEM_READ)
91	memory_writemax64(cpu, data, len, odata);
92
93	return 1;
94	}
95
96
97	/*
98	* dev_ps2_spd_init():
99	*/
100	void dev_ps2_spd_init(struct machine machine, struct memory mem,
101	uint64_t baseaddr)
102	{
103	struct ps2_spd_data *d;
104	char tmpstr[200];
105
106	d = malloc(sizeof(struct ps2_spd_data));
107	if (d == NULL) {
108	fprintf(stderr, "out of memory\n");
109	exit(1);
110	}
111	memset(d, 0, sizeof(struct ps2_spd_data));
112	d->wdcaddr = baseaddr + DEV_PS2_SPD_LENGTH;
113
114	memory_device_register(mem, "ps2_spd", baseaddr, DEV_PS2_SPD_LENGTH,
115	dev_ps2_spd_access, d, DM_DEFAULT, NULL);
116
117	/* Register a generic wdc device at a bogus address: */
118	/* (irq 8 + 32 + 0 means SBUS/PCMCIA) */
119	snprintf(tmpstr, sizeof(tmpstr), "wdc addr=0x%llx irq=%i",
120	(long long)d->wdcaddr, 8 + 32 + 0);
121	device_add(machine, tmpstr);
122	}
123