Supply _kvm_kvatop() and _kvm_pa2off() for OEA-type CPUs. This does
not yet support other PPC CPU types. Contributed by Wasabi Systems Inc.
This commit is contained in:
briggs
parent
0a15d30196
commit
a6246199bb
@ -1,5 +1,39 @@
|
||||
/* $NetBSD: kvm_powerpc.c,v 1.6 2001/08/05 03:33:15 matt Exp $ */
|
||||
/* $NetBSD: kvm_powerpc.c,v 1.7 2005/02/17 02:31:27 briggs Exp $ */
|
||||
|
||||
/*
|
||||
* Copyright (c) 2005 Wasabi Systems, Inc.
|
||||
* All rights reserved.
|
||||
*
|
||||
* Written by Allen Briggs for Wasabi Systems, Inc.
|
||||
*
|
||||
* 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 for the NetBSD Project by
|
||||
* Wasabi Systems, Inc.
|
||||
* 4. The name of Wasabi Systems, Inc. may not be used to endorse
|
||||
* or promote products derived from this software without specific prior
|
||||
* written permission.
|
||||
*
|
||||
* THIS SOFTWARE IS PROVIDED BY WASABI SYSTEMS, INC. ``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 WASABI SYSTEMS, INC
|
||||
* 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) 1996 Wolfgang Solfrank.
|
||||
* Copyright (C) 1996 TooLs GmbH.
|
||||
@ -44,9 +78,23 @@
|
||||
#include <limits.h>
|
||||
#include <kvm.h>
|
||||
#include <stdlib.h>
|
||||
#include <unistd.h>
|
||||
|
||||
#include "kvm_private.h"
|
||||
|
||||
#include <sys/kcore.h>
|
||||
#include <machine/kcore.h>
|
||||
|
||||
#include <powerpc/spr.h>
|
||||
#include <powerpc/oea/bat.h>
|
||||
#include <powerpc/oea/pte.h>
|
||||
|
||||
static int _kvm_match_601bat(kvm_t *kd, u_long va, u_long *pa, int *off);
|
||||
static int _kvm_match_bat(kvm_t *kd, u_long va, u_long *pa, int *off);
|
||||
static int _kvm_match_sr(kvm_t *kd, u_long va, u_long *pa, int *off);
|
||||
static struct pte *_kvm_scan_pteg(struct pteg *pteg, uint32_t vsid,
|
||||
uint32_t api, int secondary);
|
||||
|
||||
void
|
||||
_kvm_freevtop(kd)
|
||||
kvm_t *kd;
|
||||
@ -55,20 +103,249 @@ _kvm_freevtop(kd)
|
||||
free(kd->vmst);
|
||||
}
|
||||
|
||||
/*ARGSUSED*/
|
||||
int
|
||||
_kvm_initvtop(kd)
|
||||
kvm_t *kd;
|
||||
{
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
#define BAT601_SIZE(b) ((((b) << 17) | ~BAT601_BLPI) + 1)
|
||||
|
||||
static int
|
||||
_kvm_match_601bat(kd, va, pa, off)
|
||||
kvm_t *kd;
|
||||
u_long va;
|
||||
u_long *pa;
|
||||
int *off;
|
||||
{
|
||||
cpu_kcore_hdr_t *cpu_kh;
|
||||
u_long pgoff;
|
||||
size_t size;
|
||||
int i, nbat;
|
||||
|
||||
cpu_kh = kd->cpu_data;
|
||||
nbat = 4;
|
||||
for (i=0 ; i<nbat ; i++) {
|
||||
if (!BAT601_VALID_P(cpu_kh->dbatu[i]))
|
||||
continue;
|
||||
if (BAT601_VA_MATCH_P(cpu_kh->dbatu[i], cpu_kh->dbatl[i], va)) {
|
||||
size = BAT601_SIZE(cpu_kh->dbatu[i] & BAT601_BSM);
|
||||
pgoff = va & (size-1);
|
||||
*pa = (cpu_kh->dbatl[i] & BAT601_PBN) + pgoff;
|
||||
*off = size - pgoff;
|
||||
return 1;
|
||||
}
|
||||
}
|
||||
return 0;
|
||||
}
|
||||
|
||||
#undef BAT601_SIZE
|
||||
|
||||
#define BAT_SIZE(b) ((((b) << 15) | ~BAT_EPI) + 1)
|
||||
|
||||
static int
|
||||
_kvm_match_bat(kd, va, pa, off)
|
||||
kvm_t *kd;
|
||||
u_long va;
|
||||
u_long *pa;
|
||||
int *off;
|
||||
{
|
||||
cpu_kcore_hdr_t *cpu_kh;
|
||||
u_long pgoff;
|
||||
size_t size;
|
||||
int i, nbat;
|
||||
|
||||
cpu_kh = kd->cpu_data;
|
||||
/*
|
||||
* Assume that we're looking for data and check only the dbats.
|
||||
*/
|
||||
nbat = 8;
|
||||
for (i=0 ; i<nbat ; i++) {
|
||||
if ( ((cpu_kh->dbatu[i] & BAT_Vs) != 0)
|
||||
&& (BAT_VA_MATCH_P(cpu_kh->dbatu[i], va))) {
|
||||
size = BAT_SIZE(cpu_kh->dbatu[i] & BAT_BL);
|
||||
pgoff = va & (size-1);
|
||||
*pa = (cpu_kh->dbatl[i] & BAT_RPN) + pgoff;
|
||||
*off = size - pgoff;
|
||||
return 1;
|
||||
}
|
||||
}
|
||||
return 0;
|
||||
}
|
||||
|
||||
#undef BAT_SIZE
|
||||
|
||||
#define SR_VSID_HASH_MASK 0x0007ffff
|
||||
|
||||
static struct pte *
|
||||
_kvm_scan_pteg(pteg, vsid, api, secondary)
|
||||
struct pteg *pteg;
|
||||
uint32_t vsid;
|
||||
uint32_t api;
|
||||
int secondary;
|
||||
{
|
||||
struct pte *pte;
|
||||
u_long ptehi;
|
||||
int i;
|
||||
|
||||
for (i=0 ; i<8 ; i++) {
|
||||
pte = &pteg->pt[i];
|
||||
ptehi = (u_long) pte->pte_hi;
|
||||
if ((ptehi & PTE_VALID) == 0)
|
||||
continue;
|
||||
if ((ptehi & PTE_HID) != secondary)
|
||||
continue;
|
||||
if (((ptehi & PTE_VSID) >> PTE_VSID_SHFT) != vsid)
|
||||
continue;
|
||||
if (((ptehi & PTE_API) >> PTE_API_SHFT) != api)
|
||||
continue;
|
||||
return pte;
|
||||
}
|
||||
return NULL;
|
||||
}
|
||||
|
||||
#define HASH_MASK 0x0007ffff
|
||||
|
||||
static int
|
||||
_kvm_match_sr(kd, va, pa, off)
|
||||
kvm_t *kd;
|
||||
u_long va;
|
||||
u_long *pa;
|
||||
int *off;
|
||||
{
|
||||
cpu_kcore_hdr_t *cpu_kh;
|
||||
struct pteg pteg;
|
||||
struct pte *pte;
|
||||
uint32_t sr, pgoff, vsid, pgidx, api, hash;
|
||||
uint32_t htaborg, htabmask, mhash;
|
||||
u_long pteg_vaddr;
|
||||
|
||||
cpu_kh = kd->cpu_data;
|
||||
|
||||
sr = cpu_kh->sr[(va >> 28) & 0xf];
|
||||
if ((sr & SR_TYPE) != 0) {
|
||||
/* Direct-store segment (shouldn't be) */
|
||||
return 0;
|
||||
}
|
||||
|
||||
pgoff = va & ADDR_POFF;
|
||||
vsid = sr & SR_VSID;
|
||||
pgidx = (va & ADDR_PIDX) >> ADDR_PIDX_SHFT;
|
||||
api = pgidx >> 10;
|
||||
hash = (vsid & HASH_MASK) ^ pgidx;
|
||||
|
||||
htaborg = cpu_kh->sdr1 & 0xffff0000;
|
||||
htabmask = cpu_kh->sdr1 & 0x1ff;
|
||||
|
||||
mhash = (hash >> 10) & htabmask;
|
||||
|
||||
pteg_vaddr = ( htaborg & 0xfe000000) | ((hash & 0x3ff) << 6)
|
||||
| ((htaborg & 0x01ff0000) | (mhash << 16));
|
||||
|
||||
if (pread(kd->pmfd, (void *) &pteg, sizeof(pteg),
|
||||
_kvm_pa2off(kd, pteg_vaddr)) != sizeof(pteg)) {
|
||||
_kvm_syserr(kd, 0, "could not read primary PTEG");
|
||||
return 0;
|
||||
}
|
||||
|
||||
if ((pte = _kvm_scan_pteg(&pteg, vsid, api, 0)) != NULL) {
|
||||
*pa = (pte->pte_lo & PTE_RPGN) | pgoff;
|
||||
*off = NBPG - pgoff;
|
||||
return 1;
|
||||
}
|
||||
|
||||
hash = (~hash) & HASH_MASK;
|
||||
mhash = (hash >> 10) & htabmask;
|
||||
|
||||
pteg_vaddr = ( htaborg & 0xfe000000) | ((hash & 0x3ff) << 6)
|
||||
| ((htaborg & 0x01ff0000) | (mhash << 16));
|
||||
|
||||
if (pread(kd->pmfd, (void *) &pteg, sizeof(pteg),
|
||||
_kvm_pa2off(kd, pteg_vaddr)) != sizeof(pteg)) {
|
||||
_kvm_syserr(kd, 0, "could not read secondary PTEG");
|
||||
return 0;
|
||||
}
|
||||
|
||||
if ((pte = _kvm_scan_pteg(&pteg, vsid, api, 0)) != NULL) {
|
||||
*pa = (pte->pte_lo & PTE_RPGN) | pgoff;
|
||||
*off = NBPG - pgoff;
|
||||
return 1;
|
||||
}
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
/*
|
||||
* Translate a KVA to a PA
|
||||
*/
|
||||
int
|
||||
_kvm_kvatop(kd, va, pa)
|
||||
kvm_t *kd;
|
||||
u_long va;
|
||||
u_long *pa;
|
||||
{
|
||||
_kvm_err(kd, 0, "vatop not yet implemented!");
|
||||
cpu_kcore_hdr_t *cpu_kh;
|
||||
int offs;
|
||||
uint32_t pvr;
|
||||
|
||||
if (ISALIVE(kd)) {
|
||||
_kvm_err(kd, 0, "vatop called in live kernel!");
|
||||
return 0;
|
||||
}
|
||||
|
||||
cpu_kh = kd->cpu_data;
|
||||
|
||||
pvr = (cpu_kh->pvr >> 16);
|
||||
if (MPC745X_P(pvr))
|
||||
pvr = MPC7450;
|
||||
|
||||
switch (pvr) {
|
||||
case MPC601:
|
||||
/* Check for a BAT hit first */
|
||||
if (_kvm_match_601bat(kd, va, pa, &offs)) {
|
||||
return offs;
|
||||
}
|
||||
|
||||
/* No BAT hit; check page tables */
|
||||
if (_kvm_match_sr(kd, va, pa, &offs)) {
|
||||
return offs;
|
||||
}
|
||||
break;
|
||||
|
||||
case MPC603:
|
||||
case MPC603e:
|
||||
case MPC603ev:
|
||||
case MPC604:
|
||||
case MPC604ev:
|
||||
case MPC750:
|
||||
case IBM750FX:
|
||||
case MPC7400:
|
||||
case MPC7450:
|
||||
case MPC7410:
|
||||
case MPC8240:
|
||||
case MPC8245:
|
||||
/* Check for a BAT hit first */
|
||||
if (_kvm_match_bat(kd, va, pa, &offs)) {
|
||||
return offs;
|
||||
}
|
||||
|
||||
/* No BAT hit; check page tables */
|
||||
if (_kvm_match_sr(kd, va, pa, &offs)) {
|
||||
return offs;
|
||||
}
|
||||
break;
|
||||
|
||||
default:
|
||||
_kvm_err(kd, 0, "Unsupported CPU type (pvr 0x%08lx)!",
|
||||
(unsigned long) cpu_kh->pvr);
|
||||
break;
|
||||
}
|
||||
|
||||
/* No hit -- no translation */
|
||||
*pa = (u_long)~0UL;
|
||||
return 0;
|
||||
}
|
||||
|
||||
@ -77,8 +354,25 @@ _kvm_pa2off(kd, pa)
|
||||
kvm_t *kd;
|
||||
u_long pa;
|
||||
{
|
||||
_kvm_err(kd, 0, "pa2off not yet implemented!");
|
||||
return 0;
|
||||
cpu_kcore_hdr_t *cpu_kh;
|
||||
phys_ram_seg_t *ram;
|
||||
off_t off;
|
||||
void *e;
|
||||
|
||||
cpu_kh = kd->cpu_data;
|
||||
e = (char *) kd->cpu_data + kd->cpu_dsize;
|
||||
ram = (void *)((char *)(void *)cpu_kh + ALIGN(sizeof *cpu_kh));
|
||||
off = kd->dump_off;
|
||||
do {
|
||||
if (pa >= ram->start && (pa - ram->start) < ram->size) {
|
||||
return off + (pa - ram->start);
|
||||
}
|
||||
ram++;
|
||||
off += ram->size;
|
||||
} while ((void *) ram < e && ram->size);
|
||||
|
||||
_kvm_err(kd, 0, "pa2off failed for pa 0x%08lx\n", pa);
|
||||
return (off_t) -1;
|
||||
}
|
||||
|
||||
/*
|
||||
|
||||
Loading…
Reference in New Issue
Block a user