Annotation of sys/arch/m88k/m88k/m88k_machdep.c, Revision 1.1.1.1
1.1 nbrk 1: /* $OpenBSD: m88k_machdep.c,v 1.21 2007/05/29 18:10:42 miod Exp $ */
2: /*
3: * Copyright (c) 1998, 1999, 2000, 2001 Steve Murphree, Jr.
4: * Copyright (c) 1996 Nivas Madhur
5: * All rights reserved.
6: *
7: * Redistribution and use in source and binary forms, with or without
8: * modification, are permitted provided that the following conditions
9: * are met:
10: * 1. Redistributions of source code must retain the above copyright
11: * notice, this list of conditions and the following disclaimer.
12: * 2. Redistributions in binary form must reproduce the above copyright
13: * notice, this list of conditions and the following disclaimer in the
14: * documentation and/or other materials provided with the distribution.
15: * 3. All advertising materials mentioning features or use of this software
16: * must display the following acknowledgement:
17: * This product includes software developed by Nivas Madhur.
18: * 4. The name of the author may not be used to endorse or promote products
19: * derived from this software without specific prior written permission
20: *
21: * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
22: * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
23: * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
24: * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,
25: * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
26: * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
27: * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
28: * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
29: * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF
30: * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
31: *
32: */
33: /*
34: * Mach Operating System
35: * Copyright (c) 1993-1991 Carnegie Mellon University
36: * Copyright (c) 1991 OMRON Corporation
37: * All Rights Reserved.
38: *
39: * Permission to use, copy, modify and distribute this software and its
40: * documentation is hereby granted, provided that both the copyright
41: * notice and this permission notice appear in all copies of the
42: * software, derivative works or modified versions, and any portions
43: * thereof, and that both notices appear in supporting documentation.
44: *
45: */
46:
47: #include <sys/param.h>
48: #include <sys/systm.h>
49: #include <sys/kernel.h>
50: #include <sys/proc.h>
51: #include <sys/user.h>
52: #include <sys/msgbuf.h>
53: #include <sys/exec.h>
54: #include <sys/errno.h>
55: #include <sys/lock.h>
56: #ifdef MULTIPROCESSOR
57: #include <sys/mplock.h>
58: #endif
59:
60: #include <machine/asm.h>
61: #include <machine/asm_macro.h>
62: #include <machine/atomic.h>
63: #include <machine/cmmu.h>
64: #include <machine/cpu.h>
65: #include <machine/reg.h>
66: #ifdef M88100
67: #include <machine/m88100.h>
68: #endif
69:
70: #include <uvm/uvm_extern.h>
71:
72: #include <net/netisr.h>
73:
74: #ifdef DDB
75: #include <machine/db_machdep.h>
76: #include <ddb/db_extern.h>
77: #include <ddb/db_interface.h>
78: #endif /* DDB */
79:
80: typedef struct {
81: u_int32_t word_one, word_two;
82: } m88k_exception_vector_area;
83:
84: void dosoftint(void);
85: void dumpconf(void);
86: void dumpsys(void);
87: void regdump(struct trapframe *f);
88: void vector_init(m88k_exception_vector_area *, u_int32_t *);
89:
90: /*
91: * CMMU and CPU variables
92: */
93:
94: #ifdef MULTIPROCESSOR
95: __cpu_simple_lock_t cmmu_cpu_lock = __SIMPLELOCK_UNLOCKED;
96: cpuid_t master_cpu;
97: struct __mp_lock sir_lock;
98: #endif
99:
100: struct cpu_info m88k_cpus[MAX_CPUS];
101: u_int max_cpus;
102:
103: struct cmmu_p *cmmu;
104:
105: /*
106: * safepri is a safe priority for sleep to set for a spin-wait
107: * during autoconfiguration or after a panic.
108: */
109: int safepri = IPL_NONE;
110:
111: /*
112: * Set registers on exec.
113: * Clear all except sp and pc.
114: */
115: void
116: setregs(p, pack, stack, retval)
117: struct proc *p;
118: struct exec_package *pack;
119: u_long stack;
120: int retval[2];
121: {
122: struct trapframe *tf = (struct trapframe *)USER_REGS(p);
123:
124: /*
125: * The syscall will ``return'' to snip; set it.
126: * argc, argv, envp are placed on the stack by copyregs.
127: * Point r2 to the stack. crt0 should extract envp from
128: * argc & argv before calling user's main.
129: */
130:
131: bzero((caddr_t)tf, sizeof *tf);
132:
133: #ifdef M88110
134: if (CPU_IS88110) {
135: /*
136: * user mode, serialize mem, interrupts enabled,
137: * graphics unit, fp enabled
138: */
139: tf->tf_epsr = PSR_SRM | PSR_SFD;
140: /*
141: * XXX disable OoO for now...
142: */
143: tf->tf_epsr |= PSR_SER;
144: }
145: #endif
146: #ifdef M88100
147: if (CPU_IS88100) {
148: /*
149: * user mode, interrupts enabled,
150: * no graphics unit, fp enabled
151: */
152: tf->tf_epsr = PSR_SFD | PSR_SFD2;
153: }
154: #endif
155:
156: /*
157: * We want to start executing at pack->ep_entry. The way to
158: * do this is force the processor to fetch from ep_entry. Set
159: * NIP to something bogus and invalid so that it will be a NOOP.
160: * And set sfip to ep_entry with valid bit on so that it will be
161: * fetched. mc88110 - just set exip to pack->ep_entry.
162: */
163: #ifdef M88110
164: if (CPU_IS88110) {
165: tf->tf_exip = pack->ep_entry & XIP_ADDR;
166: }
167: #endif
168: #ifdef M88100
169: if (CPU_IS88100) {
170: tf->tf_snip = pack->ep_entry & NIP_ADDR;
171: tf->tf_sfip = (pack->ep_entry & FIP_ADDR) | FIP_V;
172: }
173: #endif
174: tf->tf_r[2] = stack;
175: tf->tf_r[31] = stack;
176: retval[1] = 0;
177: }
178:
179: int
180: copystr(fromaddr, toaddr, maxlength, lencopied)
181: const void *fromaddr;
182: void *toaddr;
183: size_t maxlength;
184: size_t *lencopied;
185: {
186: u_int tally;
187:
188: tally = 0;
189:
190: while (maxlength--) {
191: *(u_char *)toaddr = *(u_char *)fromaddr++;
192: tally++;
193: if (*(u_char *)toaddr++ == 0) {
194: if (lencopied) *lencopied = tally;
195: return (0);
196: }
197: }
198:
199: if (lencopied)
200: *lencopied = tally;
201:
202: return (ENAMETOOLONG);
203: }
204:
205: void
206: setrunqueue(p)
207: struct proc *p;
208: {
209: struct prochd *q;
210: struct proc *oldlast;
211: int which = p->p_priority >> 2;
212:
213: #ifdef DIAGNOSTIC
214: if (p->p_back != NULL)
215: panic("setrunqueue %p", p);
216: #endif
217: q = &qs[which];
218: whichqs |= 1 << which;
219: p->p_forw = (struct proc *)q;
220: p->p_back = oldlast = q->ph_rlink;
221: q->ph_rlink = p;
222: oldlast->p_forw = p;
223: }
224:
225: /*
226: * Remove process p from its run queue, which should be the one
227: * indicated by its priority. Calls should be made at splstatclock().
228: */
229: void
230: remrunqueue(vp)
231: struct proc *vp;
232: {
233: struct proc *p = vp;
234: int which = p->p_priority >> 2;
235: struct prochd *q;
236:
237: #ifdef DIAGNOSTIC
238: if ((whichqs & (1 << which)) == 0)
239: panic("remrq %p", p);
240: #endif
241: p->p_forw->p_back = p->p_back;
242: p->p_back->p_forw = p->p_forw;
243: p->p_back = NULL;
244: q = &qs[which];
245: if (q->ph_link == (struct proc *)q)
246: whichqs &= ~(1 << which);
247: }
248:
249: #ifdef DDB
250: int longformat = 1;
251: void
252: regdump(struct trapframe *f)
253: {
254: #define R(i) f->tf_r[i]
255: printf("R00-05: 0x%08x 0x%08x 0x%08x 0x%08x 0x%08x 0x%08x\n",
256: R(0),R(1),R(2),R(3),R(4),R(5));
257: printf("R06-11: 0x%08x 0x%08x 0x%08x 0x%08x 0x%08x 0x%08x\n",
258: R(6),R(7),R(8),R(9),R(10),R(11));
259: printf("R12-17: 0x%08x 0x%08x 0x%08x 0x%08x 0x%08x 0x%08x\n",
260: R(12),R(13),R(14),R(15),R(16),R(17));
261: printf("R18-23: 0x%08x 0x%08x 0x%08x 0x%08x 0x%08x 0x%08x\n",
262: R(18),R(19),R(20),R(21),R(22),R(23));
263: printf("R24-29: 0x%08x 0x%08x 0x%08x 0x%08x 0x%08x 0x%08x\n",
264: R(24),R(25),R(26),R(27),R(28),R(29));
265: printf("R30-31: 0x%08x 0x%08x\n",R(30),R(31));
266: #ifdef M88110
267: if (CPU_IS88110) {
268: printf("exip %x enip %x\n", f->tf_exip, f->tf_enip);
269: }
270: #endif
271: #ifdef M88100
272: if (CPU_IS88100) {
273: printf("sxip %x snip %x sfip %x\n",
274: f->tf_sxip, f->tf_snip, f->tf_sfip);
275: }
276: if (CPU_IS88100 && f->tf_vector == 0x3) {
277: /* print dmt stuff for data access fault */
278: printf("dmt0 %x dmd0 %x dma0 %x\n",
279: f->tf_dmt0, f->tf_dmd0, f->tf_dma0);
280: printf("dmt1 %x dmd1 %x dma1 %x\n",
281: f->tf_dmt1, f->tf_dmd1, f->tf_dma1);
282: printf("dmt2 %x dmd2 %x dma2 %x\n",
283: f->tf_dmt2, f->tf_dmd2, f->tf_dma2);
284: printf("fault type %d\n", (f->tf_dpfsr >> 16) & 0x7);
285: dae_print((unsigned *)f);
286: }
287: if (CPU_IS88100 && longformat != 0) {
288: printf("fpsr %x fpcr %x epsr %x ssbr %x\n",
289: f->tf_fpsr, f->tf_fpcr, f->tf_epsr, f->tf_ssbr);
290: printf("fpecr %x fphs1 %x fpls1 %x fphs2 %x fpls2 %x\n",
291: f->tf_fpecr, f->tf_fphs1, f->tf_fpls1,
292: f->tf_fphs2, f->tf_fpls2);
293: printf("fppt %x fprh %x fprl %x fpit %x\n",
294: f->tf_fppt, f->tf_fprh, f->tf_fprl, f->tf_fpit);
295: printf("vector %d mask %x mode %x scratch1 %x cpu %p\n",
296: f->tf_vector, f->tf_mask, f->tf_mode,
297: f->tf_scratch1, f->tf_cpu);
298: }
299: #endif
300: #ifdef M88110
301: if (CPU_IS88110 && longformat != 0) {
302: printf("fpsr %x fpcr %x fpecr %x epsr %x\n",
303: f->tf_fpsr, f->tf_fpcr, f->tf_fpecr, f->tf_epsr);
304: printf("dsap %x duap %x dsr %x dlar %x dpar %x\n",
305: f->tf_dsap, f->tf_duap, f->tf_dsr, f->tf_dlar, f->tf_dpar);
306: printf("isap %x iuap %x isr %x ilar %x ipar %x\n",
307: f->tf_isap, f->tf_iuap, f->tf_isr, f->tf_ilar, f->tf_ipar);
308: printf("vector %d mask %x mode %x scratch1 %x cpu %p\n",
309: f->tf_vector, f->tf_mask, f->tf_mode,
310: f->tf_scratch1, f->tf_cpu);
311: }
312: #endif
313: }
314: #endif /* DDB */
315:
316: /*
317: * Set up the cpu_info pointer and the cpu number for the current processor.
318: */
319: void
320: set_cpu_number(cpuid_t number)
321: {
322: struct cpu_info *ci;
323: extern struct pcb idle_u;
324:
325: #ifdef MULTIPROCESSOR
326: ci = &m88k_cpus[number];
327: #else
328: ci = &m88k_cpus[0];
329: #endif
330: ci->ci_cpuid = number;
331:
332: __asm__ __volatile__ ("stcr %0, cr17" :: "r" (ci));
333: flush_pipeline();
334:
335: #ifdef MULTIPROCESSOR
336: if (number == master_cpu)
337: #endif
338: {
339: ci->ci_primary = 1;
340: ci->ci_idle_pcb = &idle_u;
341:
342: #ifdef MULTIPROCESSOR
343: /*
344: * Specific initialization for the master processor.
345: */
346: __mp_lock_init(&sir_lock);
347: #endif
348: }
349:
350: ci->ci_alive = 1;
351: }
352:
353: /*
354: * Notify the current process (p) that it has a signal pending,
355: * process as soon as possible.
356: */
357: void
358: signotify(struct proc *p)
359: {
360: aston(p);
361: #ifdef MULTIPROCESSOR
362: if (p->p_cpu != curcpu() && p->p_cpu != NULL)
363: m88k_send_ipi(CI_IPI_NOTIFY, p->p_cpu->ci_cpuid);
364: #endif
365: }
366:
367: /*
368: * Soft interrupt interface
369: */
370:
371: unsigned int ssir;
372: int netisr;
373:
374: void
375: dosoftint()
376: {
377: int sir, n;
378:
379: if ((sir = ssir) == 0)
380: return;
381:
382: atomic_clearbits_int(&ssir, sir);
383: uvmexp.softs++;
384:
385: if (ISSET(sir, SIR_NET)) {
386: while ((n = netisr) != 0) {
387: atomic_clearbits_int(&netisr, n);
388:
389: #define DONETISR(bit, fn) \
390: do { \
391: if (n & (1 << bit)) \
392: fn(); \
393: } while (0)
394:
395: #include <net/netisr_dispatch.h>
396:
397: #undef DONETISR
398: }
399: }
400:
401: if (ISSET(sir, SIR_CLOCK))
402: softclock();
403: }
404:
405: int
406: spl0()
407: {
408: int s;
409:
410: s = setipl(IPL_SOFTCLOCK);
411:
412: dosoftint();
413:
414: setipl(IPL_NONE);
415: return (s);
416: }
417:
418: #define EMPTY_BR 0xc0000000 /* empty "br" instruction */
419: #define NO_OP 0xf4005800 /* "or r0, r0, r0" */
420:
421: #define BRANCH(FROM, TO) \
422: (EMPTY_BR | ((vaddr_t)(TO) - (vaddr_t)(FROM)) >> 2)
423:
424: #define SET_VECTOR(NUM, VALUE) \
425: do { \
426: vbr[NUM].word_one = NO_OP; \
427: vbr[NUM].word_two = BRANCH(&vbr[NUM].word_two, VALUE); \
428: } while (0)
429:
430: /*
431: * vector_init(vector, vector_init_list)
432: *
433: * This routine sets up the m88k vector table for the running processor.
434: * This is the first C code to run, before anything is initialized.
435: *
436: * It fills the exception vectors page. I would add an extra four bytes
437: * to the page pointed to by the vbr, since the 88100 may execute the
438: * first instruction of the next trap handler, as documented in its
439: * Errata. Processing trap #511 would then fall into the next page,
440: * unless the address computation wraps, or software traps can not trigger
441: * the issue - the Errata does not provide more detail. And since the
442: * MVME BUG does not add an extra NOP after their VBR page, I'll assume this
443: * is safe for now -- miod
444: */
445: void
446: vector_init(m88k_exception_vector_area *vbr, u_int32_t *vector_init_list)
447: {
448: u_int num;
449: u_int32_t vec;
450:
451: for (num = 0; (vec = vector_init_list[num]) != 0; num++)
452: SET_VECTOR(num, vec);
453:
454: switch (cputyp) {
455: default:
456: #ifdef M88110
457: case CPU_88110:
458: {
459: extern void m88110_sigsys(void);
460: extern void m88110_syscall_handler(void);
461: extern void m88110_cache_flush_handler(void);
462: extern void m88110_stepbpt(void);
463: extern void m88110_userbpt(void);
464:
465: for (; num < 512; num++)
466: SET_VECTOR(num, m88110_sigsys);
467:
468: SET_VECTOR(450, m88110_syscall_handler);
469: SET_VECTOR(451, m88110_cache_flush_handler);
470: SET_VECTOR(504, m88110_stepbpt);
471: SET_VECTOR(511, m88110_userbpt);
472: }
473: break;
474: #endif
475: #ifdef M88100
476: case CPU_88100:
477: {
478: extern void sigsys(void);
479: extern void syscall_handler(void);
480: extern void cache_flush_handler(void);
481: extern void stepbpt(void);
482: extern void userbpt(void);
483:
484: for (; num < 512; num++)
485: SET_VECTOR(num, sigsys);
486:
487: SET_VECTOR(450, syscall_handler);
488: SET_VECTOR(451, cache_flush_handler);
489: SET_VECTOR(504, stepbpt);
490: SET_VECTOR(511, userbpt);
491: }
492: break;
493: #endif
494: }
495:
496: /* GCC will by default produce explicit trap 503 for division by zero */
497: SET_VECTOR(503, vector_init_list[8]);
498: }
CVSweb