a22a9e02e09309829b9c60448776ec85ccfd4e0c
[linux-2.6.git] / arch / cris / arch-v32 / kernel / io.c
1 /*
2  * Helper functions for I/O pins.
3  *
4  * Copyright (c) 2004 Axis Communications AB.
5  */
6
7 #include <linux/types.h>
8 #include <linux/errno.h>
9 #include <linux/init.h>
10 #include <linux/string.h>
11 #include <linux/ctype.h>
12 #include <linux/kernel.h>
13 #include <linux/module.h>
14 #include <asm/io.h>
15 #include <asm/arch/pinmux.h>
16 #include <asm/arch/hwregs/gio_defs.h>
17
18 struct crisv32_ioport crisv32_ioports[] =
19 {
20         {
21                 (unsigned long*)REG_ADDR(gio, regi_gio, rw_pa_oe),
22                 (unsigned long*)REG_ADDR(gio, regi_gio, rw_pa_dout),
23                 (unsigned long*)REG_ADDR(gio, regi_gio, r_pa_din),
24                 8
25         },
26         {
27                 (unsigned long*)REG_ADDR(gio, regi_gio, rw_pb_oe),
28                 (unsigned long*)REG_ADDR(gio, regi_gio, rw_pb_dout),
29                 (unsigned long*)REG_ADDR(gio, regi_gio, r_pb_din),
30                 18
31         },
32         {
33                 (unsigned long*)REG_ADDR(gio, regi_gio, rw_pc_oe),
34                 (unsigned long*)REG_ADDR(gio, regi_gio, rw_pc_dout),
35                 (unsigned long*)REG_ADDR(gio, regi_gio, r_pc_din),
36                 18
37         },
38         {
39                 (unsigned long*)REG_ADDR(gio, regi_gio, rw_pd_oe),
40                 (unsigned long*)REG_ADDR(gio, regi_gio, rw_pd_dout),
41                 (unsigned long*)REG_ADDR(gio, regi_gio, r_pd_din),
42                 18
43         },
44         {
45                 (unsigned long*)REG_ADDR(gio, regi_gio, rw_pe_oe),
46                 (unsigned long*)REG_ADDR(gio, regi_gio, rw_pe_dout),
47                 (unsigned long*)REG_ADDR(gio, regi_gio, r_pe_din),
48                 18
49         }
50 };
51
52 #define NBR_OF_PORTS ARRAY_SIZE(crisv32_ioports)
53
54 struct crisv32_iopin crisv32_led1_green;
55 struct crisv32_iopin crisv32_led1_red;
56 struct crisv32_iopin crisv32_led2_green;
57 struct crisv32_iopin crisv32_led2_red;
58 struct crisv32_iopin crisv32_led3_green;
59 struct crisv32_iopin crisv32_led3_red;
60
61 /* Dummy port used when green LED and red LED is on the same bit */
62 static unsigned long io_dummy;
63 static struct crisv32_ioport dummy_port =
64 {
65         &io_dummy,
66         &io_dummy,
67         &io_dummy,
68         18
69 };
70 static struct crisv32_iopin dummy_led =
71 {
72         &dummy_port,
73         0
74 };
75
76 static int __init crisv32_io_init(void)
77 {
78         int ret = 0;
79         /* Initialize LEDs */
80         ret += crisv32_io_get_name(&crisv32_led1_green, CONFIG_ETRAX_LED1G);
81         ret += crisv32_io_get_name(&crisv32_led1_red, CONFIG_ETRAX_LED1R);
82         ret += crisv32_io_get_name(&crisv32_led2_green, CONFIG_ETRAX_LED2G);
83         ret += crisv32_io_get_name(&crisv32_led2_red, CONFIG_ETRAX_LED2R);
84         ret += crisv32_io_get_name(&crisv32_led3_green, CONFIG_ETRAX_LED3G);
85         ret += crisv32_io_get_name(&crisv32_led3_red, CONFIG_ETRAX_LED3R);
86         crisv32_io_set_dir(&crisv32_led1_green, crisv32_io_dir_out);
87         crisv32_io_set_dir(&crisv32_led1_red, crisv32_io_dir_out);
88         crisv32_io_set_dir(&crisv32_led2_green, crisv32_io_dir_out);
89         crisv32_io_set_dir(&crisv32_led2_red, crisv32_io_dir_out);
90         crisv32_io_set_dir(&crisv32_led3_green, crisv32_io_dir_out);
91         crisv32_io_set_dir(&crisv32_led3_red, crisv32_io_dir_out);
92
93         if (!strcmp(CONFIG_ETRAX_LED1G, CONFIG_ETRAX_LED1R))
94                 crisv32_led1_red = dummy_led;
95         if (!strcmp(CONFIG_ETRAX_LED2G, CONFIG_ETRAX_LED2R))
96                 crisv32_led2_red = dummy_led;
97
98         return ret;
99 }
100
101 __initcall(crisv32_io_init);
102
103 int crisv32_io_get(struct crisv32_iopin* iopin,
104                    unsigned int port, unsigned int pin)
105 {
106         if (port > NBR_OF_PORTS)
107                 return -EINVAL;
108         if (port > crisv32_ioports[port].pin_count)
109                 return -EINVAL;
110
111         iopin->bit = 1 << pin;
112         iopin->port = &crisv32_ioports[port];
113
114         if (crisv32_pinmux_alloc(port, pin, pin, pinmux_gpio))
115                 return -EIO;
116
117         return 0;
118 }
119
120 int crisv32_io_get_name(struct crisv32_iopin* iopin,
121                          char* name)
122 {
123         int port;
124         int pin;
125
126         if (toupper(*name) == 'P')
127                 name++;
128
129         if (toupper(*name) < 'A' || toupper(*name) > 'E')
130                 return -EINVAL;
131
132         port = toupper(*name) - 'A';
133         name++;
134         pin = simple_strtoul(name, NULL, 10);
135
136         if (pin < 0 || pin > crisv32_ioports[port].pin_count)
137                 return -EINVAL;
138
139         iopin->bit = 1 << pin;
140         iopin->port = &crisv32_ioports[port];
141
142         if (crisv32_pinmux_alloc(port, pin, pin, pinmux_gpio))
143                 return -EIO;
144
145         return 0;
146 }
147
148 #ifdef CONFIG_PCI
149 /* PCI I/O access stuff */
150 struct cris_io_operations* cris_iops = NULL;
151 EXPORT_SYMBOL(cris_iops);
152 #endif
153