2 * Copyright (c) 2002 Marcel Moolenaar
5 * Redistribution and use in source and binary forms, with or without
6 * modification, are permitted provided that the following conditions
9 * 1. Redistributions of source code must retain the above copyright
10 * notice, this list of conditions and the following disclaimer.
11 * 2. Redistributions in binary form must reproduce the above copyright
12 * notice, this list of conditions and the following disclaimer in the
13 * documentation and/or other materials provided with the distribution.
15 * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
16 * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
17 * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
18 * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,
19 * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
20 * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
21 * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
22 * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
23 * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF
24 * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
27 #include <sys/cdefs.h>
28 __FBSDID("$FreeBSD$");
30 #include <sys/param.h>
31 #include <sys/systm.h>
34 #include <sys/kernel.h>
36 #include <sys/kerneldump.h>
39 #include <machine/elf.h>
40 #include <machine/md_var.h>
41 #include <machine/pcb.h>
42 #include <machine/armreg.h>
44 CTASSERT(sizeof(struct kerneldumpheader) == 512);
47 * Don't touch the first SIZEOF_METADATA bytes on the dump device. This
48 * is to protect us from metadata and to protect metadata from us.
50 #define SIZEOF_METADATA (64*1024)
52 #define MD_ALIGN(x) (((off_t)(x) + PAGE_MASK) & ~PAGE_MASK)
53 #define DEV_ALIGN(x) (((off_t)(x) + (DEV_BSIZE-1)) & ~(DEV_BSIZE-1))
54 extern struct pcb dumppcb;
61 typedef int callback_t(struct md_pa *, int, void *);
63 static struct kerneldumpheader kdh;
64 static off_t dumplo, fileofs;
66 /* Handle buffered writes. */
67 static char buffer[DEV_BSIZE];
70 /* XXX: I suppose 20 should be enough. */
71 static struct md_pa dump_map[20];
78 bzero(dump_map, sizeof(dump_map));
79 for (n = 0; n < sizeof(dump_map) / sizeof(dump_map[0]); n++) {
81 if (dump_avail[idx] == 0 && dump_avail[idx + 1] == 0)
83 dump_map[n].md_start = dump_avail[idx];
84 dump_map[n].md_size = dump_avail[idx + 1] - dump_avail[idx];
92 return (&dump_map[0]);
96 md_pa_next(struct md_pa *mdp)
100 if (mdp->md_size == 0)
105 /* XXX should be MI */
107 mkdumpheader(struct kerneldumpheader *kdh, uint32_t archver, uint64_t dumplen,
111 bzero(kdh, sizeof(*kdh));
112 strncpy(kdh->magic, KERNELDUMPMAGIC, sizeof(kdh->magic));
113 strncpy(kdh->architecture, MACHINE_ARCH, sizeof(kdh->architecture));
114 kdh->version = htod32(KERNELDUMPVERSION);
115 kdh->architectureversion = htod32(archver);
116 kdh->dumplength = htod64(dumplen);
117 kdh->dumptime = htod64(time_second);
118 kdh->blocksize = htod32(blksz);
119 strncpy(kdh->hostname, hostname, sizeof(kdh->hostname));
120 strncpy(kdh->versionstring, version, sizeof(kdh->versionstring));
121 if (panicstr != NULL)
122 strncpy(kdh->panicstring, panicstr, sizeof(kdh->panicstring));
123 kdh->parity = kerneldump_parity(kdh);
127 buf_write(struct dumperinfo *di, char *ptr, size_t sz)
133 len = DEV_BSIZE - fragsz;
136 bcopy(ptr, buffer + fragsz, len);
140 if (fragsz == DEV_BSIZE) {
141 error = dump_write(di, buffer, 0, dumplo,
154 buf_flush(struct dumperinfo *di)
161 error = dump_write(di, buffer, 0, dumplo, DEV_BSIZE);
167 extern vm_offset_t kernel_l1kva;
171 cb_dumpdata(struct md_pa *mdp, int seqnr, void *arg)
173 struct dumperinfo *di = (struct dumperinfo*)arg;
177 size_t counter, sz, chunk;
178 int c, error, twiddle;
180 error = 0; /* catch case in which chunk size is 0 */
181 counter = 0; /* Update twiddle every 16MB */
184 pgs = mdp->md_size / PAGE_SIZE;
187 printf(" chunk %d: %dMB (%d pages)", seqnr, pgs * PAGE_SIZE / (
190 /* Make sure we write coherent datas. */
191 cpu_idcache_wbinv_all();
193 xscale_cache_clean_minidata();
197 if (chunk > MAXDUMPPGS)
199 sz = chunk << PAGE_SHIFT;
202 printf(" %d", pgs * PAGE_SIZE);
203 counter &= (1<<24) - 1;
205 if (pa == (pa & L1_ADDR_BITS)) {
206 pmap_kenter_section(0, pa & L1_ADDR_BITS, 0);
207 cpu_tlb_flushID_SE(0);
210 error = dump_write(di,
211 (void *)(pa - (pa & L1_ADDR_BITS)),0, dumplo, sz);
218 /* Check for user abort. */
223 printf(" (CTRL-C to abort) ");
225 printf(" ... %s\n", (error) ? "fail" : "ok");
230 cb_dumphdr(struct md_pa *mdp, int seqnr, void *arg)
232 struct dumperinfo *di = (struct dumperinfo*)arg;
238 bzero(&phdr, sizeof(phdr));
239 phdr.p_type = PT_LOAD;
240 phdr.p_flags = PF_R; /* XXX */
241 phdr.p_offset = fileofs;
242 phdr.p_vaddr = mdp->md_start;
243 phdr.p_paddr = mdp->md_start;
244 phdr.p_filesz = size;
246 phdr.p_align = PAGE_SIZE;
248 error = buf_write(di, (char*)&phdr, sizeof(phdr));
249 fileofs += phdr.p_filesz;
254 cb_size(struct md_pa *mdp, int seqnr, void *arg)
256 uint32_t *sz = (uint32_t*)arg;
258 *sz += (uint32_t)mdp->md_size;
263 foreach_chunk(callback_t cb, void *arg)
270 while (mdp != NULL) {
271 error = (*cb)(mdp, seqnr++, arg);
274 mdp = md_pa_next(mdp);
280 dumpsys(struct dumperinfo *di)
288 bzero(&ehdr, sizeof(ehdr));
289 ehdr.e_ident[EI_MAG0] = ELFMAG0;
290 ehdr.e_ident[EI_MAG1] = ELFMAG1;
291 ehdr.e_ident[EI_MAG2] = ELFMAG2;
292 ehdr.e_ident[EI_MAG3] = ELFMAG3;
293 ehdr.e_ident[EI_CLASS] = ELF_CLASS;
294 #if BYTE_ORDER == LITTLE_ENDIAN
295 ehdr.e_ident[EI_DATA] = ELFDATA2LSB;
297 ehdr.e_ident[EI_DATA] = ELFDATA2MSB;
299 ehdr.e_ident[EI_VERSION] = EV_CURRENT;
300 ehdr.e_ident[EI_OSABI] = ELFOSABI_STANDALONE; /* XXX big picture? */
301 ehdr.e_type = ET_CORE;
302 ehdr.e_machine = EM_ARM;
303 ehdr.e_phoff = sizeof(ehdr);
305 ehdr.e_ehsize = sizeof(ehdr);
306 ehdr.e_phentsize = sizeof(Elf_Phdr);
307 ehdr.e_shentsize = sizeof(Elf_Shdr);
311 /* Calculate dump size. */
313 ehdr.e_phnum = foreach_chunk(cb_size, &dumpsize);
314 hdrsz = ehdr.e_phoff + ehdr.e_phnum * ehdr.e_phentsize;
315 fileofs = MD_ALIGN(hdrsz);
317 hdrgap = fileofs - DEV_ALIGN(hdrsz);
319 /* Determine dump offset on device. */
320 if (di->mediasize < SIZEOF_METADATA + dumpsize + sizeof(kdh) * 2) {
324 dumplo = di->mediaoffset + di->mediasize - dumpsize;
325 dumplo -= sizeof(kdh) * 2;
327 mkdumpheader(&kdh, KERNELDUMP_ARM_VERSION, dumpsize, di->blocksize);
329 printf("Dumping %llu MB (%d chunks)\n", (long long)dumpsize >> 20,
333 error = dump_write(di, &kdh, 0, dumplo, sizeof(kdh));
336 dumplo += sizeof(kdh);
338 /* Dump ELF header */
339 error = buf_write(di, (char*)&ehdr, sizeof(ehdr));
343 /* Dump program headers */
344 error = foreach_chunk(cb_dumphdr, di);
350 * All headers are written using blocked I/O, so we know the
351 * current offset is (still) block aligned. Skip the alignement
352 * in the file to have the segment contents aligned at page
353 * boundary. We cannot use MD_ALIGN on dumplo, because we don't
354 * care and may very well be unaligned within the dump device.
358 /* Dump memory chunks (updates dumplo) */
359 error = foreach_chunk(cb_dumpdata, di);
364 error = dump_write(di, &kdh, 0, dumplo, sizeof(kdh));
368 /* Signal completion, signoff and exit stage left. */
369 dump_write(di, NULL, 0, 0, 0);
370 printf("\nDump complete\n");
377 if (error == ECANCELED)
378 printf("\nDump aborted\n");
379 else if (error == ENOSPC)
380 printf("\nDump failed. Partition too small.\n");
382 printf("\n** DUMP FAILED (ERROR %d) **\n", error);