xref: /netbsd-src/sys/arch/luna68k/stand/boot/machdep.c (revision b7b7574d3bf8eeb51a1fa3977b59142ec6434a55)
1 /*	$NetBSD: machdep.c,v 1.3 2014/04/16 11:18:00 tsutsui Exp $	*/
2 
3 /*
4  * Copyright (c) 1992 OMRON Corporation.
5  *
6  * This code is derived from software contributed to Berkeley by
7  * OMRON Corporation.
8  *
9  * Redistribution and use in source and binary forms, with or without
10  * modification, are permitted provided that the following conditions
11  * are met:
12  * 1. Redistributions of source code must retain the above copyright
13  *    notice, this list of conditions and the following disclaimer.
14  * 2. Redistributions in binary form must reproduce the above copyright
15  *    notice, this list of conditions and the following disclaimer in the
16  *    documentation and/or other materials provided with the distribution.
17  * 3. All advertising materials mentioning features or use of this software
18  *    must display the following acknowledgement:
19  *	This product includes software developed by the University of
20  *	California, Berkeley and its contributors.
21  * 4. Neither the name of the University nor the names of its contributors
22  *    may be used to endorse or promote products derived from this software
23  *    without specific prior written permission.
24  *
25  * THIS SOFTWARE IS PROVIDED BY THE REGENTS AND CONTRIBUTORS ``AS IS'' AND
26  * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
27  * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
28  * ARE DISCLAIMED.  IN NO EVENT SHALL THE REGENTS OR CONTRIBUTORS BE LIABLE
29  * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
30  * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
31  * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
32  * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
33  * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
34  * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
35  * SUCH DAMAGE.
36  *
37  *	@(#)machdep.c	8.1 (Berkeley) 6/10/93
38  */
39 /*
40  * Copyright (c) 1992, 1993
41  *	The Regents of the University of California.  All rights reserved.
42  *
43  * This code is derived from software contributed to Berkeley by
44  * OMRON Corporation.
45  *
46  * Redistribution and use in source and binary forms, with or without
47  * modification, are permitted provided that the following conditions
48  * are met:
49  * 1. Redistributions of source code must retain the above copyright
50  *    notice, this list of conditions and the following disclaimer.
51  * 2. Redistributions in binary form must reproduce the above copyright
52  *    notice, this list of conditions and the following disclaimer in the
53  *    documentation and/or other materials provided with the distribution.
54  * 3. Neither the name of the University nor the names of its contributors
55  *    may be used to endorse or promote products derived from this software
56  *    without specific prior written permission.
57  *
58  * THIS SOFTWARE IS PROVIDED BY THE REGENTS AND CONTRIBUTORS ``AS IS'' AND
59  * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
60  * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
61  * ARE DISCLAIMED.  IN NO EVENT SHALL THE REGENTS OR CONTRIBUTORS BE LIABLE
62  * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
63  * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
64  * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
65  * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
66  * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
67  * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
68  * SUCH DAMAGE.
69  *
70  *	@(#)machdep.c	8.1 (Berkeley) 6/10/93
71  */
72 
73 #include <sys/param.h>
74 #include <luna68k/include/reg.h>
75 #include <luna68k/stand/boot/samachdep.h>
76 
77 static void dumpmem(int *, int, int);
78 
79 void
80 straytrap(int addr)
81 {
82 	printf("stray trap, addr 0x%x\n", addr);
83 }
84 
85 int	*nofault = 0;
86 
87 int
88 badaddr(volatile void *addr)
89 {
90 	label_t	faultbuf;
91 
92 #ifdef lint
93 	int i;
94 	i = *addr; if (i) return 0;
95 #endif
96 	nofault = (int *) &faultbuf;
97 	if (setjmp((label_t *)nofault)) {
98 		nofault = NULL;
99 		return 1;
100 	}
101 	(void)*(volatile short *)addr;
102 	nofault = NULL;
103 	return 0;
104 }
105 
106 void
107 regdump(int *rp /* must not be register */, int sbytes)
108 {
109 	static int doingdump = 0;
110 	int i;
111 	int s;
112 
113 	if (doingdump)
114 		return;
115 	s = splhigh();
116 	doingdump = 1;
117 #if 0
118 	printf("pid = %d, pc = %s, ", u.u_procp->p_pid, hexstr(rp[PC], 8));
119 #endif
120 	printf("pc = %s, ", hexstr(rp[PC], 8));
121 	printf("ps = %s, ", hexstr(rp[PS], 4));
122 	printf("sfc = %s, ", hexstr(getsfc(), 4));
123 	printf("dfc = %s\n", hexstr(getdfc(), 4));
124 #if 0
125 	printf("p0 = %x@%s, ",
126 	       u.u_pcb.pcb_p0lr, hexstr((int)u.u_pcb.pcb_p0br, 8));
127 	printf("p1 = %x@%s\n\n",
128 	       u.u_pcb.pcb_p1lr, hexstr((int)u.u_pcb.pcb_p1br, 8));
129 #endif
130 	printf("Registers:\n     ");
131 	for (i = 0; i < 8; i++)
132 		printf("        %d", i);
133 	printf("\ndreg:");
134 	for (i = 0; i < 8; i++)
135 		printf(" %s", hexstr(rp[i], 8));
136 	printf("\nareg:");
137 	for (i = 0; i < 8; i++)
138 		printf(" %s", hexstr(rp[i+8], 8));
139 	if (sbytes > 0) {
140 #if 0
141 		if (rp[PS] & PSL_S) {
142 #endif
143 			printf("\n\nKernel stack (%s):",
144 			       hexstr((int)(((int *)&rp) - 1), 8));
145 			dumpmem(((int *)&rp) - 1, sbytes, 0);
146 #if 0
147 		} else {
148 			printf("\n\nUser stack (%s):", hexstr(rp[SP], 8));
149 			dumpmem((int *)rp[SP], sbytes, 1);
150 		}
151 #endif
152 	}
153 	doingdump = 0;
154 	splx(s);
155 }
156 
157 /*	#define KSADDR	((int *)&(((char *)&u)[(UPAGES-1)*NBPG]))	*/
158 
159 void
160 dumpmem(int *ptr, int sz, int ustack)
161 {
162 	int i, val;
163 
164 	for (i = 0; i < sz; i++) {
165 		if ((i & 7) == 0)
166 			printf("\n%s: ", hexstr((int)ptr, 6));
167 		else
168 			printf(" ");
169 #if 0
170 		if (ustack == 1) {
171 			if ((val = fuword(ptr++)) == -1)
172 				break;
173 		} else {
174 			if (ustack == 0 &&
175 			    (ptr < KSADDR || ptr > KSADDR+(NBPG/4-1)))
176 				break;
177 #endif
178 			val = *ptr++;
179 #if 0
180 		}
181 #endif
182 		printf("%s", hexstr(val, 8));
183 	}
184 	printf("\n");
185 }
186 
187 char *
188 hexstr(int val, int len)
189 {
190 	static char nbuf[9];
191 	int x, i;
192 
193 	if (len > 8)
194 		return "";
195 	nbuf[len] = '\0';
196 	for (i = len-1; i >= 0; --i) {
197 		x = val & 0xF;
198 		if (x > 9)
199 			nbuf[i] = x - 10 + 'A';
200 		else
201 			nbuf[i] = x + '0';
202 		val >>= 4;
203 	}
204 	return nbuf;
205 }
206