mirror of
https://github.com/AetherDroid/android_kernel_samsung_on5xelte.git
synced 2025-10-31 08:08:51 +01:00
Fixed MTP to work with TWRP
This commit is contained in:
awab228
commit
f6dfaef42e
50820 changed files with 20846062 additions and 0 deletions
582
arch/mips/mm/cerr-sb1.c
Normal file
582
arch/mips/mm/cerr-sb1.c
Normal file
|
|
@ -0,0 +1,582 @@
|
|||
/*
|
||||
* Copyright (C) 2001,2002,2003 Broadcom 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; either version 2
|
||||
* of the License, or (at your option) any later version.
|
||||
*
|
||||
* 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/sched.h>
|
||||
#include <asm/mipsregs.h>
|
||||
#include <asm/sibyte/sb1250.h>
|
||||
#include <asm/sibyte/sb1250_regs.h>
|
||||
|
||||
#if !defined(CONFIG_SIBYTE_BUS_WATCHER) || defined(CONFIG_SIBYTE_BW_TRACE)
|
||||
#include <asm/io.h>
|
||||
#include <asm/sibyte/sb1250_scd.h>
|
||||
#endif
|
||||
|
||||
/*
|
||||
* We'd like to dump the L2_ECC_TAG register on errors, but errata make
|
||||
* that unsafe... So for now we don't. (BCM1250/BCM112x erratum SOC-48.)
|
||||
*/
|
||||
#undef DUMP_L2_ECC_TAG_ON_ERROR
|
||||
|
||||
/* SB1 definitions */
|
||||
|
||||
/* XXX should come from config1 XXX */
|
||||
#define SB1_CACHE_INDEX_MASK 0x1fe0
|
||||
|
||||
#define CP0_ERRCTL_RECOVERABLE (1 << 31)
|
||||
#define CP0_ERRCTL_DCACHE (1 << 30)
|
||||
#define CP0_ERRCTL_ICACHE (1 << 29)
|
||||
#define CP0_ERRCTL_MULTIBUS (1 << 23)
|
||||
#define CP0_ERRCTL_MC_TLB (1 << 15)
|
||||
#define CP0_ERRCTL_MC_TIMEOUT (1 << 14)
|
||||
|
||||
#define CP0_CERRI_TAG_PARITY (1 << 29)
|
||||
#define CP0_CERRI_DATA_PARITY (1 << 28)
|
||||
#define CP0_CERRI_EXTERNAL (1 << 26)
|
||||
|
||||
#define CP0_CERRI_IDX_VALID(c) (!((c) & CP0_CERRI_EXTERNAL))
|
||||
#define CP0_CERRI_DATA (CP0_CERRI_DATA_PARITY)
|
||||
|
||||
#define CP0_CERRD_MULTIPLE (1 << 31)
|
||||
#define CP0_CERRD_TAG_STATE (1 << 30)
|
||||
#define CP0_CERRD_TAG_ADDRESS (1 << 29)
|
||||
#define CP0_CERRD_DATA_SBE (1 << 28)
|
||||
#define CP0_CERRD_DATA_DBE (1 << 27)
|
||||
#define CP0_CERRD_EXTERNAL (1 << 26)
|
||||
#define CP0_CERRD_LOAD (1 << 25)
|
||||
#define CP0_CERRD_STORE (1 << 24)
|
||||
#define CP0_CERRD_FILLWB (1 << 23)
|
||||
#define CP0_CERRD_COHERENCY (1 << 22)
|
||||
#define CP0_CERRD_DUPTAG (1 << 21)
|
||||
|
||||
#define CP0_CERRD_DPA_VALID(c) (!((c) & CP0_CERRD_EXTERNAL))
|
||||
#define CP0_CERRD_IDX_VALID(c) \
|
||||
(((c) & (CP0_CERRD_LOAD | CP0_CERRD_STORE)) ? (!((c) & CP0_CERRD_EXTERNAL)) : 0)
|
||||
#define CP0_CERRD_CAUSES \
|
||||
(CP0_CERRD_LOAD | CP0_CERRD_STORE | CP0_CERRD_FILLWB | CP0_CERRD_COHERENCY | CP0_CERRD_DUPTAG)
|
||||
#define CP0_CERRD_TYPES \
|
||||
(CP0_CERRD_TAG_STATE | CP0_CERRD_TAG_ADDRESS | CP0_CERRD_DATA_SBE | CP0_CERRD_DATA_DBE | CP0_CERRD_EXTERNAL)
|
||||
#define CP0_CERRD_DATA (CP0_CERRD_DATA_SBE | CP0_CERRD_DATA_DBE)
|
||||
|
||||
static uint32_t extract_ic(unsigned short addr, int data);
|
||||
static uint32_t extract_dc(unsigned short addr, int data);
|
||||
|
||||
static inline void breakout_errctl(unsigned int val)
|
||||
{
|
||||
if (val & CP0_ERRCTL_RECOVERABLE)
|
||||
printk(" recoverable");
|
||||
if (val & CP0_ERRCTL_DCACHE)
|
||||
printk(" dcache");
|
||||
if (val & CP0_ERRCTL_ICACHE)
|
||||
printk(" icache");
|
||||
if (val & CP0_ERRCTL_MULTIBUS)
|
||||
printk(" multiple-buserr");
|
||||
printk("\n");
|
||||
}
|
||||
|
||||
static inline void breakout_cerri(unsigned int val)
|
||||
{
|
||||
if (val & CP0_CERRI_TAG_PARITY)
|
||||
printk(" tag-parity");
|
||||
if (val & CP0_CERRI_DATA_PARITY)
|
||||
printk(" data-parity");
|
||||
if (val & CP0_CERRI_EXTERNAL)
|
||||
printk(" external");
|
||||
printk("\n");
|
||||
}
|
||||
|
||||
static inline void breakout_cerrd(unsigned int val)
|
||||
{
|
||||
switch (val & CP0_CERRD_CAUSES) {
|
||||
case CP0_CERRD_LOAD:
|
||||
printk(" load,");
|
||||
break;
|
||||
case CP0_CERRD_STORE:
|
||||
printk(" store,");
|
||||
break;
|
||||
case CP0_CERRD_FILLWB:
|
||||
printk(" fill/wb,");
|
||||
break;
|
||||
case CP0_CERRD_COHERENCY:
|
||||
printk(" coherency,");
|
||||
break;
|
||||
case CP0_CERRD_DUPTAG:
|
||||
printk(" duptags,");
|
||||
break;
|
||||
default:
|
||||
printk(" NO CAUSE,");
|
||||
break;
|
||||
}
|
||||
if (!(val & CP0_CERRD_TYPES))
|
||||
printk(" NO TYPE");
|
||||
else {
|
||||
if (val & CP0_CERRD_MULTIPLE)
|
||||
printk(" multi-err");
|
||||
if (val & CP0_CERRD_TAG_STATE)
|
||||
printk(" tag-state");
|
||||
if (val & CP0_CERRD_TAG_ADDRESS)
|
||||
printk(" tag-address");
|
||||
if (val & CP0_CERRD_DATA_SBE)
|
||||
printk(" data-SBE");
|
||||
if (val & CP0_CERRD_DATA_DBE)
|
||||
printk(" data-DBE");
|
||||
if (val & CP0_CERRD_EXTERNAL)
|
||||
printk(" external");
|
||||
}
|
||||
printk("\n");
|
||||
}
|
||||
|
||||
#ifndef CONFIG_SIBYTE_BUS_WATCHER
|
||||
|
||||
static void check_bus_watcher(void)
|
||||
{
|
||||
uint32_t status, l2_err, memio_err;
|
||||
#ifdef DUMP_L2_ECC_TAG_ON_ERROR
|
||||
uint64_t l2_tag;
|
||||
#endif
|
||||
|
||||
/* Destructive read, clears register and interrupt */
|
||||
status = csr_in32(IOADDR(A_SCD_BUS_ERR_STATUS));
|
||||
/* Bit 31 is always on, but there's no #define for that */
|
||||
if (status & ~(1UL << 31)) {
|
||||
l2_err = csr_in32(IOADDR(A_BUS_L2_ERRORS));
|
||||
#ifdef DUMP_L2_ECC_TAG_ON_ERROR
|
||||
l2_tag = in64(IOADDR(A_L2_ECC_TAG));
|
||||
#endif
|
||||
memio_err = csr_in32(IOADDR(A_BUS_MEM_IO_ERRORS));
|
||||
printk("Bus watcher error counters: %08x %08x\n", l2_err, memio_err);
|
||||
printk("\nLast recorded signature:\n");
|
||||
printk("Request %02x from %d, answered by %d with Dcode %d\n",
|
||||
(unsigned int)(G_SCD_BERR_TID(status) & 0x3f),
|
||||
(int)(G_SCD_BERR_TID(status) >> 6),
|
||||
(int)G_SCD_BERR_RID(status),
|
||||
(int)G_SCD_BERR_DCODE(status));
|
||||
#ifdef DUMP_L2_ECC_TAG_ON_ERROR
|
||||
printk("Last L2 tag w/ bad ECC: %016llx\n", l2_tag);
|
||||
#endif
|
||||
} else {
|
||||
printk("Bus watcher indicates no error\n");
|
||||
}
|
||||
}
|
||||
#else
|
||||
extern void check_bus_watcher(void);
|
||||
#endif
|
||||
|
||||
asmlinkage void sb1_cache_error(void)
|
||||
{
|
||||
uint32_t errctl, cerr_i, cerr_d, dpalo, dpahi, eepc, res;
|
||||
unsigned long long cerr_dpa;
|
||||
|
||||
#ifdef CONFIG_SIBYTE_BW_TRACE
|
||||
/* Freeze the trace buffer now */
|
||||
csr_out32(M_SCD_TRACE_CFG_FREEZE, IOADDR(A_SCD_TRACE_CFG));
|
||||
printk("Trace buffer frozen\n");
|
||||
#endif
|
||||
|
||||
printk("Cache error exception on CPU %x:\n",
|
||||
(read_c0_prid() >> 25) & 0x7);
|
||||
|
||||
__asm__ __volatile__ (
|
||||
" .set push\n\t"
|
||||
" .set mips64\n\t"
|
||||
" .set noat\n\t"
|
||||
" mfc0 %0, $26\n\t"
|
||||
" mfc0 %1, $27\n\t"
|
||||
" mfc0 %2, $27, 1\n\t"
|
||||
" dmfc0 $1, $27, 3\n\t"
|
||||
" dsrl32 %3, $1, 0 \n\t"
|
||||
" sll %4, $1, 0 \n\t"
|
||||
" mfc0 %5, $30\n\t"
|
||||
" .set pop"
|
||||
: "=r" (errctl), "=r" (cerr_i), "=r" (cerr_d),
|
||||
"=r" (dpahi), "=r" (dpalo), "=r" (eepc));
|
||||
|
||||
cerr_dpa = (((uint64_t)dpahi) << 32) | dpalo;
|
||||
printk(" c0_errorepc == %08x\n", eepc);
|
||||
printk(" c0_errctl == %08x", errctl);
|
||||
breakout_errctl(errctl);
|
||||
if (errctl & CP0_ERRCTL_ICACHE) {
|
||||
printk(" c0_cerr_i == %08x", cerr_i);
|
||||
breakout_cerri(cerr_i);
|
||||
if (CP0_CERRI_IDX_VALID(cerr_i)) {
|
||||
/* Check index of EPC, allowing for delay slot */
|
||||
if (((eepc & SB1_CACHE_INDEX_MASK) != (cerr_i & SB1_CACHE_INDEX_MASK)) &&
|
||||
((eepc & SB1_CACHE_INDEX_MASK) != ((cerr_i & SB1_CACHE_INDEX_MASK) - 4)))
|
||||
printk(" cerr_i idx doesn't match eepc\n");
|
||||
else {
|
||||
res = extract_ic(cerr_i & SB1_CACHE_INDEX_MASK,
|
||||
(cerr_i & CP0_CERRI_DATA) != 0);
|
||||
if (!(res & cerr_i))
|
||||
printk("...didn't see indicated icache problem\n");
|
||||
}
|
||||
}
|
||||
}
|
||||
if (errctl & CP0_ERRCTL_DCACHE) {
|
||||
printk(" c0_cerr_d == %08x", cerr_d);
|
||||
breakout_cerrd(cerr_d);
|
||||
if (CP0_CERRD_DPA_VALID(cerr_d)) {
|
||||
printk(" c0_cerr_dpa == %010llx\n", cerr_dpa);
|
||||
if (!CP0_CERRD_IDX_VALID(cerr_d)) {
|
||||
res = extract_dc(cerr_dpa & SB1_CACHE_INDEX_MASK,
|
||||
(cerr_d & CP0_CERRD_DATA) != 0);
|
||||
if (!(res & cerr_d))
|
||||
printk("...didn't see indicated dcache problem\n");
|
||||
} else {
|
||||
if ((cerr_dpa & SB1_CACHE_INDEX_MASK) != (cerr_d & SB1_CACHE_INDEX_MASK))
|
||||
printk(" cerr_d idx doesn't match cerr_dpa\n");
|
||||
else {
|
||||
res = extract_dc(cerr_d & SB1_CACHE_INDEX_MASK,
|
||||
(cerr_d & CP0_CERRD_DATA) != 0);
|
||||
if (!(res & cerr_d))
|
||||
printk("...didn't see indicated problem\n");
|
||||
}
|
||||
}
|
||||
}
|
||||
}
|
||||
|
||||
check_bus_watcher();
|
||||
|
||||
/*
|
||||
* Calling panic() when a fatal cache error occurs scrambles the
|
||||
* state of the system (and the cache), making it difficult to
|
||||
* investigate after the fact. However, if you just stall the CPU,
|
||||
* the other CPU may keep on running, which is typically very
|
||||
* undesirable.
|
||||
*/
|
||||
#ifdef CONFIG_SB1_CERR_STALL
|
||||
while (1)
|
||||
;
|
||||
#else
|
||||
panic("unhandled cache error");
|
||||
#endif
|
||||
}
|
||||
|
||||
|
||||
/* Parity lookup table. */
|
||||
static const uint8_t parity[256] = {
|
||||
0, 1, 1, 0, 1, 0, 0, 1, 1, 0, 0, 1, 0, 1, 1, 0,
|
||||
1, 0, 0, 1, 0, 1, 1, 0, 0, 1, 1, 0, 1, 0, 0, 1,
|
||||
1, 0, 0, 1, 0, 1, 1, 0, 0, 1, 1, 0, 1, 0, 0, 1,
|
||||
0, 1, 1, 0, 1, 0, 0, 1, 1, 0, 0, 1, 0, 1, 1, 0,
|
||||
1, 0, 0, 1, 0, 1, 1, 0, 0, 1, 1, 0, 1, 0, 0, 1,
|
||||
0, 1, 1, 0, 1, 0, 0, 1, 1, 0, 0, 1, 0, 1, 1, 0,
|
||||
0, 1, 1, 0, 1, 0, 0, 1, 1, 0, 0, 1, 0, 1, 1, 0,
|
||||
1, 0, 0, 1, 0, 1, 1, 0, 0, 1, 1, 0, 1, 0, 0, 1,
|
||||
1, 0, 0, 1, 0, 1, 1, 0, 0, 1, 1, 0, 1, 0, 0, 1,
|
||||
0, 1, 1, 0, 1, 0, 0, 1, 1, 0, 0, 1, 0, 1, 1, 0,
|
||||
0, 1, 1, 0, 1, 0, 0, 1, 1, 0, 0, 1, 0, 1, 1, 0,
|
||||
1, 0, 0, 1, 0, 1, 1, 0, 0, 1, 1, 0, 1, 0, 0, 1,
|
||||
0, 1, 1, 0, 1, 0, 0, 1, 1, 0, 0, 1, 0, 1, 1, 0,
|
||||
1, 0, 0, 1, 0, 1, 1, 0, 0, 1, 1, 0, 1, 0, 0, 1,
|
||||
1, 0, 0, 1, 0, 1, 1, 0, 0, 1, 1, 0, 1, 0, 0, 1,
|
||||
0, 1, 1, 0, 1, 0, 0, 1, 1, 0, 0, 1, 0, 1, 1, 0
|
||||
};
|
||||
|
||||
/* Masks to select bits for Hamming parity, mask_72_64[i] for bit[i] */
|
||||
static const uint64_t mask_72_64[8] = {
|
||||
0x0738C808099264FFULL,
|
||||
0x38C808099264FF07ULL,
|
||||
0xC808099264FF0738ULL,
|
||||
0x08099264FF0738C8ULL,
|
||||
0x099264FF0738C808ULL,
|
||||
0x9264FF0738C80809ULL,
|
||||
0x64FF0738C8080992ULL,
|
||||
0xFF0738C808099264ULL
|
||||
};
|
||||
|
||||
/* Calculate the parity on a range of bits */
|
||||
static char range_parity(uint64_t dword, int max, int min)
|
||||
{
|
||||
char parity = 0;
|
||||
int i;
|
||||
dword >>= min;
|
||||
for (i=max-min; i>=0; i--) {
|
||||
if (dword & 0x1)
|
||||
parity = !parity;
|
||||
dword >>= 1;
|
||||
}
|
||||
return parity;
|
||||
}
|
||||
|
||||
/* Calculate the 4-bit even byte-parity for an instruction */
|
||||
static unsigned char inst_parity(uint32_t word)
|
||||
{
|
||||
int i, j;
|
||||
char parity = 0;
|
||||
for (j=0; j<4; j++) {
|
||||
char byte_parity = 0;
|
||||
for (i=0; i<8; i++) {
|
||||
if (word & 0x80000000)
|
||||
byte_parity = !byte_parity;
|
||||
word <<= 1;
|
||||
}
|
||||
parity <<= 1;
|
||||
parity |= byte_parity;
|
||||
}
|
||||
return parity;
|
||||
}
|
||||
|
||||
static uint32_t extract_ic(unsigned short addr, int data)
|
||||
{
|
||||
unsigned short way;
|
||||
int valid;
|
||||
uint32_t taghi, taglolo, taglohi;
|
||||
unsigned long long taglo, va;
|
||||
uint64_t tlo_tmp;
|
||||
uint8_t lru;
|
||||
int res = 0;
|
||||
|
||||
printk("Icache index 0x%04x ", addr);
|
||||
for (way = 0; way < 4; way++) {
|
||||
/* Index-load-tag-I */
|
||||
__asm__ __volatile__ (
|
||||
" .set push \n\t"
|
||||
" .set noreorder \n\t"
|
||||
" .set mips64 \n\t"
|
||||
" .set noat \n\t"
|
||||
" cache 4, 0(%3) \n\t"
|
||||
" mfc0 %0, $29 \n\t"
|
||||
" dmfc0 $1, $28 \n\t"
|
||||
" dsrl32 %1, $1, 0 \n\t"
|
||||
" sll %2, $1, 0 \n\t"
|
||||
" .set pop"
|
||||
: "=r" (taghi), "=r" (taglohi), "=r" (taglolo)
|
||||
: "r" ((way << 13) | addr));
|
||||
|
||||
taglo = ((unsigned long long)taglohi << 32) | taglolo;
|
||||
if (way == 0) {
|
||||
lru = (taghi >> 14) & 0xff;
|
||||
printk("[Bank %d Set 0x%02x] LRU > %d %d %d %d > MRU\n",
|
||||
((addr >> 5) & 0x3), /* bank */
|
||||
((addr >> 7) & 0x3f), /* index */
|
||||
(lru & 0x3),
|
||||
((lru >> 2) & 0x3),
|
||||
((lru >> 4) & 0x3),
|
||||
((lru >> 6) & 0x3));
|
||||
}
|
||||
va = (taglo & 0xC0000FFFFFFFE000ULL) | addr;
|
||||
if ((taglo & (1 << 31)) && (((taglo >> 62) & 0x3) == 3))
|
||||
va |= 0x3FFFF00000000000ULL;
|
||||
valid = ((taghi >> 29) & 1);
|
||||
if (valid) {
|
||||
tlo_tmp = taglo & 0xfff3ff;
|
||||
if (((taglo >> 10) & 1) ^ range_parity(tlo_tmp, 23, 0)) {
|
||||
printk(" ** bad parity in VTag0/G/ASID\n");
|
||||
res |= CP0_CERRI_TAG_PARITY;
|
||||
}
|
||||
if (((taglo >> 11) & 1) ^ range_parity(taglo, 63, 24)) {
|
||||
printk(" ** bad parity in R/VTag1\n");
|
||||
res |= CP0_CERRI_TAG_PARITY;
|
||||
}
|
||||
}
|
||||
if (valid ^ ((taghi >> 27) & 1)) {
|
||||
printk(" ** bad parity for valid bit\n");
|
||||
res |= CP0_CERRI_TAG_PARITY;
|
||||
}
|
||||
printk(" %d [VA %016llx] [Vld? %d] raw tags: %08X-%016llX\n",
|
||||
way, va, valid, taghi, taglo);
|
||||
|
||||
if (data) {
|
||||
uint32_t datahi, insta, instb;
|
||||
uint8_t predecode;
|
||||
int offset;
|
||||
|
||||
/* (hit all banks and ways) */
|
||||
for (offset = 0; offset < 4; offset++) {
|
||||
/* Index-load-data-I */
|
||||
__asm__ __volatile__ (
|
||||
" .set push\n\t"
|
||||
" .set noreorder\n\t"
|
||||
" .set mips64\n\t"
|
||||
" .set noat\n\t"
|
||||
" cache 6, 0(%3) \n\t"
|
||||
" mfc0 %0, $29, 1\n\t"
|
||||
" dmfc0 $1, $28, 1\n\t"
|
||||
" dsrl32 %1, $1, 0 \n\t"
|
||||
" sll %2, $1, 0 \n\t"
|
||||
" .set pop \n"
|
||||
: "=r" (datahi), "=r" (insta), "=r" (instb)
|
||||
: "r" ((way << 13) | addr | (offset << 3)));
|
||||
predecode = (datahi >> 8) & 0xff;
|
||||
if (((datahi >> 16) & 1) != (uint32_t)range_parity(predecode, 7, 0)) {
|
||||
printk(" ** bad parity in predecode\n");
|
||||
res |= CP0_CERRI_DATA_PARITY;
|
||||
}
|
||||
/* XXXKW should/could check predecode bits themselves */
|
||||
if (((datahi >> 4) & 0xf) ^ inst_parity(insta)) {
|
||||
printk(" ** bad parity in instruction a\n");
|
||||
res |= CP0_CERRI_DATA_PARITY;
|
||||
}
|
||||
if ((datahi & 0xf) ^ inst_parity(instb)) {
|
||||
printk(" ** bad parity in instruction b\n");
|
||||
res |= CP0_CERRI_DATA_PARITY;
|
||||
}
|
||||
printk(" %05X-%08X%08X", datahi, insta, instb);
|
||||
}
|
||||
printk("\n");
|
||||
}
|
||||
}
|
||||
return res;
|
||||
}
|
||||
|
||||
/* Compute the ECC for a data doubleword */
|
||||
static uint8_t dc_ecc(uint64_t dword)
|
||||
{
|
||||
uint64_t t;
|
||||
uint32_t w;
|
||||
uint8_t p;
|
||||
int i;
|
||||
|
||||
p = 0;
|
||||
for (i = 7; i >= 0; i--)
|
||||
{
|
||||
p <<= 1;
|
||||
t = dword & mask_72_64[i];
|
||||
w = (uint32_t)(t >> 32);
|
||||
p ^= (parity[w>>24] ^ parity[(w>>16) & 0xFF]
|
||||
^ parity[(w>>8) & 0xFF] ^ parity[w & 0xFF]);
|
||||
w = (uint32_t)(t & 0xFFFFFFFF);
|
||||
p ^= (parity[w>>24] ^ parity[(w>>16) & 0xFF]
|
||||
^ parity[(w>>8) & 0xFF] ^ parity[w & 0xFF]);
|
||||
}
|
||||
return p;
|
||||
}
|
||||
|
||||
struct dc_state {
|
||||
unsigned char val;
|
||||
char *name;
|
||||
};
|
||||
|
||||
static struct dc_state dc_states[] = {
|
||||
{ 0x00, "INVALID" },
|
||||
{ 0x0f, "COH-SHD" },
|
||||
{ 0x13, "NCO-E-C" },
|
||||
{ 0x19, "NCO-E-D" },
|
||||
{ 0x16, "COH-E-C" },
|
||||
{ 0x1c, "COH-E-D" },
|
||||
{ 0xff, "*ERROR*" }
|
||||
};
|
||||
|
||||
#define DC_TAG_VALID(state) \
|
||||
(((state) == 0x0) || ((state) == 0xf) || ((state) == 0x13) || \
|
||||
((state) == 0x19) || ((state) == 0x16) || ((state) == 0x1c))
|
||||
|
||||
static char *dc_state_str(unsigned char state)
|
||||
{
|
||||
struct dc_state *dsc = dc_states;
|
||||
while (dsc->val != 0xff) {
|
||||
if (dsc->val == state)
|
||||
break;
|
||||
dsc++;
|
||||
}
|
||||
return dsc->name;
|
||||
}
|
||||
|
||||
static uint32_t extract_dc(unsigned short addr, int data)
|
||||
{
|
||||
int valid, way;
|
||||
unsigned char state;
|
||||
uint32_t taghi, taglolo, taglohi;
|
||||
unsigned long long taglo, pa;
|
||||
uint8_t ecc, lru;
|
||||
int res = 0;
|
||||
|
||||
printk("Dcache index 0x%04x ", addr);
|
||||
for (way = 0; way < 4; way++) {
|
||||
__asm__ __volatile__ (
|
||||
" .set push\n\t"
|
||||
" .set noreorder\n\t"
|
||||
" .set mips64\n\t"
|
||||
" .set noat\n\t"
|
||||
" cache 5, 0(%3)\n\t" /* Index-load-tag-D */
|
||||
" mfc0 %0, $29, 2\n\t"
|
||||
" dmfc0 $1, $28, 2\n\t"
|
||||
" dsrl32 %1, $1, 0\n\t"
|
||||
" sll %2, $1, 0\n\t"
|
||||
" .set pop"
|
||||
: "=r" (taghi), "=r" (taglohi), "=r" (taglolo)
|
||||
: "r" ((way << 13) | addr));
|
||||
|
||||
taglo = ((unsigned long long)taglohi << 32) | taglolo;
|
||||
pa = (taglo & 0xFFFFFFE000ULL) | addr;
|
||||
if (way == 0) {
|
||||
lru = (taghi >> 14) & 0xff;
|
||||
printk("[Bank %d Set 0x%02x] LRU > %d %d %d %d > MRU\n",
|
||||
((addr >> 11) & 0x2) | ((addr >> 5) & 1), /* bank */
|
||||
((addr >> 6) & 0x3f), /* index */
|
||||
(lru & 0x3),
|
||||
((lru >> 2) & 0x3),
|
||||
((lru >> 4) & 0x3),
|
||||
((lru >> 6) & 0x3));
|
||||
}
|
||||
state = (taghi >> 25) & 0x1f;
|
||||
valid = DC_TAG_VALID(state);
|
||||
printk(" %d [PA %010llx] [state %s (%02x)] raw tags: %08X-%016llX\n",
|
||||
way, pa, dc_state_str(state), state, taghi, taglo);
|
||||
if (valid) {
|
||||
if (((taglo >> 11) & 1) ^ range_parity(taglo, 39, 26)) {
|
||||
printk(" ** bad parity in PTag1\n");
|
||||
res |= CP0_CERRD_TAG_ADDRESS;
|
||||
}
|
||||
if (((taglo >> 10) & 1) ^ range_parity(taglo, 25, 13)) {
|
||||
printk(" ** bad parity in PTag0\n");
|
||||
res |= CP0_CERRD_TAG_ADDRESS;
|
||||
}
|
||||
} else {
|
||||
res |= CP0_CERRD_TAG_STATE;
|
||||
}
|
||||
|
||||
if (data) {
|
||||
uint32_t datalohi, datalolo, datahi;
|
||||
unsigned long long datalo;
|
||||
int offset;
|
||||
char bad_ecc = 0;
|
||||
|
||||
for (offset = 0; offset < 4; offset++) {
|
||||
/* Index-load-data-D */
|
||||
__asm__ __volatile__ (
|
||||
" .set push\n\t"
|
||||
" .set noreorder\n\t"
|
||||
" .set mips64\n\t"
|
||||
" .set noat\n\t"
|
||||
" cache 7, 0(%3)\n\t" /* Index-load-data-D */
|
||||
" mfc0 %0, $29, 3\n\t"
|
||||
" dmfc0 $1, $28, 3\n\t"
|
||||
" dsrl32 %1, $1, 0 \n\t"
|
||||
" sll %2, $1, 0 \n\t"
|
||||
" .set pop"
|
||||
: "=r" (datahi), "=r" (datalohi), "=r" (datalolo)
|
||||
: "r" ((way << 13) | addr | (offset << 3)));
|
||||
datalo = ((unsigned long long)datalohi << 32) | datalolo;
|
||||
ecc = dc_ecc(datalo);
|
||||
if (ecc != datahi) {
|
||||
int bits;
|
||||
bad_ecc |= 1 << (3-offset);
|
||||
ecc ^= datahi;
|
||||
bits = hweight8(ecc);
|
||||
res |= (bits == 1) ? CP0_CERRD_DATA_SBE : CP0_CERRD_DATA_DBE;
|
||||
}
|
||||
printk(" %02X-%016llX", datahi, datalo);
|
||||
}
|
||||
printk("\n");
|
||||
if (bad_ecc)
|
||||
printk(" dwords w/ bad ECC: %d %d %d %d\n",
|
||||
!!(bad_ecc & 8), !!(bad_ecc & 4),
|
||||
!!(bad_ecc & 2), !!(bad_ecc & 1));
|
||||
}
|
||||
}
|
||||
return res;
|
||||
}
|
||||
Loading…
Add table
Add a link
Reference in a new issue