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 <mach/pinmux.h>
 16#include <hwregs/gio_defs.h>
 17
 18struct 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 ARRAY_SIZE(crisv32_ioports)
 40
 41struct crisv32_iopin crisv32_led_net0_green;
 42struct crisv32_iopin crisv32_led_net0_red;
 43struct crisv32_iopin crisv32_led2_green;
 44struct crisv32_iopin crisv32_led2_red;
 45struct crisv32_iopin crisv32_led3_green;
 46struct crisv32_iopin crisv32_led3_red;
 47
 48/* Dummy port used when green LED and red LED is on the same bit */
 49static unsigned long io_dummy;
 50static struct crisv32_ioport dummy_port = {
 51	&io_dummy,
 52	&io_dummy,
 53	&io_dummy,
 54	32
 55};
 56static struct crisv32_iopin dummy_led = {
 57	&dummy_port,
 58	0
 59};
 60
 61static 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
100int 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
117int crisv32_io_get_name(struct crisv32_iopin *iopin, const char *name)
118{
119	int port;
120	int pin;
121
122	if (toupper(*name) == 'P')
123		name++;
124
125	if (toupper(*name) < 'A' || toupper(*name) > 'E')
126		return -EINVAL;
127
128	port = toupper(*name) - 'A';
129	name++;
130	pin = simple_strtoul(name, NULL, 10);
131
132	if (pin < 0 || pin > crisv32_ioports[port].pin_count)
133		return -EINVAL;
134
135	iopin->bit = 1 << pin;
136	iopin->port = &crisv32_ioports[port];
137
138	if (crisv32_pinmux_alloc(port, pin, pin, pinmux_gpio))
139		return -EIO;
140
141	return 0;
142}
143
144#ifdef CONFIG_PCI
145/* PCI I/O access stuff */
146struct cris_io_operations *cris_iops = NULL;
147EXPORT_SYMBOL(cris_iops);
148#endif
149