root/lib/libkvm/kvm_m68k_cmn.c
/*      $NetBSD: kvm_m68k_cmn.c,v 1.18 2014/03/04 06:38:08 matt Exp $   */

/*-
 * Copyright (c) 1989, 1992, 1993
 *      The Regents of the University of California.  All rights reserved.
 *
 * This code is derived from software developed by the Computer Systems
 * Engineering group at Lawrence Berkeley Laboratory under DARPA contract
 * BG 91-66 and contributed to Berkeley.
 *
 * Redistribution and use in source and binary forms, with or without
 * modification, are permitted provided that the following conditions
 * are met:
 * 1. Redistributions of source code must retain the above copyright
 *    notice, this list of conditions and the following disclaimer.
 * 2. Redistributions in binary form must reproduce the above copyright
 *    notice, this list of conditions and the following disclaimer in the
 *    documentation and/or other materials provided with the distribution.
 * 3. Neither the name of the University nor the names of its contributors
 *    may be used to endorse or promote products derived from this software
 *    without specific prior written permission.
 *
 * THIS SOFTWARE IS PROVIDED BY THE REGENTS AND CONTRIBUTORS ``AS IS'' AND
 * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
 * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
 * ARE DISCLAIMED.  IN NO EVENT SHALL THE REGENTS OR CONTRIBUTORS BE LIABLE
 * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
 * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
 * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
 * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
 * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
 * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
 * SUCH DAMAGE.
 */

/*-
 * Copyright (c) 1997 Jason R. Thorpe.  All rights reserved.
 *
 * This code is derived from software developed by the Computer Systems
 * Engineering group at Lawrence Berkeley Laboratory under DARPA contract
 * BG 91-66 and contributed to Berkeley.
 *
 * Redistribution and use in source and binary forms, with or without
 * modification, are permitted provided that the following conditions
 * are met:
 * 1. Redistributions of source code must retain the above copyright
 *    notice, this list of conditions and the following disclaimer.
 * 2. Redistributions in binary form must reproduce the above copyright
 *    notice, this list of conditions and the following disclaimer in the
 *    documentation and/or other materials provided with the distribution.
 * 3. All advertising materials mentioning features or use of this software
 *    must display the following acknowledgement:
 *      This product includes software developed by the University of
 *      California, Berkeley and its contributors.
 * 4. Neither the name of the University nor the names of its contributors
 *    may be used to endorse or promote products derived from this software
 *    without specific prior written permission.
 *
 * THIS SOFTWARE IS PROVIDED BY THE REGENTS AND CONTRIBUTORS ``AS IS'' AND
 * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
 * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
 * ARE DISCLAIMED.  IN NO EVENT SHALL THE REGENTS OR CONTRIBUTORS BE LIABLE
 * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
 * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
 * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
 * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
 * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
 * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
 * SUCH DAMAGE.
 */

#include <sys/cdefs.h>
#if defined(LIBC_SCCS) && !defined(lint)
#if 0
static char sccsid[] = "@(#)kvm_hp300.c 8.1 (Berkeley) 6/4/93";
#else
__RCSID("$NetBSD: kvm_m68k_cmn.c,v 1.18 2014/03/04 06:38:08 matt Exp $");
#endif
#endif /* LIBC_SCCS and not lint */

/*
 * Common m68k machine dependent routines for kvm.
 *
 * Note: This file has to build on ALL m68k machines,
 * so do NOT include any <machine / *.h> files here.
 */

#include <sys/param.h>
#include <sys/types.h>
#include <sys/kcore.h>

#include <unistd.h>
#include <limits.h>
#include <nlist.h>
#include <kvm.h>
#include <db.h>

#include <m68k/cpu.h>
#include <m68k/kcore.h>
#include <m68k/m68k.h>

#include "kvm_private.h"
#include "kvm_m68k.h"

