Using typedefs to rename structure types if frowned on by CodingStyle. However, we do so for the hash PTE structure on both ppc32 (where it's called "PTE") and ppc64 (where it's called "hpte_t"). On ppc32 we also have such a typedef for the BATs ("BAT"). This removes this unhelpful use of typedefs, in the process bringing ppc32 and ppc64 closer together, by using the name "struct hash_pte" in both cases. Signed-off-by: David Gibson <david@gibson.dropbear.id.au> Signed-off-by: Paul Mackerras <paulus@samba.org>
282 lines
7.3 KiB
C
282 lines
7.3 KiB
C
/*
|
|
* PS3 pagetable management routines.
|
|
*
|
|
* Copyright (C) 2006 Sony Computer Entertainment Inc.
|
|
* Copyright 2006, 2007 Sony Corporation
|
|
*
|
|
* This program is free software; you can redistribute it and/or modify
|
|
* it under the terms of the GNU General Public License as published by
|
|
* the Free Software Foundation; version 2 of the License.
|
|
*
|
|
* This program is distributed in the hope that it will be useful,
|
|
* but WITHOUT ANY WARRANTY; without even the implied warranty of
|
|
* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
|
|
* GNU General Public License for more details.
|
|
*
|
|
* You should have received a copy of the GNU General Public License
|
|
* along with this program; if not, write to the Free Software
|
|
* Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA
|
|
*/
|
|
|
|
#include <linux/kernel.h>
|
|
|
|
#include <asm/machdep.h>
|
|
#include <asm/lmb.h>
|
|
#include <asm/udbg.h>
|
|
#include <asm/lv1call.h>
|
|
#include <asm/ps3fb.h>
|
|
|
|
#include "platform.h"
|
|
|
|
#if defined(DEBUG)
|
|
#define DBG(fmt...) udbg_printf(fmt)
|
|
#else
|
|
#define DBG(fmt...) do{if(0)printk(fmt);}while(0)
|
|
#endif
|
|
|
|
static struct hash_pte *htab;
|
|
static unsigned long htab_addr;
|
|
static unsigned char *bolttab;
|
|
static unsigned char *inusetab;
|
|
|
|
static DEFINE_SPINLOCK(ps3_bolttab_lock);
|
|
|
|
#define debug_dump_hpte(_a, _b, _c, _d, _e, _f, _g) \
|
|
_debug_dump_hpte(_a, _b, _c, _d, _e, _f, _g, __func__, __LINE__)
|
|
static void _debug_dump_hpte(unsigned long pa, unsigned long va,
|
|
unsigned long group, unsigned long bitmap, struct hash_pte lhpte,
|
|
int psize, unsigned long slot, const char* func, int line)
|
|
{
|
|
DBG("%s:%d: pa = %lxh\n", func, line, pa);
|
|
DBG("%s:%d: lpar = %lxh\n", func, line,
|
|
ps3_mm_phys_to_lpar(pa));
|
|
DBG("%s:%d: va = %lxh\n", func, line, va);
|
|
DBG("%s:%d: group = %lxh\n", func, line, group);
|
|
DBG("%s:%d: bitmap = %lxh\n", func, line, bitmap);
|
|
DBG("%s:%d: hpte.v = %lxh\n", func, line, lhpte.v);
|
|
DBG("%s:%d: hpte.r = %lxh\n", func, line, lhpte.r);
|
|
DBG("%s:%d: psize = %xh\n", func, line, psize);
|
|
DBG("%s:%d: slot = %lxh\n", func, line, slot);
|
|
}
|
|
|
|
static long ps3_hpte_insert(unsigned long hpte_group, unsigned long va,
|
|
unsigned long pa, unsigned long rflags, unsigned long vflags, int psize)
|
|
{
|
|
unsigned long slot;
|
|
struct hash_pte lhpte;
|
|
int secondary = 0;
|
|
unsigned long result;
|
|
unsigned long bitmap;
|
|
unsigned long flags;
|
|
unsigned long p_pteg, s_pteg, b_index, b_mask, cb, ci;
|
|
|
|
vflags &= ~HPTE_V_SECONDARY; /* this bit is ignored */
|
|
|
|
lhpte.v = hpte_encode_v(va, psize) | vflags | HPTE_V_VALID;
|
|
lhpte.r = hpte_encode_r(ps3_mm_phys_to_lpar(pa), psize) | rflags;
|
|
|
|
p_pteg = hpte_group / HPTES_PER_GROUP;
|
|
s_pteg = ~p_pteg & htab_hash_mask;
|
|
|
|
spin_lock_irqsave(&ps3_bolttab_lock, flags);
|
|
|
|
BUG_ON(bolttab[p_pteg] == 0xff && bolttab[s_pteg] == 0xff);
|
|
|
|
bitmap = (inusetab[p_pteg] << 8) | inusetab[s_pteg];
|
|
|
|
if (bitmap == 0xffff) {
|
|
/*
|
|
* PTEG is full. Search for victim.
|
|
*/
|
|
bitmap &= ~((bolttab[p_pteg] << 8) | bolttab[s_pteg]);
|
|
do {
|
|
ci = mftb() & 15;
|
|
cb = 0x8000UL >> ci;
|
|
} while ((cb & bitmap) == 0);
|
|
} else {
|
|
/*
|
|
* search free slot in hardware order
|
|
* [primary] 0, 2, 4, 6, 1, 3, 5, 7
|
|
* [secondary] 0, 2, 4, 6, 1, 3, 5, 7
|
|
*/
|
|
for (ci = 0; ci < HPTES_PER_GROUP; ci += 2) {
|
|
cb = 0x8000UL >> ci;
|
|
if ((cb & bitmap) == 0)
|
|
goto found;
|
|
}
|
|
for (ci = 1; ci < HPTES_PER_GROUP; ci += 2) {
|
|
cb = 0x8000UL >> ci;
|
|
if ((cb & bitmap) == 0)
|
|
goto found;
|
|
}
|
|
for (ci = HPTES_PER_GROUP; ci < HPTES_PER_GROUP*2; ci += 2) {
|
|
cb = 0x8000UL >> ci;
|
|
if ((cb & bitmap) == 0)
|
|
goto found;
|
|
}
|
|
for (ci = HPTES_PER_GROUP+1; ci < HPTES_PER_GROUP*2; ci += 2) {
|
|
cb = 0x8000UL >> ci;
|
|
if ((cb & bitmap) == 0)
|
|
goto found;
|
|
}
|
|
}
|
|
|
|
found:
|
|
if (ci < HPTES_PER_GROUP) {
|
|
slot = p_pteg * HPTES_PER_GROUP + ci;
|
|
} else {
|
|
slot = s_pteg * HPTES_PER_GROUP + (ci & 7);
|
|
/* lhpte.dw0.dw0.h = 1; */
|
|
vflags |= HPTE_V_SECONDARY;
|
|
lhpte.v |= HPTE_V_SECONDARY;
|
|
}
|
|
|
|
result = lv1_write_htab_entry(0, slot, lhpte.v, lhpte.r);
|
|
|
|
if (result) {
|
|
debug_dump_hpte(pa, va, hpte_group, bitmap, lhpte, psize, slot);
|
|
BUG();
|
|
}
|
|
|
|
/*
|
|
* If used slot is not in primary HPTE group,
|
|
* the slot should be in secondary HPTE group.
|
|
*/
|
|
|
|
if ((hpte_group ^ slot) & ~(HPTES_PER_GROUP - 1)) {
|
|
secondary = 1;
|
|
b_index = s_pteg;
|
|
} else {
|
|
secondary = 0;
|
|
b_index = p_pteg;
|
|
}
|
|
|
|
b_mask = (lhpte.v & HPTE_V_BOLTED) ? 1 << 7 : 0 << 7;
|
|
bolttab[b_index] |= b_mask >> (slot & 7);
|
|
b_mask = 1 << 7;
|
|
inusetab[b_index] |= b_mask >> (slot & 7);
|
|
spin_unlock_irqrestore(&ps3_bolttab_lock, flags);
|
|
|
|
return (slot & 7) | (secondary << 3);
|
|
}
|
|
|
|
static long ps3_hpte_remove(unsigned long hpte_group)
|
|
{
|
|
panic("ps3_hpte_remove() not implemented");
|
|
return 0;
|
|
}
|
|
|
|
static long ps3_hpte_updatepp(unsigned long slot, unsigned long newpp,
|
|
unsigned long va, int psize, int local)
|
|
{
|
|
unsigned long flags;
|
|
unsigned long result;
|
|
unsigned long pteg, bit;
|
|
unsigned long hpte_v, want_v;
|
|
|
|
want_v = hpte_encode_v(va, psize);
|
|
|
|
spin_lock_irqsave(&ps3_bolttab_lock, flags);
|
|
|
|
hpte_v = htab[slot].v;
|
|
if (!HPTE_V_COMPARE(hpte_v, want_v) || !(hpte_v & HPTE_V_VALID)) {
|
|
spin_unlock_irqrestore(&ps3_bolttab_lock, flags);
|
|
|
|
/* ps3_hpte_insert() will be used to update PTE */
|
|
return -1;
|
|
}
|
|
|
|
result = lv1_write_htab_entry(0, slot, 0, 0);
|
|
|
|
if (result) {
|
|
DBG("%s: va=%lx slot=%lx psize=%d result = %ld (0x%lx)\n",
|
|
__func__, va, slot, psize, result, result);
|
|
BUG();
|
|
}
|
|
|
|
pteg = slot / HPTES_PER_GROUP;
|
|
bit = slot % HPTES_PER_GROUP;
|
|
inusetab[pteg] &= ~(0x80 >> bit);
|
|
|
|
spin_unlock_irqrestore(&ps3_bolttab_lock, flags);
|
|
|
|
/* ps3_hpte_insert() will be used to update PTE */
|
|
return -1;
|
|
}
|
|
|
|
static void ps3_hpte_updateboltedpp(unsigned long newpp, unsigned long ea,
|
|
int psize)
|
|
{
|
|
panic("ps3_hpte_updateboltedpp() not implemented");
|
|
}
|
|
|
|
static void ps3_hpte_invalidate(unsigned long slot, unsigned long va,
|
|
int psize, int local)
|
|
{
|
|
unsigned long flags;
|
|
unsigned long result;
|
|
unsigned long pteg, bit;
|
|
|
|
spin_lock_irqsave(&ps3_bolttab_lock, flags);
|
|
result = lv1_write_htab_entry(0, slot, 0, 0);
|
|
|
|
if (result) {
|
|
DBG("%s: va=%lx slot=%lx psize=%d result = %ld (0x%lx)\n",
|
|
__func__, va, slot, psize, result, result);
|
|
BUG();
|
|
}
|
|
|
|
pteg = slot / HPTES_PER_GROUP;
|
|
bit = slot % HPTES_PER_GROUP;
|
|
inusetab[pteg] &= ~(0x80 >> bit);
|
|
spin_unlock_irqrestore(&ps3_bolttab_lock, flags);
|
|
}
|
|
|
|
static void ps3_hpte_clear(void)
|
|
{
|
|
/* Make sure to clean up the frame buffer device first */
|
|
ps3fb_cleanup();
|
|
|
|
lv1_unmap_htab(htab_addr);
|
|
}
|
|
|
|
void __init ps3_hpte_init(unsigned long htab_size)
|
|
{
|
|
long bitmap_size;
|
|
|
|
DBG(" -> %s:%d\n", __func__, __LINE__);
|
|
|
|
ppc_md.hpte_invalidate = ps3_hpte_invalidate;
|
|
ppc_md.hpte_updatepp = ps3_hpte_updatepp;
|
|
ppc_md.hpte_updateboltedpp = ps3_hpte_updateboltedpp;
|
|
ppc_md.hpte_insert = ps3_hpte_insert;
|
|
ppc_md.hpte_remove = ps3_hpte_remove;
|
|
ppc_md.hpte_clear_all = ps3_hpte_clear;
|
|
|
|
ppc64_pft_size = __ilog2(htab_size);
|
|
|
|
bitmap_size = htab_size / sizeof(struct hash_pte) / 8;
|
|
|
|
bolttab = __va(lmb_alloc(bitmap_size, 1));
|
|
inusetab = __va(lmb_alloc(bitmap_size, 1));
|
|
|
|
memset(bolttab, 0, bitmap_size);
|
|
memset(inusetab, 0, bitmap_size);
|
|
|
|
DBG(" <- %s:%d\n", __func__, __LINE__);
|
|
}
|
|
|
|
void __init ps3_map_htab(void)
|
|
{
|
|
long result;
|
|
unsigned long htab_size = (1UL << ppc64_pft_size);
|
|
|
|
result = lv1_map_htab(0, &htab_addr);
|
|
|
|
htab = (struct hash_pte *)__ioremap(htab_addr, htab_size,
|
|
pgprot_val(PAGE_READONLY_X));
|
|
|
|
DBG("%s:%d: lpar %016lxh, virt %016lxh\n", __func__, __LINE__,
|
|
htab_addr, (unsigned long)htab);
|
|
}
|