|
@@ -1,273 +0,0 @@
|
|
|
-/*
|
|
|
- * arch/sh/boards/se/7343/io.c
|
|
|
- *
|
|
|
- * I/O routine for SH-Mobile3AS 7343 SolutionEngine.
|
|
|
- *
|
|
|
- */
|
|
|
-#include <linux/kernel.h>
|
|
|
-#include <asm/io.h>
|
|
|
-#include <mach-se/mach/se7343.h>
|
|
|
-
|
|
|
-#define badio(fn, a) panic("bad i/o operation %s for %08lx.", #fn, a)
|
|
|
-
|
|
|
-struct iop {
|
|
|
- unsigned long start, end;
|
|
|
- unsigned long base;
|
|
|
- struct iop *(*check) (struct iop * p, unsigned long port);
|
|
|
- unsigned char (*inb) (struct iop * p, unsigned long port);
|
|
|
- unsigned short (*inw) (struct iop * p, unsigned long port);
|
|
|
- void (*outb) (struct iop * p, unsigned char value, unsigned long port);
|
|
|
- void (*outw) (struct iop * p, unsigned short value, unsigned long port);
|
|
|
-};
|
|
|
-
|
|
|
-struct iop *
|
|
|
-simple_check(struct iop *p, unsigned long port)
|
|
|
-{
|
|
|
- static int count;
|
|
|
-
|
|
|
- if (count < 100)
|
|
|
- count++;
|
|
|
-
|
|
|
- port &= 0xFFFF;
|
|
|
-
|
|
|
- if ((p->start <= port) && (port <= p->end))
|
|
|
- return p;
|
|
|
- else
|
|
|
- badio(check, port);
|
|
|
-}
|
|
|
-
|
|
|
-struct iop *
|
|
|
-ide_check(struct iop *p, unsigned long port)
|
|
|
-{
|
|
|
- if (((0x1f0 <= port) && (port <= 0x1f7)) || (port == 0x3f7))
|
|
|
- return p;
|
|
|
- return NULL;
|
|
|
-}
|
|
|
-
|
|
|
-unsigned char
|
|
|
-simple_inb(struct iop *p, unsigned long port)
|
|
|
-{
|
|
|
- return *(unsigned char *) (p->base + port);
|
|
|
-}
|
|
|
-
|
|
|
-unsigned short
|
|
|
-simple_inw(struct iop *p, unsigned long port)
|
|
|
-{
|
|
|
- return *(unsigned short *) (p->base + port);
|
|
|
-}
|
|
|
-
|
|
|
-void
|
|
|
-simple_outb(struct iop *p, unsigned char value, unsigned long port)
|
|
|
-{
|
|
|
- *(unsigned char *) (p->base + port) = value;
|
|
|
-}
|
|
|
-
|
|
|
-void
|
|
|
-simple_outw(struct iop *p, unsigned short value, unsigned long port)
|
|
|
-{
|
|
|
- *(unsigned short *) (p->base + port) = value;
|
|
|
-}
|
|
|
-
|
|
|
-unsigned char
|
|
|
-pcc_inb(struct iop *p, unsigned long port)
|
|
|
-{
|
|
|
- unsigned long addr = p->base + port + 0x40000;
|
|
|
- unsigned long v;
|
|
|
-
|
|
|
- if (port & 1)
|
|
|
- addr += 0x00400000;
|
|
|
- v = *(volatile unsigned char *) addr;
|
|
|
- return v;
|
|
|
-}
|
|
|
-
|
|
|
-void
|
|
|
-pcc_outb(struct iop *p, unsigned char value, unsigned long port)
|
|
|
-{
|
|
|
- unsigned long addr = p->base + port + 0x40000;
|
|
|
-
|
|
|
- if (port & 1)
|
|
|
- addr += 0x00400000;
|
|
|
- *(volatile unsigned char *) addr = value;
|
|
|
-}
|
|
|
-
|
|
|
-unsigned char
|
|
|
-bad_inb(struct iop *p, unsigned long port)
|
|
|
-{
|
|
|
- badio(inb, port);
|
|
|
-}
|
|
|
-
|
|
|
-void
|
|
|
-bad_outb(struct iop *p, unsigned char value, unsigned long port)
|
|
|
-{
|
|
|
- badio(inw, port);
|
|
|
-}
|
|
|
-
|
|
|
-#ifdef CONFIG_SMC91X
|
|
|
-/* MSTLANEX01 LAN at 0xb400:0000 */
|
|
|
-static struct iop laniop = {
|
|
|
- .start = 0x00,
|
|
|
- .end = 0x0F,
|
|
|
- .base = 0x04000000,
|
|
|
- .check = simple_check,
|
|
|
- .inb = simple_inb,
|
|
|
- .inw = simple_inw,
|
|
|
- .outb = simple_outb,
|
|
|
- .outw = simple_outw,
|
|
|
-};
|
|
|
-#endif
|
|
|
-
|
|
|
-#ifdef CONFIG_NE2000
|
|
|
-/* NE2000 pc card NIC */
|
|
|
-static struct iop neiop = {
|
|
|
- .start = 0x280,
|
|
|
- .end = 0x29f,
|
|
|
- .base = 0xb0600000 + 0x80, /* soft 0x280 -> hard 0x300 */
|
|
|
- .check = simple_check,
|
|
|
- .inb = pcc_inb,
|
|
|
- .inw = simple_inw,
|
|
|
- .outb = pcc_outb,
|
|
|
- .outw = simple_outw,
|
|
|
-};
|
|
|
-#endif
|
|
|
-
|
|
|
-#ifdef CONFIG_IDE
|
|
|
-/* CF in CF slot */
|
|
|
-static struct iop cfiop = {
|
|
|
- .base = 0xb0600000,
|
|
|
- .check = ide_check,
|
|
|
- .inb = pcc_inb,
|
|
|
- .inw = simple_inw,
|
|
|
- .outb = pcc_outb,
|
|
|
- .outw = simple_outw,
|
|
|
-};
|
|
|
-#endif
|
|
|
-
|
|
|
-static __inline__ struct iop *
|
|
|
-port2iop(unsigned long port)
|
|
|
-{
|
|
|
- if (0) ;
|
|
|
-#if defined(CONFIG_SMC91X)
|
|
|
- else if (laniop.check(&laniop, port))
|
|
|
- return &laniop;
|
|
|
-#endif
|
|
|
-#if defined(CONFIG_NE2000)
|
|
|
- else if (neiop.check(&neiop, port))
|
|
|
- return &neiop;
|
|
|
-#endif
|
|
|
-#if defined(CONFIG_IDE)
|
|
|
- else if (cfiop.check(&cfiop, port))
|
|
|
- return &cfiop;
|
|
|
-#endif
|
|
|
- else
|
|
|
- return NULL;
|
|
|
-}
|
|
|
-
|
|
|
-static inline void
|
|
|
-delay(void)
|
|
|
-{
|
|
|
- ctrl_inw(0xac000000);
|
|
|
- ctrl_inw(0xac000000);
|
|
|
-}
|
|
|
-
|
|
|
-unsigned char
|
|
|
-sh7343se_inb(unsigned long port)
|
|
|
-{
|
|
|
- struct iop *p = port2iop(port);
|
|
|
- return (p->inb) (p, port);
|
|
|
-}
|
|
|
-
|
|
|
-unsigned char
|
|
|
-sh7343se_inb_p(unsigned long port)
|
|
|
-{
|
|
|
- unsigned char v = sh7343se_inb(port);
|
|
|
- delay();
|
|
|
- return v;
|
|
|
-}
|
|
|
-
|
|
|
-unsigned short
|
|
|
-sh7343se_inw(unsigned long port)
|
|
|
-{
|
|
|
- struct iop *p = port2iop(port);
|
|
|
- return (p->inw) (p, port);
|
|
|
-}
|
|
|
-
|
|
|
-unsigned int
|
|
|
-sh7343se_inl(unsigned long port)
|
|
|
-{
|
|
|
- badio(inl, port);
|
|
|
-}
|
|
|
-
|
|
|
-void
|
|
|
-sh7343se_outb(unsigned char value, unsigned long port)
|
|
|
-{
|
|
|
- struct iop *p = port2iop(port);
|
|
|
- (p->outb) (p, value, port);
|
|
|
-}
|
|
|
-
|
|
|
-void
|
|
|
-sh7343se_outb_p(unsigned char value, unsigned long port)
|
|
|
-{
|
|
|
- sh7343se_outb(value, port);
|
|
|
- delay();
|
|
|
-}
|
|
|
-
|
|
|
-void
|
|
|
-sh7343se_outw(unsigned short value, unsigned long port)
|
|
|
-{
|
|
|
- struct iop *p = port2iop(port);
|
|
|
- (p->outw) (p, value, port);
|
|
|
-}
|
|
|
-
|
|
|
-void
|
|
|
-sh7343se_outl(unsigned int value, unsigned long port)
|
|
|
-{
|
|
|
- badio(outl, port);
|
|
|
-}
|
|
|
-
|
|
|
-void
|
|
|
-sh7343se_insb(unsigned long port, void *addr, unsigned long count)
|
|
|
-{
|
|
|
- unsigned char *a = addr;
|
|
|
- struct iop *p = port2iop(port);
|
|
|
- while (count--)
|
|
|
- *a++ = (p->inb) (p, port);
|
|
|
-}
|
|
|
-
|
|
|
-void
|
|
|
-sh7343se_insw(unsigned long port, void *addr, unsigned long count)
|
|
|
-{
|
|
|
- unsigned short *a = addr;
|
|
|
- struct iop *p = port2iop(port);
|
|
|
- while (count--)
|
|
|
- *a++ = (p->inw) (p, port);
|
|
|
-}
|
|
|
-
|
|
|
-void
|
|
|
-sh7343se_insl(unsigned long port, void *addr, unsigned long count)
|
|
|
-{
|
|
|
- badio(insl, port);
|
|
|
-}
|
|
|
-
|
|
|
-void
|
|
|
-sh7343se_outsb(unsigned long port, const void *addr, unsigned long count)
|
|
|
-{
|
|
|
- unsigned char *a = (unsigned char *) addr;
|
|
|
- struct iop *p = port2iop(port);
|
|
|
- while (count--)
|
|
|
- (p->outb) (p, *a++, port);
|
|
|
-}
|
|
|
-
|
|
|
-void
|
|
|
-sh7343se_outsw(unsigned long port, const void *addr, unsigned long count)
|
|
|
-{
|
|
|
- unsigned short *a = (unsigned short *) addr;
|
|
|
- struct iop *p = port2iop(port);
|
|
|
- while (count--)
|
|
|
- (p->outw) (p, *a++, port);
|
|
|
-}
|
|
|
-
|
|
|
-void
|
|
|
-sh7343se_outsl(unsigned long port, const void *addr, unsigned long count)
|
|
|
-{
|
|
|
- badio(outsw, port);
|
|
|
-}
|