107 строки
2.9 KiB
C
107 строки
2.9 KiB
C
/*
|
|
* panic kernel with dump information
|
|
*
|
|
* Copyright 2005-2009 Analog Devices Inc.
|
|
*
|
|
* Licensed under the GPL-2 or later.
|
|
*/
|
|
|
|
#include <linux/module.h>
|
|
#include <linux/kernel_stat.h>
|
|
#include <linux/sched.h>
|
|
#include <asm/blackfin.h>
|
|
|
|
#define L1_ICACHE_START 0xffa10000
|
|
#define L1_ICACHE_END 0xffa13fff
|
|
|
|
/*
|
|
* irq_panic - calls panic with string setup
|
|
*/
|
|
__attribute__ ((l1_text))
|
|
asmlinkage void irq_panic(int reason, struct pt_regs *regs)
|
|
{
|
|
unsigned int cmd, tag, ca, cache_hi, cache_lo, *pa;
|
|
unsigned short i, j, die;
|
|
unsigned int bad[10][6];
|
|
|
|
/* check entire cache for coherency
|
|
* Since printk is in cacheable memory,
|
|
* don't call it until you have checked everything
|
|
*/
|
|
|
|
die = 0;
|
|
i = 0;
|
|
|
|
/* check icache */
|
|
|
|
for (ca = L1_ICACHE_START; ca <= L1_ICACHE_END && i < 10; ca += 32) {
|
|
|
|
/* Grab various address bits for the itest_cmd fields */
|
|
cmd = (((ca & 0x3000) << 4) | /* ca[13:12] for SBNK[1:0] */
|
|
((ca & 0x0c00) << 16) | /* ca[11:10] for WAYSEL[1:0] */
|
|
((ca & 0x3f8)) | /* ca[09:03] for SET[4:0] and DW[1:0] */
|
|
0); /* Access Tag, Read access */
|
|
|
|
SSYNC();
|
|
bfin_write_ITEST_COMMAND(cmd);
|
|
SSYNC();
|
|
tag = bfin_read_ITEST_DATA0();
|
|
SSYNC();
|
|
|
|
/* if tag is marked as valid, check it */
|
|
if (tag & 1) {
|
|
/* The icache is arranged in 4 groups of 64-bits */
|
|
for (j = 0; j < 32; j += 8) {
|
|
cmd = ((((ca + j) & 0x3000) << 4) | /* ca[13:12] for SBNK[1:0] */
|
|
(((ca + j) & 0x0c00) << 16) | /* ca[11:10] for WAYSEL[1:0] */
|
|
(((ca + j) & 0x3f8)) | /* ca[09:03] for SET[4:0] and DW[1:0] */
|
|
4); /* Access Data, Read access */
|
|
|
|
SSYNC();
|
|
bfin_write_ITEST_COMMAND(cmd);
|
|
SSYNC();
|
|
|
|
cache_hi = bfin_read_ITEST_DATA1();
|
|
cache_lo = bfin_read_ITEST_DATA0();
|
|
|
|
pa = ((unsigned int *)((tag & 0xffffcc00) |
|
|
((ca + j) & ~(0xffffcc00))));
|
|
|
|
/*
|
|
* Debugging this, enable
|
|
*
|
|
* printk("addr: %08x %08x%08x | %08x%08x\n",
|
|
* ((unsigned int *)((tag & 0xffffcc00) | ((ca+j) & ~(0xffffcc00)))),
|
|
* cache_hi, cache_lo, *(pa+1), *pa);
|
|
*/
|
|
|
|
if (cache_hi != *(pa + 1) || cache_lo != *pa) {
|
|
/* Since icache is not working, stay out of it, by not printing */
|
|
die = 1;
|
|
bad[i][0] = (ca + j);
|
|
bad[i][1] = cache_hi;
|
|
bad[i][2] = cache_lo;
|
|
bad[i][3] = ((tag & 0xffffcc00) |
|
|
((ca + j) & ~(0xffffcc00)));
|
|
bad[i][4] = *(pa + 1);
|
|
bad[i][5] = *(pa);
|
|
i++;
|
|
}
|
|
}
|
|
}
|
|
}
|
|
if (die) {
|
|
printk(KERN_EMERG "icache coherency error\n");
|
|
for (j = 0; j <= i; j++) {
|
|
printk(KERN_EMERG
|
|
"cache address : %08x cache value : %08x%08x\n",
|
|
bad[j][0], bad[j][1], bad[j][2]);
|
|
printk(KERN_EMERG
|
|
"physical address: %08x SDRAM value : %08x%08x\n",
|
|
bad[j][3], bad[j][4], bad[j][5]);
|
|
}
|
|
panic("icache coherency error");
|
|
} else
|
|
printk(KERN_EMERG "icache checked, and OK\n");
|
|
}
|