x86/mm/pat: Don't report PAT on CPUs that don't support it
[linux/fpc-iii.git] / drivers / gpio / gpio-104-idi-48.c
blob568375a7ebc265a861cd3f5dcd9930d6d604427b
1 /*
2 * GPIO driver for the ACCES 104-IDI-48 family
3 * Copyright (C) 2015 William Breathitt Gray
5 * This program is free software; you can redistribute it and/or modify
6 * it under the terms of the GNU General Public License, version 2, as
7 * published by the Free Software Foundation.
9 * This program is distributed in the hope that it will be useful, but
10 * WITHOUT ANY WARRANTY; without even the implied warranty of
11 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU
12 * General Public License for more details.
14 * This driver supports the following ACCES devices: 104-IDI-48A,
15 * 104-IDI-48AC, 104-IDI-48B, and 104-IDI-48BC.
17 #include <linux/bitops.h>
18 #include <linux/device.h>
19 #include <linux/errno.h>
20 #include <linux/gpio/driver.h>
21 #include <linux/io.h>
22 #include <linux/ioport.h>
23 #include <linux/interrupt.h>
24 #include <linux/irqdesc.h>
25 #include <linux/isa.h>
26 #include <linux/kernel.h>
27 #include <linux/module.h>
28 #include <linux/moduleparam.h>
29 #include <linux/spinlock.h>
31 #define IDI_48_EXTENT 8
32 #define MAX_NUM_IDI_48 max_num_isa_dev(IDI_48_EXTENT)
34 static unsigned int base[MAX_NUM_IDI_48];
35 static unsigned int num_idi_48;
36 module_param_array(base, uint, &num_idi_48, 0);
37 MODULE_PARM_DESC(base, "ACCES 104-IDI-48 base addresses");
39 static unsigned int irq[MAX_NUM_IDI_48];
40 module_param_array(irq, uint, NULL, 0);
41 MODULE_PARM_DESC(irq, "ACCES 104-IDI-48 interrupt line numbers");
43 /**
44 * struct idi_48_gpio - GPIO device private data structure
45 * @chip: instance of the gpio_chip
46 * @lock: synchronization lock to prevent I/O race conditions
47 * @ack_lock: synchronization lock to prevent IRQ handler race conditions
48 * @irq_mask: input bits affected by interrupts
49 * @base: base port address of the GPIO device
50 * @cos_enb: Change-Of-State IRQ enable boundaries mask
52 struct idi_48_gpio {
53 struct gpio_chip chip;
54 spinlock_t lock;
55 spinlock_t ack_lock;
56 unsigned char irq_mask[6];
57 unsigned base;
58 unsigned char cos_enb;
61 static int idi_48_gpio_get_direction(struct gpio_chip *chip, unsigned offset)
63 return 1;
66 static int idi_48_gpio_direction_input(struct gpio_chip *chip, unsigned offset)
68 return 0;
71 static int idi_48_gpio_get(struct gpio_chip *chip, unsigned offset)
73 struct idi_48_gpio *const idi48gpio = gpiochip_get_data(chip);
74 unsigned i;
75 const unsigned register_offset[6] = { 0, 1, 2, 4, 5, 6 };
76 unsigned base_offset;
77 unsigned mask;
79 for (i = 0; i < 48; i += 8)
80 if (offset < i + 8) {
81 base_offset = register_offset[i / 8];
82 mask = BIT(offset - i);
84 return !!(inb(idi48gpio->base + base_offset) & mask);
87 /* The following line should never execute since offset < 48 */
88 return 0;
91 static void idi_48_irq_ack(struct irq_data *data)
95 static void idi_48_irq_mask(struct irq_data *data)
97 struct gpio_chip *chip = irq_data_get_irq_chip_data(data);
98 struct idi_48_gpio *const idi48gpio = gpiochip_get_data(chip);
99 const unsigned offset = irqd_to_hwirq(data);
100 unsigned i;
101 unsigned mask;
102 unsigned boundary;
103 unsigned long flags;
105 for (i = 0; i < 48; i += 8)
106 if (offset < i + 8) {
107 mask = BIT(offset - i);
108 boundary = i / 8;
110 idi48gpio->irq_mask[boundary] &= ~mask;
112 if (!idi48gpio->irq_mask[boundary]) {
113 idi48gpio->cos_enb &= ~BIT(boundary);
115 spin_lock_irqsave(&idi48gpio->lock, flags);
117 outb(idi48gpio->cos_enb, idi48gpio->base + 7);
119 spin_unlock_irqrestore(&idi48gpio->lock, flags);
122 return;
126 static void idi_48_irq_unmask(struct irq_data *data)
128 struct gpio_chip *chip = irq_data_get_irq_chip_data(data);
129 struct idi_48_gpio *const idi48gpio = gpiochip_get_data(chip);
130 const unsigned offset = irqd_to_hwirq(data);
131 unsigned i;
132 unsigned mask;
133 unsigned boundary;
134 unsigned prev_irq_mask;
135 unsigned long flags;
137 for (i = 0; i < 48; i += 8)
138 if (offset < i + 8) {
139 mask = BIT(offset - i);
140 boundary = i / 8;
141 prev_irq_mask = idi48gpio->irq_mask[boundary];
143 idi48gpio->irq_mask[boundary] |= mask;
145 if (!prev_irq_mask) {
146 idi48gpio->cos_enb |= BIT(boundary);
148 spin_lock_irqsave(&idi48gpio->lock, flags);
150 outb(idi48gpio->cos_enb, idi48gpio->base + 7);
152 spin_unlock_irqrestore(&idi48gpio->lock, flags);
155 return;
159 static int idi_48_irq_set_type(struct irq_data *data, unsigned flow_type)
161 /* The only valid irq types are none and both-edges */
162 if (flow_type != IRQ_TYPE_NONE &&
163 (flow_type & IRQ_TYPE_EDGE_BOTH) != IRQ_TYPE_EDGE_BOTH)
164 return -EINVAL;
166 return 0;
169 static struct irq_chip idi_48_irqchip = {
170 .name = "104-idi-48",
171 .irq_ack = idi_48_irq_ack,
172 .irq_mask = idi_48_irq_mask,
173 .irq_unmask = idi_48_irq_unmask,
174 .irq_set_type = idi_48_irq_set_type
177 static irqreturn_t idi_48_irq_handler(int irq, void *dev_id)
179 struct idi_48_gpio *const idi48gpio = dev_id;
180 unsigned long cos_status;
181 unsigned long boundary;
182 unsigned long irq_mask;
183 unsigned long bit_num;
184 unsigned long gpio;
185 struct gpio_chip *const chip = &idi48gpio->chip;
187 spin_lock(&idi48gpio->ack_lock);
189 spin_lock(&idi48gpio->lock);
191 cos_status = inb(idi48gpio->base + 7);
193 spin_unlock(&idi48gpio->lock);
195 /* IRQ Status (bit 6) is active low (0 = IRQ generated by device) */
196 if (cos_status & BIT(6)) {
197 spin_unlock(&idi48gpio->ack_lock);
198 return IRQ_NONE;
201 /* Bit 0-5 indicate which Change-Of-State boundary triggered the IRQ */
202 cos_status &= 0x3F;
204 for_each_set_bit(boundary, &cos_status, 6) {
205 irq_mask = idi48gpio->irq_mask[boundary];
207 for_each_set_bit(bit_num, &irq_mask, 8) {
208 gpio = bit_num + boundary * 8;
210 generic_handle_irq(irq_find_mapping(chip->irqdomain,
211 gpio));
215 spin_unlock(&idi48gpio->ack_lock);
217 return IRQ_HANDLED;
220 #define IDI48_NGPIO 48
221 static const char *idi48_names[IDI48_NGPIO] = {
222 "Bit 0 A", "Bit 1 A", "Bit 2 A", "Bit 3 A", "Bit 4 A", "Bit 5 A",
223 "Bit 6 A", "Bit 7 A", "Bit 8 A", "Bit 9 A", "Bit 10 A", "Bit 11 A",
224 "Bit 12 A", "Bit 13 A", "Bit 14 A", "Bit 15 A", "Bit 16 A", "Bit 17 A",
225 "Bit 18 A", "Bit 19 A", "Bit 20 A", "Bit 21 A", "Bit 22 A", "Bit 23 A",
226 "Bit 0 B", "Bit 1 B", "Bit 2 B", "Bit 3 B", "Bit 4 B", "Bit 5 B",
227 "Bit 6 B", "Bit 7 B", "Bit 8 B", "Bit 9 B", "Bit 10 B", "Bit 11 B",
228 "Bit 12 B", "Bit 13 B", "Bit 14 B", "Bit 15 B", "Bit 16 B", "Bit 17 B",
229 "Bit 18 B", "Bit 19 B", "Bit 20 B", "Bit 21 B", "Bit 22 B", "Bit 23 B"
232 static int idi_48_probe(struct device *dev, unsigned int id)
234 struct idi_48_gpio *idi48gpio;
235 const char *const name = dev_name(dev);
236 int err;
238 idi48gpio = devm_kzalloc(dev, sizeof(*idi48gpio), GFP_KERNEL);
239 if (!idi48gpio)
240 return -ENOMEM;
242 if (!devm_request_region(dev, base[id], IDI_48_EXTENT, name)) {
243 dev_err(dev, "Unable to lock port addresses (0x%X-0x%X)\n",
244 base[id], base[id] + IDI_48_EXTENT);
245 return -EBUSY;
248 idi48gpio->chip.label = name;
249 idi48gpio->chip.parent = dev;
250 idi48gpio->chip.owner = THIS_MODULE;
251 idi48gpio->chip.base = -1;
252 idi48gpio->chip.ngpio = IDI48_NGPIO;
253 idi48gpio->chip.names = idi48_names;
254 idi48gpio->chip.get_direction = idi_48_gpio_get_direction;
255 idi48gpio->chip.direction_input = idi_48_gpio_direction_input;
256 idi48gpio->chip.get = idi_48_gpio_get;
257 idi48gpio->base = base[id];
259 spin_lock_init(&idi48gpio->lock);
260 spin_lock_init(&idi48gpio->ack_lock);
262 err = devm_gpiochip_add_data(dev, &idi48gpio->chip, idi48gpio);
263 if (err) {
264 dev_err(dev, "GPIO registering failed (%d)\n", err);
265 return err;
268 /* Disable IRQ by default */
269 outb(0, base[id] + 7);
270 inb(base[id] + 7);
272 err = gpiochip_irqchip_add(&idi48gpio->chip, &idi_48_irqchip, 0,
273 handle_edge_irq, IRQ_TYPE_NONE);
274 if (err) {
275 dev_err(dev, "Could not add irqchip (%d)\n", err);
276 return err;
279 err = devm_request_irq(dev, irq[id], idi_48_irq_handler, IRQF_SHARED,
280 name, idi48gpio);
281 if (err) {
282 dev_err(dev, "IRQ handler registering failed (%d)\n", err);
283 return err;
286 return 0;
289 static struct isa_driver idi_48_driver = {
290 .probe = idi_48_probe,
291 .driver = {
292 .name = "104-idi-48"
295 module_isa_driver(idi_48_driver, num_idi_48);
297 MODULE_AUTHOR("William Breathitt Gray <vilhelm.gray@gmail.com>");
298 MODULE_DESCRIPTION("ACCES 104-IDI-48 GPIO driver");
299 MODULE_LICENSE("GPL v2");