src/devices/dev_pmppc.c

/*
 *  Copyright (C) 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_pmppc.c,v 1.3 2005/10/26 14:37:04 debug Exp $
 *  
 *  PM/PPC devices.
 *
 *  TODO
 */

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

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

#include "pmppc.h"


struct pmppc_data {
        uint8_t         config0;
        uint8_t         config1;

        uint8_t         reset_reg;
};


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

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

        relative_addr += PMPPC_CONFIG0;

        switch (relative_addr) {
        case PMPPC_CONFIG0:
                if (writeflag==MEM_READ) {
                        odata = d->config0;
                } else {
                        debug("[ pmppc: UNIMPLEMENTED write to PMPPC_CONFIG0:"
                            " 0x%02x ]\n", (int)idata);
                }
                break;
        case PMPPC_CONFIG1:
                if (writeflag==MEM_READ) {
                        odata = d->config1;
                } else {
                        debug("[ pmppc: UNIMPLEMENTED write to PMPPC_CONFIG1:"
                            " 0x%02x ]\n", (int)idata);
                }
                break;
        case PMPPC_RESET:
                if (writeflag==MEM_READ) {
                        odata = d->reset_reg;
                } else {
                        if (d->reset_reg == PMPPC_RESET_SEQ_STEP1 &&
                            idata == PMPPC_RESET_SEQ_STEP2) {
                                cpu->running = 0;
                                cpu->machine->
                                    exit_without_entering_debugger = 1;
                        }
                        d->reset_reg = idata;
                }
                break;
        default:
                if (writeflag==MEM_READ) {
                        debug("[ pmppc: UNIMPLEMENTED read from 0x%08lx ]\n",
                            (long)relative_addr);
                } else {
                        debug("[ pmppc: UNIMPLEMENTED write to  0x%08lx:"
                            " 0x%02x ]\n", (long)relative_addr, (int)idata);
                }
        }

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

        return 1;
}


/*
 *  dev_pmppc_init():
 */
void dev_pmppc_init(struct memory *mem)
{
        struct pmppc_data *d;

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

        /*
         *  Based on how NetBSD/pmppc's pmppc_setup() works:
         *
         *  config0:
         *      bit 7           Is monarch (?).
         *      bit 5           Has ethernet.
         *      bit 4           Has RTC.
         *      bits 3..2       Flash size (00 = 256 MB, 01 = 128 MB,
         *                      10 = 64 MB, 11 = 32 MB).
         *      bits 1..0       Flash width (00 = 64, 01 = 32, 10 = 16, 11 = 0).
         *
         *  config1:
         *      bit 7           Boot device is FLASH (1) or ROM (0).
         *      bit 6           Has ECC.
         *      bits 5..4       Memory size: 00 = 32 MB, 01 = 64 MB,
         *                      10 = 128 MB, 11 = 256 MB.
         *      bits 3..2       L2 cache.
         *      bits 1..0       Bus frequency: 00 = 66.66 MHz, 01 = 83.33 MHz,
         *                      10 = 100.00 MHz, 11 = reserved?
         */
        d->config0 = 0x30;
        d->config1 = 0;         /*  TODO  */

        memory_device_register(mem, "pmppc_board",
            PMPPC_CONFIG0, 0x10, dev_pmppc_board_access, d, MEM_DEFAULT, NULL);
}

