/[gxemul]/trunk/src/devices/dev_openpic.c
This is repository of my old source code which isn't updated any more. Go to git.rot13.org for current projects!
ViewVC logotype

Annotation of /trunk/src/devices/dev_openpic.c

Parent Directory Parent Directory | Revision Log Revision Log


Revision 63 - (hide annotations)
Sat Oct 13 15:05:59 2007 UTC (16 years, 5 months ago) by dpavlin
File MIME type: text/plain
File size: 7243 byte(s)
create OpenPIC
1 dpavlin 22 /*
2 dpavlin 34 * Copyright (C) 2005-2007 Anders Gavare. All rights reserved.
3 dpavlin 22 *
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 dpavlin 63 * $Id: dev_openpic.c,v 1.14 2007/09/11 21:42:52 debug Exp $
28 dpavlin 22 *
29 dpavlin 63 * COMMENT: OpenPIC Interrupt controller (used by sandpoint ppc)
30     * based on dev_openpic.c
31 dpavlin 22 */
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 dpavlin 63 #define DEV_OPENPIC_LENGTH 0x40000
45 dpavlin 34
46 dpavlin 63 struct openpic_data {
47 dpavlin 34 struct interrupt cpu_irq;
48    
49     uint32_t status_hi;
50     uint32_t status_lo;
51     uint32_t enable_hi;
52     uint32_t enable_lo;
53     };
54    
55    
56 dpavlin 63 void openpic_hi_interrupt_assert(struct interrupt *interrupt)
57 dpavlin 34 {
58 dpavlin 63 struct openpic_data *d = interrupt->extra;
59 dpavlin 34 d->status_hi |= interrupt->line;
60     if (d->status_lo & d->enable_lo || d->status_hi & d->enable_hi)
61     INTERRUPT_ASSERT(d->cpu_irq);
62     }
63 dpavlin 63 void openpic_hi_interrupt_deassert(struct interrupt *interrupt)
64 dpavlin 34 {
65 dpavlin 63 struct openpic_data *d = interrupt->extra;
66 dpavlin 34 d->status_hi &= ~interrupt->line;
67     if (!(d->status_lo & d->enable_lo || d->status_hi & d->enable_hi))
68     INTERRUPT_DEASSERT(d->cpu_irq);
69     }
70 dpavlin 63 void openpic_lo_interrupt_assert(struct interrupt *interrupt)
71 dpavlin 34 {
72 dpavlin 63 struct openpic_data *d = interrupt->extra;
73 dpavlin 34 d->status_lo |= interrupt->line;
74     if (d->status_lo & d->enable_lo || d->status_hi & d->enable_hi)
75     INTERRUPT_ASSERT(d->cpu_irq);
76     }
77 dpavlin 63 void openpic_lo_interrupt_deassert(struct interrupt *interrupt)
78 dpavlin 34 {
79 dpavlin 63 struct openpic_data *d = interrupt->extra;
80 dpavlin 34 d->status_lo &= ~interrupt->line;
81     if (!(d->status_lo & d->enable_lo || d->status_hi & d->enable_hi))
82     INTERRUPT_DEASSERT(d->cpu_irq);
83     }
84    
85    
86 dpavlin 63 DEVICE_ACCESS(openpic)
87 dpavlin 22 {
88 dpavlin 63 struct openpic_data *d = extra;
89 dpavlin 22 uint64_t idata = 0, odata = 0;
90    
91     if (writeflag == MEM_WRITE)
92     idata = memory_readmax64(cpu, data, len);
93    
94     switch (relative_addr) {
95    
96     #if 0
97     #define INT_STATE_REG_H (interrupt_reg + 0x00)
98     #define INT_ENABLE_REG_H (interrupt_reg + 0x04)
99     #define INT_CLEAR_REG_H (interrupt_reg + 0x08)
100     #define INT_LEVEL_REG_H (interrupt_reg + 0x0c)
101     #define INT_STATE_REG_L (interrupt_reg + 0x10)
102     #define INT_ENABLE_REG_L (interrupt_reg + 0x14)
103     #define INT_CLEAR_REG_L (interrupt_reg + 0x18)
104     #define INT_LEVEL_REG_L (interrupt_reg + 0x1c)
105     #endif
106    
107     case 0x10:
108     if (writeflag == MEM_READ)
109 dpavlin 24 odata = d->status_hi & d->enable_hi;
110 dpavlin 22 break;
111    
112     case 0x14:
113     if (writeflag == MEM_READ)
114     odata = d->enable_hi;
115     else {
116 dpavlin 34 int old_assert = (d->status_lo & d->enable_lo
117     || d->status_hi & d->enable_hi);
118     int new_assert;
119 dpavlin 22 d->enable_hi = idata;
120 dpavlin 34
121     new_assert = (d->status_lo & d->enable_lo ||
122     d->status_hi & d->enable_hi);
123    
124     if (old_assert && !new_assert)
125     INTERRUPT_DEASSERT(d->cpu_irq);
126     else if (!old_assert && new_assert)
127     INTERRUPT_ASSERT(d->cpu_irq);
128 dpavlin 22 }
129     break;
130    
131     case 0x18:
132     if (writeflag == MEM_WRITE) {
133 dpavlin 34 int old_assert = (d->status_lo & d->enable_lo
134     || d->status_hi & d->enable_hi);
135     int new_assert;
136 dpavlin 22 d->status_hi &= ~idata;
137 dpavlin 34
138     new_assert = (d->status_lo & d->enable_lo ||
139     d->status_hi & d->enable_hi);
140    
141     if (old_assert && !new_assert)
142     INTERRUPT_DEASSERT(d->cpu_irq);
143     else if (!old_assert && new_assert)
144     INTERRUPT_ASSERT(d->cpu_irq);
145 dpavlin 22 }
146     break;
147    
148     case 0x20:
149     if (writeflag == MEM_READ)
150 dpavlin 24 odata = d->status_lo & d->enable_lo;
151 dpavlin 22 break;
152    
153     case 0x24:
154     if (writeflag == MEM_READ)
155     odata = d->enable_lo;
156     else {
157 dpavlin 34 int old_assert = (d->status_lo & d->enable_lo
158     || d->status_hi & d->enable_hi);
159     int new_assert;
160 dpavlin 22 d->enable_lo = idata;
161 dpavlin 34
162     new_assert = (d->status_lo & d->enable_lo ||
163     d->status_hi & d->enable_hi);
164    
165     if (old_assert && !new_assert)
166     INTERRUPT_DEASSERT(d->cpu_irq);
167     else if (!old_assert && new_assert)
168     INTERRUPT_ASSERT(d->cpu_irq);
169 dpavlin 22 }
170     break;
171    
172     case 0x28:
173     if (writeflag == MEM_WRITE) {
174 dpavlin 34 int old_assert = (d->status_lo & d->enable_lo
175     || d->status_hi & d->enable_hi);
176     int new_assert;
177 dpavlin 22 d->status_lo &= ~idata;
178 dpavlin 34
179     new_assert = (d->status_lo & d->enable_lo ||
180     d->status_hi & d->enable_hi);
181    
182     if (old_assert && !new_assert)
183     INTERRUPT_DEASSERT(d->cpu_irq);
184     else if (!old_assert && new_assert)
185     INTERRUPT_ASSERT(d->cpu_irq);
186 dpavlin 22 }
187     break;
188    
189 dpavlin 44 case 0x1c:
190 dpavlin 24 case 0x2c:
191 dpavlin 34 /* Avoid a debug message. */
192 dpavlin 24 break;
193    
194 dpavlin 22 default:if (writeflag == MEM_WRITE) {
195 dpavlin 63 fatal("[ openpic: unimplemented write to "
196 dpavlin 22 "offset 0x%x: data=0x%x ]\n", (int)
197     relative_addr, (int)idata);
198     } else {
199 dpavlin 63 fatal("[ openpic: unimplemented read from "
200 dpavlin 22 "offset 0x%x ]\n", (int)relative_addr);
201     }
202     }
203    
204     if (writeflag == MEM_READ)
205     memory_writemax64(cpu, data, len, odata);
206    
207     return 1;
208     }
209    
210    
211 dpavlin 63 DEVINIT(openpic)
212 dpavlin 22 {
213 dpavlin 63 struct openpic_data *d;
214 dpavlin 34 int i;
215 dpavlin 22
216 dpavlin 63 CHECK_ALLOCATION(d = malloc(sizeof(struct openpic_data)));
217     memset(d, 0, sizeof(struct openpic_data));
218 dpavlin 22
219 dpavlin 42 /* Connect to the CPU interrupt pin: */
220 dpavlin 34 INTERRUPT_CONNECT(devinit->interrupt_path, d->cpu_irq);
221 dpavlin 22
222 dpavlin 34 /*
223     * Register the 64 Grand Central interrupts (32 lo, 32 hi):
224     */
225     for (i=0; i<32; i++) {
226     struct interrupt template;
227     char n[300];
228 dpavlin 63 snprintf(n, sizeof(n), "%s.openpic.lo.%i",
229 dpavlin 34 devinit->interrupt_path, i);
230     memset(&template, 0, sizeof(template));
231     template.line = 1 << i;
232     template.name = n;
233     template.extra = d;
234 dpavlin 63 template.interrupt_assert = openpic_lo_interrupt_assert;
235     template.interrupt_deassert = openpic_lo_interrupt_deassert;
236 dpavlin 34 interrupt_handler_register(&template);
237    
238 dpavlin 63 snprintf(n, sizeof(n), "%s.openpic.hi.%i",
239 dpavlin 34 devinit->interrupt_path, i);
240     memset(&template, 0, sizeof(template));
241     template.line = 1 << i;
242     template.name = n;
243     template.extra = d;
244 dpavlin 63 template.interrupt_assert = openpic_hi_interrupt_assert;
245     template.interrupt_deassert = openpic_hi_interrupt_deassert;
246 dpavlin 34 interrupt_handler_register(&template);
247     }
248    
249 dpavlin 63 memory_device_register(devinit->machine->memory, "openpic",
250     devinit->addr, DEV_OPENPIC_LENGTH, dev_openpic_access, d, DM_DEFAULT, NULL);
251 dpavlin 34
252     return 1;
253 dpavlin 22 }
254    

  ViewVC Help
Powered by ViewVC 1.1.26