CRIS v32: Add new machine dependent files for Etrax-FS and Artpec-3.
[linux-2.6.git] / arch / cris / arch-v32 / mach-a3 / io.c
1 /*
2  * Helper functions for I/O pins.
3  *
4  * Copyright (c) 2005-2007 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/mach/pinmux.h>
16 #include <hwregs/gio_defs.h>
17
18 struct crisv32_ioport crisv32_ioports[] = {
19         {
20                 (unsigned long *)REG_ADDR(gio, regi_gio, rw_pa_oe),
21                 (unsigned long *)REG_ADDR(gio, regi_gio, rw_pa_dout),
22                 (unsigned long *)REG_ADDR(gio, regi_gio, r_pa_din),
23                 32
24         },
25         {
26                 (unsigned long *)REG_ADDR(gio, regi_gio, rw_pb_oe),
27                 (unsigned long *)REG_ADDR(gio, regi_gio, rw_pb_dout),
28                 (unsigned long *)REG_ADDR(gio, regi_gio, r_pb_din),
29                 32
30         },
31         {
32                 (unsigned long *)REG_ADDR(gio, regi_gio, rw_pc_oe),
33                 (unsigned long *)REG_ADDR(gio, regi_gio, rw_pc_dout),
34                 (unsigned long *)REG_ADDR(gio, regi_gio, r_pc_din),
35                 16
36         },
37 };
38
39 #define NBR_OF_PORTS sizeof(crisv32_ioports)/sizeof(struct crisv32_ioport)
40
41 struct crisv32_iopin crisv32_led_net0_green;
42 struct crisv32_iopin crisv32_led_net0_red;
43 struct crisv32_iopin crisv32_led2_green;
44 struct crisv32_iopin crisv32_led2_red;
45 struct crisv32_iopin crisv32_led3_green;
46 struct crisv32_iopin crisv32_led3_red;
47
48 /* Dummy port used when green LED and red LED is on the same bit */
49 static unsigned long io_dummy;
50 static struct crisv32_ioport dummy_port = {
51         &io_dummy,
52         &io_dummy,
53         &io_dummy,
54         32
55 };
56 static struct crisv32_iopin dummy_led = {
57         &dummy_port,
58         0
59 };
60
61 static int __init crisv32_io_init(void)
62 {
63         int ret = 0;
64
65         u32 i;
66
67         /* Locks *should* be dynamically initialized. */
68         for (i = 0; i < ARRAY_SIZE(crisv32_ioports); i++)
69                 spin_lock_init(&crisv32_ioports[i].lock);
70         spin_lock_init(&dummy_port.lock);
71
72         /* Initialize LEDs */
73 #if (defined(CONFIG_ETRAX_NBR_LED_GRP_ONE) || defined(CONFIG_ETRAX_NBR_LED_GRP_TWO))
74         ret += crisv32_io_get_name(&crisv32_led_net0_green,
75                 CONFIG_ETRAX_LED_G_NET0);
76         crisv32_io_set_dir(&crisv32_led_net0_green, crisv32_io_dir_out);
77         if (strcmp(CONFIG_ETRAX_LED_G_NET0, CONFIG_ETRAX_LED_R_NET0)) {
78                 ret += crisv32_io_get_name(&crisv32_led_net0_red,
79                         CONFIG_ETRAX_LED_R_NET0);
80                 crisv32_io_set_dir(&crisv32_led_net0_red, crisv32_io_dir_out);
81         } else
82                 crisv32_led_net0_red = dummy_led;
83 #endif
84
85         ret += crisv32_io_get_name(&crisv32_led2_green, CONFIG_ETRAX_V32_LED2G);
86         ret += crisv32_io_get_name(&crisv32_led2_red, CONFIG_ETRAX_V32_LED2R);
87         ret += crisv32_io_get_name(&crisv32_led3_green, CONFIG_ETRAX_V32_LED3G);
88         ret += crisv32_io_get_name(&crisv32_led3_red, CONFIG_ETRAX_V32_LED3R);
89
90         crisv32_io_set_dir(&crisv32_led2_green, crisv32_io_dir_out);
91         crisv32_io_set_dir(&crisv32_led2_red, crisv32_io_dir_out);
92         crisv32_io_set_dir(&crisv32_led3_green, crisv32_io_dir_out);
93         crisv32_io_set_dir(&crisv32_led3_red, crisv32_io_dir_out);
94
95         return ret;
96 }
97
98 __initcall(crisv32_io_init);
99
100 int crisv32_io_get(struct crisv32_iopin *iopin,
101         unsigned int port, unsigned int pin)
102 {
103         if (port > NBR_OF_PORTS)
104                 return -EINVAL;
105         if (port > crisv32_ioports[port].pin_count)
106                 return -EINVAL;
107
108         iopin->bit = 1 << pin;
109         iopin->port = &crisv32_ioports[port];
110
111         if (crisv32_pinmux_alloc(port, pin, pin, pinmux_gpio))
112                 return -EIO;
113
114         return 0;
115 }
116
117 int crisv32_io_get_name(struct crisv32_iopin *iopin,
118         const char *name)
119 {
120         int port;
121         int pin;
122
123         if (toupper(*name) == 'P')
124                 name++;
125
126         if (toupper(*name) < 'A' || toupper(*name) > 'E')
127                 return -EINVAL;
128
129         port = toupper(*name) - 'A';
130         name++;
131         pin = simple_strtoul(name, NULL, 10);
132
133         if (pin < 0 || pin > crisv32_ioports[port].pin_count)
134                 return -EINVAL;
135
136         iopin->bit = 1 << pin;
137         iopin->port = &crisv32_ioports[port];
138
139         if (crisv32_pinmux_alloc(port, pin, pin, pinmux_gpio))
140                 return -EIO;
141
142         return 0;
143 }
144
145 #ifdef CONFIG_PCI
146 /* PCI I/O access stuff */
147 struct cris_io_operations *cris_iops = NULL;
148 EXPORT_SYMBOL(cris_iops);
149 #endif
150