xref: /netbsd/sys/arch/arm/arm32/stubs.c (revision 6550d01e)
1 /*	$NetBSD: stubs.c,v 1.22 2009/11/07 07:27:41 cegger Exp $	*/
2 
3 /*
4  * Copyright (c) 1994-1998 Mark Brinicombe.
5  * Copyright (c) 1994 Brini.
6  * All rights reserved.
7  *
8  * This code is derived from software written for Brini by Mark Brinicombe
9  *
10  * Redistribution and use in source and binary forms, with or without
11  * modification, are permitted provided that the following conditions
12  * are met:
13  * 1. Redistributions of source code must retain the above copyright
14  *    notice, this list of conditions and the following disclaimer.
15  * 2. Redistributions in binary form must reproduce the above copyright
16  *    notice, this list of conditions and the following disclaimer in the
17  *    documentation and/or other materials provided with the distribution.
18  * 3. All advertising materials mentioning features or use of this software
19  *    must display the following acknowledgement:
20  *	This product includes software developed by Mark Brinicombe
21  *	for the NetBSD Project.
22  * 4. The name of the company nor the name of the author may be used to
23  *    endorse or promote products derived from this software without specific
24  *    prior written permission.
25  *
26  * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR IMPLIED
27  * WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES OF
28  * MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
29  * IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE FOR ANY DIRECT,
30  * INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES
31  * (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR
32  * SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
33  * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
34  * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
35  * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
36  * SUCH DAMAGE.
37  *
38  * Routines that are temporary or do not have a home yet.
39  *
40  * Created      : 17/09/94
41  */
42 
43 #include <sys/cdefs.h>
44 __KERNEL_RCSID(0, "$NetBSD: stubs.c,v 1.22 2009/11/07 07:27:41 cegger Exp $");
45 
46 #include <sys/param.h>
47 #include <sys/systm.h>
48 #include <sys/errno.h>
49 #include <sys/proc.h>
50 #include <sys/conf.h>
51 #include <sys/msgbuf.h>
52 #include <uvm/uvm_extern.h>
53 #include <machine/cpu.h>
54 #include <machine/intr.h>
55 #include <machine/bootconfig.h>
56 #include <machine/pcb.h>
57 #include <arm/arm32/machdep.h>
58 #include <arm/kcore.h>
59 #include <sys/kcore.h>
60 #include <sys/core.h>
61 #include <sys/exec_aout.h>
62 
63 extern dev_t dumpdev;
64 
65 int	cpu_dump(void);
66 int	cpu_dumpsize(void);
67 u_long	cpu_dump_mempagecnt(void);
68 
69 /*
70  * These variables are needed by /sbin/savecore
71  */
72 u_int32_t dumpmag = 0x8fca0101;	/* magic number */
73 int 	dumpsize = 0;		/* pages */
74 long	dumplo = 0; 		/* blocks */
75 
76 struct pcb dumppcb;
77 
78 /*
79  * This is called by main to set dumplo and dumpsize.
80  * Dumps always skip the first PAGE_SIZE of disk space
81  * in case there might be a disk label stored there.
82  * If there is extra space, put dump at the end to
83  * reduce the chance that swapping trashes it.
84  */
85 
86 void
87 cpu_dumpconf(void)
88 {
89 	const struct bdevsw *bdev;
90 	int nblks, dumpblks;	/* size of dump area */
91 
92 	if (dumpdev == NODEV)
93 		return;
94 	bdev = bdevsw_lookup(dumpdev);
95 	if (bdev == NULL)
96 		panic("dumpconf: bad dumpdev=0x%"PRIx64"", dumpdev);
97 	if (bdev->d_psize == NULL)
98 		return;
99 	nblks = (*bdev->d_psize)(dumpdev);
100 	if (nblks <= ctod(1))
101 		return;
102 
103 	dumpblks = cpu_dumpsize();
104 	if (dumpblks < 0)
105 		goto bad;
106 	dumpblks += ctod(cpu_dump_mempagecnt());
107 
108 	/* If dump won't fit (incl. room for possible label), punt. */
109 	if (dumpblks > (nblks - ctod(1)))
110 		goto bad;
111 
112 	/* Put dump at end of partition */
113 	dumplo = nblks - dumpblks;
114 
115 	/* dumpsize is in page units, and doesn't include headers. */
116 	dumpsize = cpu_dump_mempagecnt();
117 	return;
118 
119  bad:
120 	dumpsize = 0;
121 }
122 
123 /*
124  * cpu_dump: dump the machine-dependent kernel core dump headers.
125  */
126 int
127 cpu_dump(void)
128 {
129 	int (*dump)(dev_t, daddr_t, void *, size_t);
130 	char bf[dbtob(1)];
131 	kcore_seg_t *segp;
132 	cpu_kcore_hdr_t *cpuhdrp;
133 	phys_ram_seg_t *memsegp;
134 	const struct bdevsw *bdev;
135 	int i;
136 
137 	bdev = bdevsw_lookup(dumpdev);
138 	if (bdev == NULL)
139 		return (ENXIO);
140 	dump = bdev->d_dump;
141 
142 	memset(bf, 0, sizeof bf);
143 	segp = (kcore_seg_t *)bf;
144 	cpuhdrp = (cpu_kcore_hdr_t *)&bf[ALIGN(sizeof(*segp))];
145 	memsegp = (phys_ram_seg_t *)&bf[ ALIGN(sizeof(*segp)) +
146 	    ALIGN(sizeof(*cpuhdrp))];
147 
148 	/*
149 	 * Generate a segment header.
150 	 */
151 	CORE_SETMAGIC(*segp, KCORE_MAGIC, MID_MACHINE, CORE_CPU);
152 	segp->c_size = dbtob(1) - ALIGN(sizeof(*segp));
153 
154 	/*
155 	 * Add the machine-dependent header info.
156 	 */
157 	cpuhdrp->version = 1;
158 	cpuhdrp->PAKernelL1Table = pmap_kernel_L1_addr();
159 	cpuhdrp->UserL1TableSize = 0;
160 	cpuhdrp->nmemsegs = bootconfig.dramblocks;
161 	cpuhdrp->omemsegs = ALIGN(sizeof(*cpuhdrp));
162 
163 	/*
164 	 * Fill in the memory segment descriptors.
165 	 */
166 	for (i = 0; i < bootconfig.dramblocks; i++) {
167 		memsegp[i].start = bootconfig.dram[i].address;
168 		memsegp[i].size = bootconfig.dram[i].pages * PAGE_SIZE;
169 	}
170 
171 	return (dump(dumpdev, dumplo, bf, dbtob(1)));
172 }
173 
174 /*
175  * cpu_dumpsize: calculate size of machine-dependent kernel core dump headers.
176  */
177 int
178 cpu_dumpsize(void)
179 {
180 	int size;
181 
182 	size = ALIGN(sizeof(kcore_seg_t)) + ALIGN(sizeof(cpu_kcore_hdr_t)) +
183 	    ALIGN( bootconfig.dramblocks * sizeof(phys_ram_seg_t));
184 	if (roundup(size, dbtob(1)) != dbtob(1))
185 		return (-1);
186 
187 	return (1);
188 }
189 
190 
191 /*
192  * cpu_dump_mempagecnt: calculate the size of RAM (in pages) to be dumped.
193  */
194 u_long
195 cpu_dump_mempagecnt(void)
196 {
197 	u_long i, n;
198 
199 	n = 0;
200 	for (i = 0; i < bootconfig.dramblocks; i++) {
201 		n += bootconfig.dram[i].pages;
202 	}
203 
204 	return (n);
205 }
206 
207 /* This should be moved to machdep.c */
208 
209 extern vaddr_t memhook;		/* XXX */
210 
211 /*
212  * Doadump comes here after turning off memory management and
213  * getting on the dump stack, either when called above, or by
214  * the auto-restart code.
215  */
216 void dodumpsys(void);
217 
218 void
219 dodumpsys(void)
220 {
221 	const struct bdevsw *bdev;
222 	daddr_t blkno;
223 	int psize;
224 	int error;
225 	int addr;
226 	int block;
227 	int len;
228 	vaddr_t dumpspace;
229 
230 	/* flush everything out of caches */
231 	cpu_dcache_wbinv_all();
232 
233 	if (dumpdev == NODEV)
234 		return;
235 	if (dumpsize == 0) {
236 		cpu_dumpconf();
237 	}
238 	if (dumplo <= 0 || dumpsize == 0) {
239 		printf("\ndump to dev %u,%u not possible\n",
240 		    major(dumpdev), minor(dumpdev));
241 		delay(5000000);
242 		return;
243 	}
244 	printf("\ndumping to dev %u,%u offset %ld\n",
245 	    major(dumpdev), minor(dumpdev), dumplo);
246 
247 
248 	bdev = bdevsw_lookup(dumpdev);
249 	if (bdev == NULL || bdev->d_psize == NULL)
250 		return;
251 	psize = (*bdev->d_psize)(dumpdev);
252 	printf("dump ");
253 	if (psize == -1) {
254 		printf("area unavailable\n");
255 		return;
256 	}
257 
258 	if ((error = cpu_dump()) != 0)
259 		goto err;
260 
261 	blkno = dumplo + cpu_dumpsize();
262 	dumpspace = memhook;
263 	error = 0;
264 	len = 0;
265 
266 	for (block = 0; block < bootconfig.dramblocks && error == 0; ++block) {
267 		addr = bootconfig.dram[block].address;
268 		for (;addr < (bootconfig.dram[block].address
269 		    + (bootconfig.dram[block].pages * PAGE_SIZE));
270 		     addr += PAGE_SIZE) {
271 		    	if ((len % (1024*1024)) == 0)
272 		    		printf("%d ", len / (1024*1024));
273 
274 			pmap_kenter_pa(dumpspace, addr, VM_PROT_READ, 0);
275 			pmap_update(pmap_kernel());
276 			error = (*bdev->d_dump)(dumpdev,
277 			    blkno, (void *) dumpspace, PAGE_SIZE);
278 
279 			if (error) goto err;
280 			blkno += btodb(PAGE_SIZE);
281 			len += PAGE_SIZE;
282 		}
283 	}
284 err:
285 	switch (error) {
286 	case ENXIO:
287 		printf("device bad\n");
288 		break;
289 
290 	case EFAULT:
291 		printf("device not ready\n");
292 		break;
293 
294 	case EINVAL:
295 		printf("area improper\n");
296 		break;
297 
298 	case EIO:
299 		printf("i/o error\n");
300 		break;
301 
302 	case EINTR:
303 		printf("aborted from console\n");
304 		break;
305 
306 	case 0:
307 		printf("succeeded\n");
308 		break;
309 
310 	default:
311 		printf("error %d\n", error);
312 		break;
313 	}
314 	printf("\n\n");
315 	delay(5000000);
316 }
317 
318 /* End of stubs.c */
319