int   _kvm_cmn_initvtop(kvm_t *);
void  _kvm_cmn_freevtop(kvm_t *);
int   _kvm_cmn_kvatop(kvm_t *, vaddr_t, paddr_t *);
off_t _kvm_cmn_pa2off(kvm_t *, paddr_t);

struct kvm_ops _kvm_ops_cmn = {
        _kvm_cmn_initvtop,
        _kvm_cmn_freevtop,
        _kvm_cmn_kvatop,
        _kvm_cmn_pa2off };

static int vatop_030(kvm_t *, uint32_t, vaddr_t, paddr_t *);
static int vatop_040(kvm_t *, uint32_t, vaddr_t, paddr_t *);

#define _kvm_btop(v, a) (((unsigned)(a)) >> (v)->pgshift)

void
_kvm_cmn_freevtop(kvm_t *kd)
{
        /* No private state information to keep. */
}

int
_kvm_cmn_initvtop(kvm_t *kd)
{
        /* No private state information to keep. */
        return (0);
}

int
_kvm_cmn_kvatop(kvm_t *kd, vaddr_t va, paddr_t *pa)
{
        cpu_kcore_hdr_t *h = kd->cpu_data;
        struct m68k_kcore_hdr *m = &h->un._m68k;
        int (*vtopf)(kvm_t *, uint32_t, vaddr_t, paddr_t *);

        if (ISALIVE(kd)) {
                _kvm_err(kd, 0, "vatop called in live kernel!");
                return (0);
        }

        /*
         * 68040 and 68060 use same translation functions,
         * as do 68030, 68851, HP MMU.
         */
        if (m->mmutype == MMU_68040 || m->mmutype == MMU_68060)
                vtopf = vatop_040;
        else
                vtopf = vatop_030;

        return ((*vtopf)(kd, m->sysseg_pa, va, pa));
}

/*
 * Translate a physical address to a file-offset in the crash dump.
 */
off_t
_kvm_cmn_pa2off(kvm_t *kd, u_long pa)
{
        cpu_kcore_hdr_t *h = kd->cpu_data;
        struct m68k_kcore_hdr *m = &h->un._m68k;
        phys_ram_seg_t *rsp;
        off_t off;
        int i;

        off = 0;
        rsp = m->ram_segs;
        for (i = 0; i < M68K_NPHYS_RAM_SEGS && rsp[i].size != 0; i++) {
                if (pa >= rsp[i].start &&
                    pa < (rsp[i].start + rsp[i].size)) {
                        pa -= rsp[i].start;
                        break;
                }
                off += rsp[i].size;
        }
        return (kd->dump_off + off + pa);
}

/*****************************************************************
 * Local stuff...
 */

static int
vatop_030(kvm_t *kd, uint32_t stpa, vaddr_t va, paddr_t *pa)
{
        cpu_kcore_hdr_t *h = kd->cpu_data;
        struct m68k_kcore_hdr *m = &h->un._m68k;
        struct vmstate *vm = kd->vmst;
        paddr_t addr;
        uint32_t ste, pte;
        u_int p, offset;

        offset = va & vm->pgofset;

        /*
         * We may be called before address translation is initialized.
         * This is typically used to find the dump magic number.  This
         * means we do not yet have the kernel page tables available,
         * so we must to a simple relocation.
         */
        if (va < m->relocend) {
                *pa = (va - h->kernbase) + m->reloc;
                return (h->page_size - offset);
        }

        addr = stpa + ((va >> m->sg_ishift) * sizeof(u_int32_t));

        /*
         * Can't use KREAD to read kernel segment table entries.
         * Fortunately it is 1-to-1 mapped so we don't have to.
         */
        if (stpa == m->sysseg_pa) {
                if (_kvm_pread(kd, kd->pmfd, &ste, sizeof(ste),
                    _kvm_cmn_pa2off(kd, addr)) != sizeof(ste))
                        goto invalid;
        } else if (KREAD(kd, addr, &ste))
                goto invalid;
        if ((ste & m->sg_v) == 0) {
                _kvm_err(kd, 0, "invalid segment (%x)", ste);
                return(0);
        }
        p = _kvm_btop(vm, va & m->sg_pmask);
        addr = (ste & m->sg_frame) + (p * sizeof(u_int32_t));

        /*
         * Address from STE is a physical address so don't use kvm_read.
         */
        if (_kvm_pread(kd, kd->pmfd, &pte, sizeof(pte),
            _kvm_cmn_pa2off(kd, addr)) != sizeof(pte))
                goto invalid;
        addr = pte & m->pg_frame;
        if ((pte & m->pg_v) == 0) {
                _kvm_err(kd, 0, "page not valid");
                return (0);
        }
        *pa = addr + offset;

        return (h->page_size - offset);
invalid:
        _kvm_err(kd, 0, "invalid address (%lx)", va);
        return (0);
}

