ip22-sc.c
上传用户:jlfgdled
上传日期:2013-04-10
资源大小:33168k
文件大小:5k
- /*
- * ip22-sc.c: Indy cache management functions.
- *
- * Copyright (C) 1997, 2001 Ralf Baechle (ralf@gnu.org),
- * derived from r4xx0.c by David S. Miller (dm@engr.sgi.com).
- */
- #include <linux/init.h>
- #include <linux/kernel.h>
- #include <linux/sched.h>
- #include <linux/mm.h>
- #include <asm/bcache.h>
- #include <asm/sgi/sgi.h>
- #include <asm/sgi/sgimc.h>
- #include <asm/page.h>
- #include <asm/pgtable.h>
- #include <asm/system.h>
- #include <asm/bootinfo.h>
- #include <asm/sgialib.h>
- #include <asm/mmu_context.h>
- /* Secondary cache size in bytes, if present. */
- static unsigned long scache_size;
- #undef DEBUG_CACHE
- #define SC_SIZE 0x00080000
- #define SC_LINE 32
- #define CI_MASK (SC_SIZE - SC_LINE)
- #define SC_INDEX(n) ((n) & CI_MASK)
- static inline void indy_sc_wipe(unsigned long first, unsigned long last)
- {
- unsigned long tmp;
- __asm__ __volatile__(
- ".settpushttt# indy_sc_wipent"
- ".settnoreordernt"
- ".settmips3nt"
- ".settnoatnt"
- "mfc0t%2, $12nt"
- "lit$1, 0x80ttt# Go 64 bitnt"
- "mtc0t$1, $12nt"
- "dlit$1, 0x9000000080000000nt"
- "ort%0, $1ttt# first line to flushnt"
- "ort%1, $1ttt# last line to flushnt"
- ".settatnt"
- "1:tswt$0, 0(%0)nt"
- "bnet%0, %1, 1bnt"
- " daddut%0, 32nt"
- "mtc0t%2, $12ttt# Back to 32 bitnt"
- "nop; nop; nop; nop;nt"
- ".settpop"
- : "=r" (first), "=r" (last), "=&r" (tmp)
- : "0" (first), "1" (last));
- }
- static void indy_sc_wback_invalidate(unsigned long addr, unsigned long size)
- {
- unsigned long first_line, last_line;
- unsigned int flags;
- #ifdef DEBUG_CACHE
- printk("indy_sc_wback_invalidate[%08lx,%08lx]", addr, size);
- #endif
- if (!size)
- return;
- /* Which lines to flush? */
- first_line = SC_INDEX(addr);
- last_line = SC_INDEX(addr + size - 1);
- __save_and_cli(flags);
- if (first_line <= last_line) {
- indy_sc_wipe(first_line, last_line);
- goto out;
- }
- indy_sc_wipe(first_line, SC_SIZE - SC_LINE);
- indy_sc_wipe(0, last_line);
- out:
- __restore_flags(flags);
- }
- static void indy_sc_enable(void)
- {
- unsigned long addr, tmp1, tmp2;
- /* This is really cool... */
- #ifdef DEBUG_CACHE
- printk("Enabling R4600 SCACHEn");
- #endif
- __asm__ __volatile__(
- ".settpushnt"
- ".settnoreordernt"
- ".settmips3nt"
- "mfc0t%2, $12nt"
- "nop; nop; nop; nop;nt"
- "lit%1, 0x80nt"
- "mtc0t%1, $12nt"
- "nop; nop; nop; nop;nt"
- "lit%0, 0x1nt"
- "dsllt%0, 31nt"
- "luit%1, 0x9000nt"
- "dsll32t%1, 0nt"
- "ort%0, %1, %0nt"
- "sbt$0, 0(%0)nt"
- "mtc0t$0, $12nt"
- "nop; nop; nop; nop;nt"
- "mtc0t%2, $12nt"
- "nop; nop; nop; nop;nt"
- ".settpop"
- : "=r" (tmp1), "=r" (tmp2), "=r" (addr));
- }
- static void indy_sc_disable(void)
- {
- unsigned long tmp1, tmp2, tmp3;
- #ifdef DEBUG_CACHE
- printk("Disabling R4600 SCACHEn");
- #endif
- __asm__ __volatile__(
- ".settpushnt"
- ".settnoreordernt"
- ".settmips3nt"
- "lit%0, 0x1nt"
- "dsllt%0, 31nt"
- "luit%1, 0x9000nt"
- "dsll32t%1, 0nt"
- "ort%0, %1, %0nt"
- "mfc0t%2, $12nt"
- "nop; nop; nop; nopnt"
- "lit%1, 0x80nt"
- "mtc0t%1, $12nt"
- "nop; nop; nop; nopnt"
- "sht$0, 0(%0)nt"
- "mtc0t$0, $12nt"
- "nop; nop; nop; nopnt"
- "mtc0t%2, $12nt"
- "nop; nop; nop; nopnt"
- ".settpop"
- : "=r" (tmp1), "=r" (tmp2), "=r" (tmp3));
- }
- static inline int __init indy_sc_probe(void)
- {
- volatile unsigned int *cpu_control;
- unsigned short cmd = 0xc220;
- unsigned long data = 0;
- int i, n;
- #ifdef __MIPSEB__
- cpu_control = (volatile unsigned int *) KSEG1ADDR(0x1fa00034);
- #else
- cpu_control = (volatile unsigned int *) KSEG1ADDR(0x1fa00030);
- #endif
- #define DEASSERT(bit) (*(cpu_control) &= (~(bit)))
- #define ASSERT(bit) (*(cpu_control) |= (bit))
- #define DELAY for(n = 0; n < 100000; n++) __asm__ __volatile__("")
- DEASSERT(SGIMC_EEPROM_PRE);
- DEASSERT(SGIMC_EEPROM_SDATAO);
- DEASSERT(SGIMC_EEPROM_SECLOCK);
- DEASSERT(SGIMC_EEPROM_PRE);
- DELAY;
- ASSERT(SGIMC_EEPROM_CSEL); ASSERT(SGIMC_EEPROM_SECLOCK);
- for(i = 0; i < 11; i++) {
- if(cmd & (1<<15))
- ASSERT(SGIMC_EEPROM_SDATAO);
- else
- DEASSERT(SGIMC_EEPROM_SDATAO);
- DEASSERT(SGIMC_EEPROM_SECLOCK);
- ASSERT(SGIMC_EEPROM_SECLOCK);
- cmd <<= 1;
- }
- DEASSERT(SGIMC_EEPROM_SDATAO);
- for(i = 0; i < (sizeof(unsigned short) * 8); i++) {
- unsigned int tmp;
- DEASSERT(SGIMC_EEPROM_SECLOCK);
- DELAY;
- ASSERT(SGIMC_EEPROM_SECLOCK);
- DELAY;
- data <<= 1;
- tmp = *cpu_control;
- if(tmp & SGIMC_EEPROM_SDATAI)
- data |= 1;
- }
- DEASSERT(SGIMC_EEPROM_SECLOCK);
- DEASSERT(SGIMC_EEPROM_CSEL);
- ASSERT(SGIMC_EEPROM_PRE);
- ASSERT(SGIMC_EEPROM_SECLOCK);
- data <<= PAGE_SHIFT;
- if (data == 0)
- return 0;
- scache_size = data;
- printk("R4600/R5000 SCACHE size %ldK, linesize 32 bytes.n",
- scache_size >> 10);
- return 1;
- }
- /* XXX Check with wje if the Indy caches can differenciate between
- writeback + invalidate and just invalidate. */
- struct bcache_ops indy_sc_ops = {
- indy_sc_enable,
- indy_sc_disable,
- indy_sc_wback_invalidate,
- indy_sc_wback_invalidate
- };
- void __init indy_sc_init(void)
- {
- if (indy_sc_probe()) {
- indy_sc_enable();
- bcops = &indy_sc_ops;
- }
- }