1	dpavlin	4	/*
2			* Copyright (C) 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	dpavlin	18	* $Id: dev_pmppc.c,v 1.3 2005/10/26 14:37:04 debug Exp $
29	dpavlin	4	*
30			* PM/PPC devices.
31			*
32			* TODO
33			*/
34
35			#include <stdio.h>
36			#include <stdlib.h>
37			#include <string.h>
38
39			#include "cpu.h"
40			#include "devices.h"
41			#include "machine.h"
42			#include "memory.h"
43			#include "misc.h"
44
45			#include "pmppc.h"
46
47
48			struct pmppc_data {
49			uint8_t config0;
50			uint8_t config1;
51
52			uint8_t reset_reg;
53			};
54
55
56			/*
57			* dev_pmppc_board_access():
58			*/
59			int dev_pmppc_board_access(struct cpu cpu, struct memory mem,
60			uint64_t relative_addr, unsigned char *data, size_t len, int writeflag,
61			void *extra)
62			{
63			struct pmppc_data *d = extra;
64			uint64_t idata = 0, odata = 0;
65
66	dpavlin	18	if (writeflag == MEM_WRITE)
67			idata = memory_readmax64(cpu, data, len);
68	dpavlin	4
69			relative_addr += PMPPC_CONFIG0;
70
71			switch (relative_addr) {
72			case PMPPC_CONFIG0:
73			if (writeflag==MEM_READ) {
74			odata = d->config0;
75			} else {
76			debug("[ pmppc: UNIMPLEMENTED write to PMPPC_CONFIG0:"
77			" 0x%02x ]\n", (int)idata);
78			}
79			break;
80			case PMPPC_CONFIG1:
81			if (writeflag==MEM_READ) {
82			odata = d->config1;
83			} else {
84			debug("[ pmppc: UNIMPLEMENTED write to PMPPC_CONFIG1:"
85			" 0x%02x ]\n", (int)idata);
86			}
87			break;
88			case PMPPC_RESET:
89			if (writeflag==MEM_READ) {
90			odata = d->reset_reg;
91			} else {
92			if (d->reset_reg == PMPPC_RESET_SEQ_STEP1 &&
93			idata == PMPPC_RESET_SEQ_STEP2) {
94			cpu->running = 0;
95			cpu->machine->
96			exit_without_entering_debugger = 1;
97			}
98			d->reset_reg = idata;
99			}
100			break;
101			default:
102			if (writeflag==MEM_READ) {
103			debug("[ pmppc: UNIMPLEMENTED read from 0x%08lx ]\n",
104			(long)relative_addr);
105			} else {
106			debug("[ pmppc: UNIMPLEMENTED write to 0x%08lx:"
107			" 0x%02x ]\n", (long)relative_addr, (int)idata);
108			}
109			}
110
111			if (writeflag == MEM_READ)
112			memory_writemax64(cpu, data, len, odata);
113
114			return 1;
115			}
116
117
118			/*
119			* dev_pmppc_init():
120			*/
121			void dev_pmppc_init(struct memory *mem)
122			{
123			struct pmppc_data *d;
124
125			d = malloc(sizeof(struct pmppc_data));
126			if (d == NULL) {
127			fprintf(stderr, "out of memory\n");
128			exit(1);
129			}
130			memset(d, 0, sizeof(struct pmppc_data));
131
132			/*
133			* Based on how NetBSD/pmppc's pmppc_setup() works:
134			*
135			* config0:
136			* bit 7 Is monarch (?).
137			* bit 5 Has ethernet.
138			* bit 4 Has RTC.
139			* bits 3..2 Flash size (00 = 256 MB, 01 = 128 MB,
140			* 10 = 64 MB, 11 = 32 MB).
141			* bits 1..0 Flash width (00 = 64, 01 = 32, 10 = 16, 11 = 0).
142			*
143			* config1:
144			* bit 7 Boot device is FLASH (1) or ROM (0).
145			* bit 6 Has ECC.
146			* bits 5..4 Memory size: 00 = 32 MB, 01 = 64 MB,
147			* 10 = 128 MB, 11 = 256 MB.
148			* bits 3..2 L2 cache.
149			* bits 1..0 Bus frequency: 00 = 66.66 MHz, 01 = 83.33 MHz,
150			* 10 = 100.00 MHz, 11 = reserved?
151			*/
152			d->config0 = 0x30;
153			d->config1 = 0; /* TODO */
154
155			memory_device_register(mem, "pmppc_board",
156			PMPPC_CONFIG0, 0x10, dev_pmppc_board_access, d, MEM_DEFAULT, NULL);
157			}
158