2 * Sonics Silicon Backplane
5 * Copyright 2011, Broadcom Corporation
8 * Licensed under the GNU/GPL. See COPYING for details.
11 #include <linux/gpio.h>
12 #include <linux/export.h>
13 #include <linux/ssb/ssb.h>
15 #include "ssb_private.h"
17 static struct ssb_bus *ssb_gpio_get_bus(struct gpio_chip *chip)
19 return container_of(chip, struct ssb_bus, gpio);
22 static int ssb_gpio_chipco_get_value(struct gpio_chip *chip, unsigned gpio)
24 struct ssb_bus *bus = ssb_gpio_get_bus(chip);
26 return !!ssb_chipco_gpio_in(&bus->chipco, 1 << gpio);
29 static void ssb_gpio_chipco_set_value(struct gpio_chip *chip, unsigned gpio,
32 struct ssb_bus *bus = ssb_gpio_get_bus(chip);
34 ssb_chipco_gpio_out(&bus->chipco, 1 << gpio, value ? 1 << gpio : 0);
37 static int ssb_gpio_chipco_direction_input(struct gpio_chip *chip,
40 struct ssb_bus *bus = ssb_gpio_get_bus(chip);
42 ssb_chipco_gpio_outen(&bus->chipco, 1 << gpio, 0);
46 static int ssb_gpio_chipco_direction_output(struct gpio_chip *chip,
47 unsigned gpio, int value)
49 struct ssb_bus *bus = ssb_gpio_get_bus(chip);
51 ssb_chipco_gpio_outen(&bus->chipco, 1 << gpio, 1 << gpio);
52 ssb_chipco_gpio_out(&bus->chipco, 1 << gpio, value ? 1 << gpio : 0);
56 static int ssb_gpio_chipco_request(struct gpio_chip *chip, unsigned gpio)
58 struct ssb_bus *bus = ssb_gpio_get_bus(chip);
60 ssb_chipco_gpio_control(&bus->chipco, 1 << gpio, 0);
62 ssb_chipco_gpio_pulldown(&bus->chipco, 1 << gpio, 0);
64 ssb_chipco_gpio_pullup(&bus->chipco, 1 << gpio, 1 << gpio);
69 static void ssb_gpio_chipco_free(struct gpio_chip *chip, unsigned gpio)
71 struct ssb_bus *bus = ssb_gpio_get_bus(chip);
74 ssb_chipco_gpio_pullup(&bus->chipco, 1 << gpio, 0);
77 static int ssb_gpio_chipco_to_irq(struct gpio_chip *chip, unsigned gpio)
79 struct ssb_bus *bus = ssb_gpio_get_bus(chip);
81 if (bus->bustype == SSB_BUSTYPE_SSB)
82 return ssb_mips_irq(bus->chipco.dev) + 2;
87 static int ssb_gpio_chipco_init(struct ssb_bus *bus)
89 struct gpio_chip *chip = &bus->gpio;
91 chip->label = "ssb_chipco_gpio";
92 chip->owner = THIS_MODULE;
93 chip->request = ssb_gpio_chipco_request;
94 chip->free = ssb_gpio_chipco_free;
95 chip->get = ssb_gpio_chipco_get_value;
96 chip->set = ssb_gpio_chipco_set_value;
97 chip->direction_input = ssb_gpio_chipco_direction_input;
98 chip->direction_output = ssb_gpio_chipco_direction_output;
99 chip->to_irq = ssb_gpio_chipco_to_irq;
101 /* There is just one SoC in one device and its GPIO addresses should be
102 * deterministic to address them more easily. The other buses could get
103 * a random base number. */
104 if (bus->bustype == SSB_BUSTYPE_SSB)
109 return gpiochip_add(chip);
112 #ifdef CONFIG_SSB_DRIVER_EXTIF
114 static int ssb_gpio_extif_get_value(struct gpio_chip *chip, unsigned gpio)
116 struct ssb_bus *bus = ssb_gpio_get_bus(chip);
118 return !!ssb_extif_gpio_in(&bus->extif, 1 << gpio);
121 static void ssb_gpio_extif_set_value(struct gpio_chip *chip, unsigned gpio,
124 struct ssb_bus *bus = ssb_gpio_get_bus(chip);
126 ssb_extif_gpio_out(&bus->extif, 1 << gpio, value ? 1 << gpio : 0);
129 static int ssb_gpio_extif_direction_input(struct gpio_chip *chip,
132 struct ssb_bus *bus = ssb_gpio_get_bus(chip);
134 ssb_extif_gpio_outen(&bus->extif, 1 << gpio, 0);
138 static int ssb_gpio_extif_direction_output(struct gpio_chip *chip,
139 unsigned gpio, int value)
141 struct ssb_bus *bus = ssb_gpio_get_bus(chip);
143 ssb_extif_gpio_outen(&bus->extif, 1 << gpio, 1 << gpio);
144 ssb_extif_gpio_out(&bus->extif, 1 << gpio, value ? 1 << gpio : 0);
148 static int ssb_gpio_extif_to_irq(struct gpio_chip *chip, unsigned gpio)
150 struct ssb_bus *bus = ssb_gpio_get_bus(chip);
152 if (bus->bustype == SSB_BUSTYPE_SSB)
153 return ssb_mips_irq(bus->extif.dev) + 2;
158 static int ssb_gpio_extif_init(struct ssb_bus *bus)
160 struct gpio_chip *chip = &bus->gpio;
162 chip->label = "ssb_extif_gpio";
163 chip->owner = THIS_MODULE;
164 chip->get = ssb_gpio_extif_get_value;
165 chip->set = ssb_gpio_extif_set_value;
166 chip->direction_input = ssb_gpio_extif_direction_input;
167 chip->direction_output = ssb_gpio_extif_direction_output;
168 chip->to_irq = ssb_gpio_extif_to_irq;
170 /* There is just one SoC in one device and its GPIO addresses should be
171 * deterministic to address them more easily. The other buses could get
172 * a random base number. */
173 if (bus->bustype == SSB_BUSTYPE_SSB)
178 return gpiochip_add(chip);
182 static int ssb_gpio_extif_init(struct ssb_bus *bus)
188 int ssb_gpio_init(struct ssb_bus *bus)
190 if (ssb_chipco_available(&bus->chipco))
191 return ssb_gpio_chipco_init(bus);
192 else if (ssb_extif_available(&bus->extif))
193 return ssb_gpio_extif_init(bus);
200 int ssb_gpio_unregister(struct ssb_bus *bus)
202 if (ssb_chipco_available(&bus->chipco) ||
203 ssb_extif_available(&bus->extif)) {
204 return gpiochip_remove(&bus->gpio);