开通博客赚积分
发布资源赚积分
分类

源码开发语言/平台
当前位置：首页 > 源码/资料 > Linux/Unix编程 > 查看源码
cache_error.c
资源名称：linux-2.4.20.tar.gz　[点击查看]
上传用户：jlfgdled
上传日期：2013-04-10
资源大小：33168k
文件大小：14k
源码类别：

Linux/Unix编程

开发平台：

Unix_Linux

cache_error.c：源码内容
  1. /*
  2.  * Copyright (C) 2001 Broadcom Corporation
  3.  *
  4.  * This program is free software; you can redistribute it and/or
  5.  * modify it under the terms of the GNU General Public License
  6.  * as published by the Free Software Foundation; either version 2
  7.  * of the License, or (at your option) any later version.
  8.  *
  9.  * This program is distributed in the hope that it will be useful,
  10.  * but WITHOUT ANY WARRANTY; without even the implied warranty of
  11.  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
  12.  * GNU General Public License for more details.
  13.  *
  14.  * You should have received a copy of the GNU General Public License
  15.  * along with this program; if not, write to the Free Software
  16.  * Foundation, Inc., 59 Temple Place - Suite 330, Boston, MA  02111-1307, USA.
  17.  */
  19. #include <linux/sched.h>
  20. #include <asm/mipsregs.h>
  22. /* SB1 definitions */
  24. /* XXX should come from config1 XXX */
  25. #define SB1_CACHE_INDEX_MASK   0x1fe0
  27. #define CP0_ERRCTL_RECOVERABLE (1 << 31)
  28. #define CP0_ERRCTL_DCACHE      (1 << 30)
  29. #define CP0_ERRCTL_ICACHE      (1 << 29)
  30. #define CP0_ERRCTL_MULTIBUS    (1 << 23)
  31. #define CP0_ERRCTL_MC_TLB      (1 << 15)
  32. #define CP0_ERRCTL_MC_TIMEOUT  (1 << 14)
  34. #define CP0_CERRI_TAG_PARITY   (1 << 29)
  35. #define CP0_CERRI_DATA_PARITY  (1 << 28)
  36. #define CP0_CERRI_EXTERNAL     (1 << 26)
  38. #define CP0_CERRI_IDX_VALID(c) (!((c) & CP0_CERRI_EXTERNAL))
  39. #define CP0_CERRI_DATA         (CP0_CERRI_DATA_PARITY)
  41. #define CP0_CERRD_MULTIPLE     (1 << 31)
  42. #define CP0_CERRD_TAG_STATE    (1 << 30)
  43. #define CP0_CERRD_TAG_ADDRESS  (1 << 29)
  44. #define CP0_CERRD_DATA_SBE     (1 << 28)
  45. #define CP0_CERRD_DATA_DBE     (1 << 27)
  46. #define CP0_CERRD_EXTERNAL     (1 << 26)
  47. #define CP0_CERRD_LOAD         (1 << 25)
  48. #define CP0_CERRD_STORE        (1 << 24)
  49. #define CP0_CERRD_FILLWB       (1 << 23)
  50. #define CP0_CERRD_COHERENCY    (1 << 22)
  51. #define CP0_CERRD_DUPTAG       (1 << 21)
  53. #define CP0_CERRD_DPA_VALID(c) (!((c) & CP0_CERRD_EXTERNAL))
  54. #define CP0_CERRD_IDX_VALID(c) 
  55.    (((c) & (CP0_CERRD_LOAD | CP0_CERRD_STORE)) ? (!((c) & CP0_CERRD_EXTERNAL)) : 0)
  56. #define CP0_CERRD_CAUSES 
  57.    (CP0_CERRD_LOAD | CP0_CERRD_STORE | CP0_CERRD_FILLWB | CP0_CERRD_COHERENCY | CP0_CERRD_DUPTAG)
  58. #define CP0_CERRD_TYPES 
  59.    (CP0_CERRD_TAG_STATE | CP0_CERRD_TAG_ADDRESS | CP0_CERRD_DATA_SBE | CP0_CERRD_DATA_DBE | CP0_CERRD_EXTERNAL)
  60. #define CP0_CERRD_DATA         (CP0_CERRD_DATA_SBE | CP0_CERRD_DATA_DBE)
  62. static uint32_t extract_ic(unsigned short addr, int data);
  63. static uint32_t extract_dc(unsigned short addr, int data);
  65. spinlock_t in_cacheerr = SPIN_LOCK_UNLOCKED;
  67. static inline void breakout_errctl(unsigned int val)
  68. {
  69. if (val & CP0_ERRCTL_RECOVERABLE)
  70. printk(" recoverable");
  71. if (val & CP0_ERRCTL_DCACHE)
  72. printk(" dcache");
  73. if (val & CP0_ERRCTL_ICACHE)
  74. printk(" icache");
  75. if (val & CP0_ERRCTL_MULTIBUS)
  76. printk(" multiple-buserr");
  77. printk("n");
  78. }
  80. static inline void breakout_cerri(unsigned int val)
  81. {
  82. if (val & CP0_CERRI_TAG_PARITY)
  83. printk(" tag-parity");
  84. if (val & CP0_CERRI_DATA_PARITY)
  85. printk(" data-parity");
  86. if (val & CP0_CERRI_EXTERNAL)
  87. printk(" external");
  88. printk("n");
  89. }
  91. static inline void breakout_cerrd(unsigned int val)
  92. {
  93. switch (val & CP0_CERRD_CAUSES) {
  94. case CP0_CERRD_LOAD:
  95. printk(" load,");
  96. break;
  97. case CP0_CERRD_STORE:
  98. printk(" store,");
  99. break;
  100. case CP0_CERRD_FILLWB:
  101. printk(" fill/wb,");
  102. break;
  103. case CP0_CERRD_COHERENCY:
  104. printk(" coherency,");
  105. break;
  106. case CP0_CERRD_DUPTAG:
  107. printk(" duptags,");
  108. break;
  109. default:
  110. printk(" NO CAUSE,");
  111. break;
  112. }
  113. if (!(val & CP0_CERRD_TYPES))
  114. printk(" NO TYPE");
  115. else {
  116. if (val & CP0_CERRD_MULTIPLE)
  117. printk(" multi-err");
  118. if (val & CP0_CERRD_TAG_STATE)
  119. printk(" tag-state");
  120. if (val & CP0_CERRD_TAG_ADDRESS)
  121. printk(" tag-address");
  122. if (val & CP0_CERRD_DATA_SBE)
  123. printk(" data-SBE");
  124. if (val & CP0_CERRD_DATA_DBE)
  125. printk(" data-DBE");
  126. if (val & CP0_CERRD_EXTERNAL)
  127. printk(" external");
  128. }
  129. printk("n");
  130. }
  132. asmlinkage void sb1_cache_error(void)
  133. {
  134. uint64_t cerr_dpa;
  135. uint32_t errctl, cerr_i, cerr_d, dpalo, dpahi, eepc, res;
  137. /* Prevent re-entrance in the SMP case */
  138. spin_lock(&in_cacheerr);
  139. printk("Cache error exception on CPU %x:n",
  140.        (read_32bit_cp0_register(CP0_PRID) >> 25) & 0x7);
  141. __asm__ __volatile__ (
  142. ".set pushnt"
  143. ".set mips64nt"
  144. ".set noatnt"
  145. "mfc0   %0, $26, 0nt"
  146. "mfc0   %1, $27, 0nt"
  147. "mfc0   %2, $27, 1nt"
  148. "dmfc0  $1, $27, 3nt"
  149. "dsrl32 %3, $1, 0 nt"
  150. "sll    %4, $1, 0 nt"
  151. "mfc0   %5, $30nt"
  152. ".set popn"
  153. : "=r" (errctl), "=r" (cerr_i), "=r" (cerr_d),
  154.   "=r" (dpahi), "=r" (dpalo), "=r" (eepc));
  155. cerr_dpa = (((uint64_t)dpahi) << 32) | dpalo;
  156. printk(" cp0_errorepc ==   %08xn", eepc);
  157. printk(" cp0_errctl   ==   %08x", errctl);
  158. breakout_errctl(errctl);
  159. if (errctl & CP0_ERRCTL_ICACHE) {
  160. printk(" cp0_cerr_i   ==   %08x", cerr_i);
  161. breakout_cerri(cerr_i);
  162. if (CP0_CERRI_IDX_VALID(cerr_i)) {
  163. if ((eepc & SB1_CACHE_INDEX_MASK) != (cerr_i & SB1_CACHE_INDEX_MASK))
  164. printk(" cerr_i idx doesn't match eepcn");
  165. else {
  166. res = extract_ic(cerr_i & SB1_CACHE_INDEX_MASK,
  167.  (cerr_i & CP0_CERRI_DATA) != 0);
  168. if (!(res & cerr_i))
  169. printk("...didn't see indicated icache problemn");
  170. }
  171. }
  172. }
  173. if (errctl & CP0_ERRCTL_DCACHE) {
  174. printk(" cp0_cerr_d   ==   %08x", cerr_d);
  175. breakout_cerrd(cerr_d);
  176. if (CP0_CERRD_DPA_VALID(cerr_d)) {
  177. printk(" cp0_cerr_dpa == %010llxn", cerr_dpa);
  178. if (!CP0_CERRD_IDX_VALID(cerr_d)) {
  179. res = extract_dc(cerr_dpa & SB1_CACHE_INDEX_MASK,
  180.  (cerr_d & CP0_CERRD_DATA) != 0);
  181. if (!(res & cerr_d))
  182. printk("...didn't see indicated dcache problemn");
  183. } else {
  184. if ((cerr_dpa & SB1_CACHE_INDEX_MASK) != (cerr_d & SB1_CACHE_INDEX_MASK))
  185. printk(" cerr_d idx doesn't match cerr_dpan");
  186. else {
  187. res = extract_dc(cerr_d & SB1_CACHE_INDEX_MASK,
  188.  (cerr_d & CP0_CERRD_DATA) != 0);
  189. if (!(res & cerr_d))
  190. printk("...didn't see indicated problemn");
  191. }
  192. }
  193. }
  194. }
  196. while (1);
  197. /*
  198.  * This tends to make things get really ugly; let's just stall instead.
  199.  *    panic("Can't handle the cache error!");
  200.  */
  201. }
  204. /* Parity lookup table. */
  205. static const uint8_t parity[256] = {
  206. 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,
  207. 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,
  208. 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,
  209. 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,
  210. 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,
  211. 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,
  212. 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,
  213. 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
  214. };
  216. /* Masks to select bits for Hamming parity, mask_72_64[i] for bit[i] */
  217. static const uint64_t mask_72_64[8] = {
  218. 0x0738C808099264FFL,
  219. 0x38C808099264FF07L,
  220. 0xC808099264FF0738L,
  221. 0x08099264FF0738C8L,
  222. 0x099264FF0738C808L,
  223. 0x9264FF0738C80809L,
  224. 0x64FF0738C8080992L,
  225. 0xFF0738C808099264L
  226. };
  228. /* Calculate the parity on a range of bits */
  229. static char range_parity(uint64_t dword, int max, int min)
  230. {
  231. char parity = 0;
  232. int i;
  233. dword >>= min;
  234. for (i=max-min; i>=0; i--) {
  235. if (dword & 0x1)
  236. parity = !parity;
  237. dword >>= 1;
  238. }
  239. return parity;
  240. }
  242. /* Calculate the 4-bit even byte-parity for an instruction */
  243. static unsigned char inst_parity(uint32_t word)
  244. {
  245. int i, j;
  246. char parity = 0;
  247. for (j=0; j<4; j++) {
  248. char byte_parity = 0;
  249. for (i=0; i<8; i++) {
  250. if (word & 0x80000000)
  251. byte_parity = !byte_parity;
  252. word <<= 1;
  253. }
  254. parity <<= 1;
  255. parity |= byte_parity;
  256. }
  257. return parity;
  258. }
  260. static uint32_t extract_ic(unsigned short addr, int data)
  261. {
  262. unsigned short way;
  263. int valid;
  264. uint64_t taglo, va, tlo_tmp;
  265. uint32_t taghi, taglolo, taglohi;
  266. uint8_t lru;
  267. int res = 0;
  269. printk("Icache index 0x%04x  ", addr);
  270. for (way = 0; way < 4; way++) {
  271. /* Index-load-tag-I */
  272. __asm__ __volatile__ (
  273. ".set push        nt"
  274. ".set noreorder   nt"
  275. ".set mips64      nt"
  276. ".set noat        nt"
  277. "cache  4, 0(%3)  nt"
  278. "mfc0   %0, $29, 0nt"
  279. "dmfc0  $1, $28, 0nt"
  280. "dsrl32 %1, $1, 0 nt"
  281. "sll    %2, $1, 0 nt"
  282. ".set pop         n"
  283. : "=r" (taghi), "=r" (taglohi),
  284.   "=r" (taglolo)
  285. : "r" ((way << 13) | addr));
  286. taglo = ((unsigned long long)taglohi << 32) | taglolo;
  287. if (way == 0) {
  288. lru = (taghi >> 14) & 0xff;
  289. printk("[Bank %d Set 0x%02x]  LRU > %d %d %d %d > MRUn",
  290.        ((addr >> 5) & 0x3), /* bank */
  291.        ((addr >> 7) & 0x3f), /* index */
  292.        (lru & 0x3),
  293.        ((lru >> 2) & 0x3),
  294.        ((lru >> 4) & 0x3),
  295.        ((lru >> 6) & 0x3));
  296. }
  297. va = (taglo & 0xC0000FFFFFFFE000) | addr;
  298. if ((taglo & (1 << 31)) && (((taglo >> 62) & 0x3) == 3))
  299. va |= 0x3FFFF00000000000;
  300. valid = ((taghi >> 29) & 1);
  301. if (valid) {
  302. tlo_tmp = taglo & 0xfff3ff;
  303. if (((taglo >> 10) & 1) ^ range_parity(tlo_tmp, 23, 0)) {
  304. printk("   ** bad parity in VTag0/G/ASIDn");
  305. res |= CP0_CERRI_TAG_PARITY;
  306. }
  307. if (((taglo >> 11) & 1) ^ range_parity(taglo, 63, 24)) {
  308. printk("   ** bad parity in R/VTag1n");
  309. res |= CP0_CERRI_TAG_PARITY;
  310. }
  311. }
  312. if (valid ^ ((taghi >> 27) & 1)) {
  313. printk("   ** bad parity for valid bitn");
  314. res |= CP0_CERRI_TAG_PARITY;
  315. }
  316. printk(" %d  [VA %016llx]  [Vld? %d]  raw tags: %08X-%016llXn",
  317.        way, va, valid, taghi, taglo);
  319. if (data) {
  320. uint32_t datahi, insta, instb;
  321. uint8_t predecode;
  322. int offset;
  324. /* (hit all banks and ways) */
  325. for (offset = 0; offset < 4; offset++) {
  326. /* Index-load-data-I */
  327. __asm__ __volatile__ (
  328. ".set push        nt"
  329. ".set noreorder   nt"
  330. ".set mips64      nt"
  331. ".set noat        nt"
  332. "cache  6, 0(%3)  nt"
  333. "mfc0   %0, $29, 1nt"
  334. "dmfc0  $1, $28, 1nt"
  335. "dsrl32 %1, $1, 0 nt"
  336. "sll    %2, $1, 0 nt"
  337. ".set pop         n"
  338. : "=r" (datahi), "=r" (insta),
  339.   "=r" (instb)
  340. : "r" ((way << 13) | addr | (offset << 3)));
  341. predecode = (datahi >> 8) & 0xff;
  342. if (((datahi >> 16) & 1) != (uint32_t)range_parity(predecode, 7, 0)) {
  343. printk("   ** bad parity in predecoden");
  344. res |= CP0_CERRI_DATA_PARITY;
  345. }
  346. /* XXXKW should/could check predecode bits themselves */
  347. if (((datahi >> 4) & 0xf) ^ inst_parity(insta)) {
  348. printk("   ** bad parity in instruction an");
  349. res |= CP0_CERRI_DATA_PARITY;
  350. }
  351. if ((datahi & 0xf) ^ inst_parity(instb)) {
  352. printk("   ** bad parity in instruction bn");
  353. res |= CP0_CERRI_DATA_PARITY;
  354. }
  355. printk("  %05X-%08X%08X", datahi, insta, instb);
  356. }
  357. printk("n");
  358. }
  359. }
  360. return res;
  361. }
  363. /* Compute the ECC for a data doubleword */
  364. static uint8_t dc_ecc(uint64_t dword)
  365. {
  366. uint64_t t;
  367. uint32_t w;
  368. uint8_t  p;
  369. int      i;
  371. p = 0;
  372. for (i = 7; i >= 0; i--)
  373. {
  374. p <<= 1;
  375. t = dword & mask_72_64[i];
  376. w = (uint32_t)(t >> 32);
  377. p ^= (parity[w>>24] ^ parity[(w>>16) & 0xFF]
  378.       ^ parity[(w>>8) & 0xFF] ^ parity[w & 0xFF]);
  379. w = (uint32_t)(t & 0xFFFFFFFF);
  380. p ^= (parity[w>>24] ^ parity[(w>>16) & 0xFF]
  381.       ^ parity[(w>>8) & 0xFF] ^ parity[w & 0xFF]);
  382. }
  383. return p;
  384. }
  386. struct dc_state {
  387. unsigned char val;
  388. char *name;
  389. };
  391. static struct dc_state dc_states[] = {
  392. { 0x00, "INVALID" },
  393. { 0x0f, "COH-SHD" },
  394. { 0x13, "NCO-E-C" },
  395. { 0x19, "NCO-E-D" },
  396. { 0x16, "COH-E-C" },
  397. { 0x1c, "COH-E-D" },
  398. { 0xff, "*ERROR*" }
  399. };
  401. #define DC_TAG_VALID(state) 
  402.     (((state) == 0xf) || ((state) == 0x13) || ((state) == 0x19) || ((state == 0x16)) || ((state) == 0x1c))
  404. static char *dc_state_str(unsigned char state)
  405. {
  406. struct dc_state *dsc = dc_states;
  407. while (dsc->val != 0xff) {
  408. if (dsc->val == state)
  409. break;
  410. dsc++;
  411. }
  412. return dsc->name;
  413. }
  415. static uint32_t extract_dc(unsigned short addr, int data)
  416. {
  417. int valid, way;
  418. unsigned char state;
  419. uint64_t taglo, pa;
  420. uint32_t taghi, taglolo, taglohi;
  421. uint8_t ecc, lru;
  422. int res = 0;
  424. printk("Dcache index 0x%04x  ", addr);
  425. for (way = 0; way < 4; way++) {
  426. /* Index-load-tag-D */
  427. __asm__ __volatile__ (
  428. ".set push        nt"
  429. ".set noreorder   nt"
  430. ".set mips64      nt"
  431. ".set noat        nt"
  432. "cache  5, 0(%3)  nt"
  433. "mfc0   %0, $29, 2nt"
  434. "dmfc0  $1, $28, 2nt"
  435. "dsrl32 %1, $1, 0 nt"
  436. "sll    %2, $1, 0 nt"
  437. ".set pop         n"
  438. : "=r" (taghi), "=r" (taglohi),
  439.   "=r" (taglolo)
  440. : "r" ((way << 13) | addr));
  442. taglo = ((unsigned long long)taglohi << 32) | taglolo;
  443. pa = (taglo & 0xFFFFFFE000) | addr;
  444. if (way == 0) {
  445. lru = (taghi >> 14) & 0xff;
  446. printk("[Bank %d Set 0x%02x]  LRU > %d %d %d %d > MRUn",
  447.        ((addr >> 11) & 0x2) | ((addr >> 5) & 1), /* bank */
  448.        ((addr >> 6) & 0x3f), /* index */
  449.        (lru & 0x3),
  450.        ((lru >> 2) & 0x3),
  451.        ((lru >> 4) & 0x3),
  452.        ((lru >> 6) & 0x3));
  453. }
  454. state = (taghi >> 25) & 0x1f;
  455. valid = DC_TAG_VALID(state);
  456. printk(" %d  [PA %010llx]  [state %s (%02x)]  raw tags: %08X-%016llXn",
  457.        way, pa, dc_state_str(state), state, taghi, taglo);
  458. if (valid) {
  459. if (((taglo >> 11) & 1) ^ range_parity(taglo, 39, 26)) {
  460. printk("   ** bad parity in PTag1n");
  461. res |= CP0_CERRD_TAG_ADDRESS;
  462. }
  463. if (((taglo >> 10) & 1) ^ range_parity(taglo, 25, 13)) {
  464. printk("   ** bad parity in PTag0n");
  465. res |= CP0_CERRD_TAG_ADDRESS;
  466. }
  467. } else {
  468. res |= CP0_CERRD_TAG_STATE;
  469. }
  471. if (data) {
  472. uint64_t datalo;
  473. uint32_t datalohi, datalolo, datahi;
  474. int offset;
  476. for (offset = 0; offset < 4; offset++) {
  477. /* Index-load-data-D */
  478. __asm__ __volatile__ (
  479. ".set push        nt"
  480. ".set noreorder   nt"
  481. ".set mips64      nt"
  482. ".set noat        nt"
  483. "cache  7, 0(%3)  nt"
  484. "mfc0   %0, $29, 3nt"
  485. "dmfc0  $1, $28, 3nt"
  486. "dsrl32 %1, $1, 0 nt"
  487. "sll    %2, $1, 0 nt"
  488. ".set pop         n"
  489. : "=r" (datahi), "=r" (datalohi),
  490. "=r" (datalolo)
  491. : "r" ((way << 13) | addr | (offset << 3)));
  492. datalo = ((unsigned long long)datalohi << 32) | datalolo;
  493. ecc = dc_ecc(datalo);
  494. if (ecc != datahi) {
  495. int bits = 0;
  496. printk("  ** bad ECC (%02x %02x) ->",
  497.        datahi, ecc);
  498. ecc ^= datahi;
  499. while (ecc) {
  500. if (ecc & 1) bits++;
  501. ecc >>= 1;
  502. }
  503. res |= (bits == 1) ? CP0_CERRD_DATA_SBE : CP0_CERRD_DATA_DBE;
  504. }
  505. printk("  %02X-%016llX", datahi, datalo);
  506. }
  507. printk("n");
  508. }
  509. }
  510. return res;
  511. }