sys/arch/arm/arm32/stubs.c

   1 /*      $NetBSD: stubs.c,v 1.21 2009/03/15 22:20:10 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.21 2009/03/15 22:20:10 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 */