static int
vatop_040(kvm_t *kd, uint32_t stpa, vaddr_t va, paddr_t *pa)
{
        cpu_kcore_hdr_t *h = kd->cpu_data;
        struct m68k_kcore_hdr *m = &h->un._m68k;
        struct vmstate *vm = kd->vmst;
        paddr_t addr;
        uint32_t stpa2;
        uint32_t ste, pte;
        u_int offset;

        offset = va & vm->pgofset;

        /*
         * We may be called before address translation is initialized.
         * This is typically used to find the dump magic number.  This
         * means we do not yet have the kernel page tables available,
         * so we must to a simple relocation.
         */
        if (va < m->relocend) {
                *pa = (va - h->kernbase) + m->reloc;
                return (h->page_size - offset);
        }

        addr = stpa + ((va >> m->sg40_shift1) * sizeof(u_int32_t));

        /*
         * Can't use KREAD to read kernel segment table entries.
         * Fortunately it is 1-to-1 mapped so we don't have to.
         */
        if (stpa == m->sysseg_pa) {
                if (_kvm_pread(kd, kd->pmfd, &ste, sizeof(ste),
                    _kvm_cmn_pa2off(kd, addr)) != sizeof(ste))
                        goto invalid;
        } else if (KREAD(kd, addr, &ste))
                goto invalid;
        if ((ste & m->sg_v) == 0) {
                _kvm_err(kd, 0, "invalid level 1 descriptor (%x)",
                                 ste);
                return((off_t)0);
        }
        stpa2 = (ste & m->sg40_addr1);
        addr = stpa2 + (((va & m->sg40_mask2) >> m->sg40_shift2) *
            sizeof(u_int32_t));

        /*
         * Address from level 1 STE is a physical address,
         * so don't use kvm_read.
         */
        if (_kvm_pread(kd, kd->pmfd, &ste, sizeof(ste),
            _kvm_cmn_pa2off(kd, addr)) != sizeof(ste))
                goto invalid;
        if ((ste & m->sg_v) == 0) {
                _kvm_err(kd, 0, "invalid level 2 descriptor (%x)",
                                 ste);
                return((off_t)0);
        }
        stpa2 = (ste & m->sg40_addr2);
        addr = stpa2 + (((va & m->sg40_mask3) >> m->sg40_shift3) *
            sizeof(u_int32_t));

        /*
         * Address from STE is a physical address so don't use kvm_read.
         */
        if (_kvm_pread(kd, kd->pmfd, &pte, sizeof(pte),
            _kvm_cmn_pa2off(kd, addr)) != sizeof(pte))
                goto invalid;
        addr = pte & m->pg_frame;
        if ((pte & m->pg_v) == 0) {
                _kvm_err(kd, 0, "page not valid");
                return (0);
        }
        *pa = addr + offset;

        return (h->page_size - offset);

invalid:
        _kvm_err(kd, 0, "invalid address (%lx)", va);
        return (0);
}