1 /* $Id: io.c,v 1.5 2004/02/22 23:08:43 kkojima Exp $
2 *
3 * linux/arch/sh/boards/se/7206/io.c
4 *
5 * Copyright (C) 2006 Yoshinori Sato
6 *
7 * I/O routine for Hitachi 7206 SolutionEngine.
8 *
9 */
10
11 #include <linux/kernel.h>
12 #include <linux/types.h>
13 #include <asm/io.h>
14 #include <mach-se/mach/se7206.h>
15
16
delay(void)17 static inline void delay(void)
18 {
19 ctrl_inw(0x20000000); /* P2 ROM Area */
20 }
21
22 /* MS7750 requires special versions of in*, out* routines, since
23 PC-like io ports are located at upper half byte of 16-bit word which
24 can be accessed only with 16-bit wide. */
25
26 static inline volatile __u16 *
port2adr(unsigned int port)27 port2adr(unsigned int port)
28 {
29 if (port >= 0x2000 && port < 0x2020)
30 return (volatile __u16 *) (PA_MRSHPC + (port - 0x2000));
31 else if (port >= 0x300 && port < 0x310)
32 return (volatile __u16 *) (PA_SMSC + (port - 0x300));
33
34 return (volatile __u16 *)port;
35 }
36
se7206_inb(unsigned long port)37 unsigned char se7206_inb(unsigned long port)
38 {
39 return (*port2adr(port)) & 0xff;
40 }
41
se7206_inb_p(unsigned long port)42 unsigned char se7206_inb_p(unsigned long port)
43 {
44 unsigned long v;
45
46 v = (*port2adr(port)) & 0xff;
47 delay();
48 return v;
49 }
50
se7206_inw(unsigned long port)51 unsigned short se7206_inw(unsigned long port)
52 {
53 return *port2adr(port);;
54 }
55
se7206_outb(unsigned char value,unsigned long port)56 void se7206_outb(unsigned char value, unsigned long port)
57 {
58 *(port2adr(port)) = value;
59 }
60
se7206_outb_p(unsigned char value,unsigned long port)61 void se7206_outb_p(unsigned char value, unsigned long port)
62 {
63 *(port2adr(port)) = value;
64 delay();
65 }
66
se7206_outw(unsigned short value,unsigned long port)67 void se7206_outw(unsigned short value, unsigned long port)
68 {
69 *port2adr(port) = value;
70 }
71
se7206_insb(unsigned long port,void * addr,unsigned long count)72 void se7206_insb(unsigned long port, void *addr, unsigned long count)
73 {
74 volatile __u16 *p = port2adr(port);
75 __u8 *ap = addr;
76
77 while (count--)
78 *ap++ = *p;
79 }
80
se7206_insw(unsigned long port,void * addr,unsigned long count)81 void se7206_insw(unsigned long port, void *addr, unsigned long count)
82 {
83 volatile __u16 *p = port2adr(port);
84 __u16 *ap = addr;
85 while (count--)
86 *ap++ = *p;
87 }
88
se7206_outsb(unsigned long port,const void * addr,unsigned long count)89 void se7206_outsb(unsigned long port, const void *addr, unsigned long count)
90 {
91 volatile __u16 *p = port2adr(port);
92 const __u8 *ap = addr;
93
94 while (count--)
95 *p = *ap++;
96 }
97
se7206_outsw(unsigned long port,const void * addr,unsigned long count)98 void se7206_outsw(unsigned long port, const void *addr, unsigned long count)
99 {
100 volatile __u16 *p = port2adr(port);
101 const __u16 *ap = addr;
102 while (count--)
103 *p = *ap++;
104 }
105