Linux Audio

Check our new training course

Loading...
v6.8
  1// SPDX-License-Identifier: GPL-2.0-only
  2/*
  3 *  GPIO interface for IT87xx Super I/O chips
  4 *
  5 *  Author: Diego Elio Pettenò <flameeyes@flameeyes.eu>
  6 *  Copyright (c) 2017 Google, Inc.
  7 *
  8 *  Based on it87_wdt.c     by Oliver Schuster
  9 *           gpio-it8761e.c by Denis Turischev
 10 *           gpio-stmpe.c   by Rabin Vincent
 
 
 
 
 
 
 
 
 
 
 
 
 
 11 */
 12
 13#define pr_fmt(fmt) KBUILD_MODNAME ": " fmt
 14
 15#include <linux/init.h>
 16#include <linux/kernel.h>
 17#include <linux/module.h>
 18#include <linux/io.h>
 19#include <linux/errno.h>
 20#include <linux/ioport.h>
 21#include <linux/slab.h>
 22#include <linux/gpio/driver.h>
 23
 24/* Chip Id numbers */
 25#define NO_DEV_ID	0xffff
 26#define IT8613_ID	0x8613
 27#define IT8620_ID	0x8620
 28#define IT8628_ID	0x8628
 29#define IT8718_ID       0x8718
 30#define IT8728_ID	0x8728
 31#define IT8732_ID	0x8732
 32#define IT8761_ID	0x8761
 33#define IT8772_ID	0x8772
 34#define IT8786_ID	0x8786
 35
 36/* IO Ports */
 37#define REG		0x2e
 38#define VAL		0x2f
 39
 40/* Logical device Numbers LDN */
 41#define GPIO		0x07
 42
 43/* Configuration Registers and Functions */
 44#define LDNREG		0x07
 45#define CHIPID		0x20
 46#define CHIPREV		0x22
 47
 48/**
 49 * struct it87_gpio - it87-specific GPIO chip
 50 * @chip: the underlying gpio_chip structure
 51 * @lock: a lock to avoid races between operations
 52 * @io_base: base address for gpio ports
 53 * @io_size: size of the port rage starting from io_base.
 54 * @output_base: Super I/O register address for Output Enable register
 55 * @simple_base: Super I/O 'Simple I/O' Enable register
 56 * @simple_size: Super IO 'Simple I/O' Enable register size; this is
 57 *	required because IT87xx chips might only provide Simple I/O
 58 *	switches on a subset of lines, whereas the others keep the
 59 *	same status all time.
 60 */
 61struct it87_gpio {
 62	struct gpio_chip chip;
 63	spinlock_t lock;
 64	u16 io_base;
 65	u16 io_size;
 66	u8 output_base;
 67	u8 simple_base;
 68	u8 simple_size;
 69};
 70
 71static struct it87_gpio it87_gpio_chip = {
 72	.lock = __SPIN_LOCK_UNLOCKED(it87_gpio_chip.lock),
 73};
 74
 75/* Superio chip access functions; copied from wdt_it87 */
 76
 77static inline int superio_enter(void)
 78{
 79	/*
 80	 * Try to reserve REG and REG + 1 for exclusive access.
 81	 */
 82	if (!request_muxed_region(REG, 2, KBUILD_MODNAME))
 83		return -EBUSY;
 84
 85	outb(0x87, REG);
 86	outb(0x01, REG);
 87	outb(0x55, REG);
 88	outb(0x55, REG);
 89	return 0;
 90}
 91
 92static inline void superio_exit(void)
 93{
 94	outb(0x02, REG);
 95	outb(0x02, VAL);
 96	release_region(REG, 2);
 97}
 98
 99static inline void superio_select(int ldn)
100{
101	outb(LDNREG, REG);
102	outb(ldn, VAL);
103}
104
105static inline int superio_inb(int reg)
106{
107	outb(reg, REG);
108	return inb(VAL);
109}
110
111static inline void superio_outb(int val, int reg)
112{
113	outb(reg, REG);
114	outb(val, VAL);
115}
116
117static inline int superio_inw(int reg)
118{
119	int val;
120
121	outb(reg++, REG);
122	val = inb(VAL) << 8;
123	outb(reg, REG);
124	val |= inb(VAL);
125	return val;
126}
127
 
 
 
 
 
 
 
 
128static inline void superio_set_mask(int mask, int reg)
129{
130	u8 curr_val = superio_inb(reg);
131	u8 new_val = curr_val | mask;
132
133	if (curr_val != new_val)
134		superio_outb(new_val, reg);
135}
136
137static inline void superio_clear_mask(int mask, int reg)
138{
139	u8 curr_val = superio_inb(reg);
140	u8 new_val = curr_val & ~mask;
141
142	if (curr_val != new_val)
143		superio_outb(new_val, reg);
144}
145
146static int it87_gpio_request(struct gpio_chip *chip, unsigned gpio_num)
147{
148	u8 mask, group;
149	int rc = 0;
150	struct it87_gpio *it87_gpio = gpiochip_get_data(chip);
151
152	mask = 1 << (gpio_num % 8);
153	group = (gpio_num / 8);
154
155	spin_lock(&it87_gpio->lock);
156
157	rc = superio_enter();
158	if (rc)
159		goto exit;
160
161	/* not all the IT87xx chips support Simple I/O and not all of
162	 * them allow all the lines to be set/unset to Simple I/O.
163	 */
164	if (group < it87_gpio->simple_size)
165		superio_set_mask(mask, group + it87_gpio->simple_base);
166
167	/* clear output enable, setting the pin to input, as all the
168	 * newly-exported GPIO interfaces are set to input.
169	 */
170	superio_clear_mask(mask, group + it87_gpio->output_base);
171
172	superio_exit();
173
174exit:
175	spin_unlock(&it87_gpio->lock);
176	return rc;
177}
178
179static int it87_gpio_get(struct gpio_chip *chip, unsigned gpio_num)
180{
181	u16 reg;
182	u8 mask;
183	struct it87_gpio *it87_gpio = gpiochip_get_data(chip);
184
185	mask = 1 << (gpio_num % 8);
186	reg = (gpio_num / 8) + it87_gpio->io_base;
187
188	return !!(inb(reg) & mask);
189}
190
191static int it87_gpio_direction_in(struct gpio_chip *chip, unsigned gpio_num)
192{
193	u8 mask, group;
194	int rc = 0;
195	struct it87_gpio *it87_gpio = gpiochip_get_data(chip);
196
197	mask = 1 << (gpio_num % 8);
198	group = (gpio_num / 8);
199
200	spin_lock(&it87_gpio->lock);
201
202	rc = superio_enter();
203	if (rc)
204		goto exit;
205
206	/* clear the output enable bit */
207	superio_clear_mask(mask, group + it87_gpio->output_base);
208
209	superio_exit();
210
211exit:
212	spin_unlock(&it87_gpio->lock);
213	return rc;
214}
215
216static void it87_gpio_set(struct gpio_chip *chip,
217			  unsigned gpio_num, int val)
218{
219	u8 mask, curr_vals;
220	u16 reg;
221	struct it87_gpio *it87_gpio = gpiochip_get_data(chip);
222
223	mask = 1 << (gpio_num % 8);
224	reg = (gpio_num / 8) + it87_gpio->io_base;
225
226	curr_vals = inb(reg);
227	if (val)
228		outb(curr_vals | mask, reg);
229	else
230		outb(curr_vals & ~mask, reg);
231}
232
233static int it87_gpio_direction_out(struct gpio_chip *chip,
234				   unsigned gpio_num, int val)
235{
236	u8 mask, group;
237	int rc = 0;
238	struct it87_gpio *it87_gpio = gpiochip_get_data(chip);
239
240	mask = 1 << (gpio_num % 8);
241	group = (gpio_num / 8);
242
243	spin_lock(&it87_gpio->lock);
244
245	rc = superio_enter();
246	if (rc)
247		goto exit;
248
249	/* set the output enable bit */
250	superio_set_mask(mask, group + it87_gpio->output_base);
251
252	it87_gpio_set(chip, gpio_num, val);
253
254	superio_exit();
255
256exit:
257	spin_unlock(&it87_gpio->lock);
258	return rc;
259}
260
261static const struct gpio_chip it87_template_chip = {
262	.label			= KBUILD_MODNAME,
263	.owner			= THIS_MODULE,
264	.request		= it87_gpio_request,
265	.get			= it87_gpio_get,
266	.direction_input	= it87_gpio_direction_in,
267	.set			= it87_gpio_set,
268	.direction_output	= it87_gpio_direction_out,
269	.base			= -1
270};
271
272static int __init it87_gpio_init(void)
273{
274	int rc = 0, i;
275	u16 chip_type;
276	u8 chip_rev, gpio_ba_reg;
277	char *labels, **labels_table;
278
279	struct it87_gpio *it87_gpio = &it87_gpio_chip;
280
281	rc = superio_enter();
282	if (rc)
283		return rc;
284
285	chip_type = superio_inw(CHIPID);
286	chip_rev  = superio_inb(CHIPREV) & 0x0f;
287	superio_exit();
288
289	it87_gpio->chip = it87_template_chip;
290
291	switch (chip_type) {
292	case IT8613_ID:
293		gpio_ba_reg = 0x62;
294		it87_gpio->io_size = 8;  /* it8613 only needs 6, use 8 for alignment */
295		it87_gpio->output_base = 0xc8;
296		it87_gpio->simple_base = 0xc0;
297		it87_gpio->simple_size = 6;
298		it87_gpio->chip.ngpio = 64;  /* has 48, use 64 for convenient calc */
299		break;
300	case IT8620_ID:
301	case IT8628_ID:
302		gpio_ba_reg = 0x62;
303		it87_gpio->io_size = 11;
304		it87_gpio->output_base = 0xc8;
305		it87_gpio->simple_size = 0;
306		it87_gpio->chip.ngpio = 64;
307		break;
308	case IT8718_ID:
309	case IT8728_ID:
310	case IT8732_ID:
311	case IT8772_ID:
312	case IT8786_ID:
313		gpio_ba_reg = 0x62;
314		it87_gpio->io_size = 8;
315		it87_gpio->output_base = 0xc8;
316		it87_gpio->simple_base = 0xc0;
317		it87_gpio->simple_size = 5;
318		it87_gpio->chip.ngpio = 64;
319		break;
320	case IT8761_ID:
321		gpio_ba_reg = 0x60;
322		it87_gpio->io_size = 4;
323		it87_gpio->output_base = 0xf0;
324		it87_gpio->simple_size = 0;
325		it87_gpio->chip.ngpio = 16;
326		break;
327	case NO_DEV_ID:
328		pr_err("no device\n");
329		return -ENODEV;
330	default:
331		pr_err("Unknown Chip found, Chip %04x Revision %x\n",
332		       chip_type, chip_rev);
333		return -ENODEV;
334	}
335
336	rc = superio_enter();
337	if (rc)
338		return rc;
339
340	superio_select(GPIO);
341
342	/* fetch GPIO base address */
343	it87_gpio->io_base = superio_inw(gpio_ba_reg);
344
345	superio_exit();
346
347	pr_info("Found Chip IT%04x rev %x. %u GPIO lines starting at %04xh\n",
348		chip_type, chip_rev, it87_gpio->chip.ngpio,
349		it87_gpio->io_base);
350
351	if (!request_region(it87_gpio->io_base, it87_gpio->io_size,
352							KBUILD_MODNAME))
353		return -EBUSY;
354
355	/* Set up aliases for the GPIO connection.
356	 *
357	 * ITE documentation for recent chips such as the IT8728F
358	 * refers to the GPIO lines as GPxy, with a coordinates system
359	 * where x is the GPIO group (starting from 1) and y is the
360	 * bit within the group.
361	 *
362	 * By creating these aliases, we make it easier to understand
363	 * to which GPIO pin we're referring to.
364	 */
365	labels = kcalloc(it87_gpio->chip.ngpio, sizeof("it87_gpXY"),
366								GFP_KERNEL);
367	labels_table = kcalloc(it87_gpio->chip.ngpio, sizeof(const char *),
368								GFP_KERNEL);
369
370	if (!labels || !labels_table) {
371		rc = -ENOMEM;
372		goto labels_free;
373	}
374
375	for (i = 0; i < it87_gpio->chip.ngpio; i++) {
376		char *label = &labels[i * sizeof("it87_gpXY")];
377
378		sprintf(label, "it87_gp%u%u", 1+(i/8), i%8);
379		labels_table[i] = label;
380	}
381
382	it87_gpio->chip.names = (const char *const*)labels_table;
383
384	rc = gpiochip_add_data(&it87_gpio->chip, it87_gpio);
385	if (rc)
386		goto labels_free;
387
388	return 0;
389
390labels_free:
391	kfree(labels_table);
392	kfree(labels);
393	release_region(it87_gpio->io_base, it87_gpio->io_size);
394	return rc;
395}
396
397static void __exit it87_gpio_exit(void)
398{
399	struct it87_gpio *it87_gpio = &it87_gpio_chip;
400
401	gpiochip_remove(&it87_gpio->chip);
402	release_region(it87_gpio->io_base, it87_gpio->io_size);
403	kfree(it87_gpio->chip.names[0]);
404	kfree(it87_gpio->chip.names);
405}
406
407module_init(it87_gpio_init);
408module_exit(it87_gpio_exit);
409
410MODULE_AUTHOR("Diego Elio Pettenò <flameeyes@flameeyes.eu>");
411MODULE_DESCRIPTION("GPIO interface for IT87xx Super I/O chips");
412MODULE_LICENSE("GPL");
v4.6
 
  1/*
  2 *  GPIO interface for IT87xx Super I/O chips
  3 *
  4 *  Author: Diego Elio Pettenò <flameeyes@flameeyes.eu>
 
  5 *
  6 *  Based on it87_wdt.c     by Oliver Schuster
  7 *           gpio-it8761e.c by Denis Turischev
  8 *           gpio-stmpe.c   by Rabin Vincent
  9 *
 10 *  This program is free software; you can redistribute it and/or modify
 11 *  it under the terms of the GNU General Public License 2 as published
 12 *  by the Free Software Foundation.
 13 *
 14 *  This program is distributed in the hope that it will be useful,
 15 *  but WITHOUT ANY WARRANTY; without even the implied warranty of
 16 *  MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
 17 *  GNU General Public License for more details.
 18 *
 19 *  You should have received a copy of the GNU General Public License
 20 *  along with this program; see the file COPYING.  If not, write to
 21 *  the Free Software Foundation, 675 Mass Ave, Cambridge, MA 02139, USA.
 22 */
 23
 24#define pr_fmt(fmt) KBUILD_MODNAME ": " fmt
 25
 26#include <linux/init.h>
 27#include <linux/kernel.h>
 28#include <linux/module.h>
 29#include <linux/io.h>
 30#include <linux/errno.h>
 31#include <linux/ioport.h>
 32#include <linux/slab.h>
 33#include <linux/gpio.h>
 34
 35/* Chip Id numbers */
 36#define NO_DEV_ID	0xffff
 
 
 
 
 37#define IT8728_ID	0x8728
 38#define IT8732_ID	0x8732
 39#define IT8761_ID	0x8761
 
 
 40
 41/* IO Ports */
 42#define REG		0x2e
 43#define VAL		0x2f
 44
 45/* Logical device Numbers LDN */
 46#define GPIO		0x07
 47
 48/* Configuration Registers and Functions */
 49#define LDNREG		0x07
 50#define CHIPID		0x20
 51#define CHIPREV		0x22
 52
 53/**
 54 * struct it87_gpio - it87-specific GPIO chip
 55 * @chip the underlying gpio_chip structure
 56 * @lock a lock to avoid races between operations
 57 * @io_base base address for gpio ports
 58 * @io_size size of the port rage starting from io_base.
 59 * @output_base Super I/O register address for Output Enable register
 60 * @simple_base Super I/O 'Simple I/O' Enable register
 61 * @simple_size Super IO 'Simple I/O' Enable register size; this is
 62 *	required because IT87xx chips might only provide Simple I/O
 63 *	switches on a subset of lines, whereas the others keep the
 64 *	same status all time.
 65 */
 66struct it87_gpio {
 67	struct gpio_chip chip;
 68	spinlock_t lock;
 69	u16 io_base;
 70	u16 io_size;
 71	u8 output_base;
 72	u8 simple_base;
 73	u8 simple_size;
 74};
 75
 76static struct it87_gpio it87_gpio_chip = {
 77	.lock = __SPIN_LOCK_UNLOCKED(it87_gpio_chip.lock),
 78};
 79
 80/* Superio chip access functions; copied from wdt_it87 */
 81
 82static inline int superio_enter(void)
 83{
 84	/*
 85	 * Try to reserve REG and REG + 1 for exclusive access.
 86	 */
 87	if (!request_muxed_region(REG, 2, KBUILD_MODNAME))
 88		return -EBUSY;
 89
 90	outb(0x87, REG);
 91	outb(0x01, REG);
 92	outb(0x55, REG);
 93	outb(0x55, REG);
 94	return 0;
 95}
 96
 97static inline void superio_exit(void)
 98{
 99	outb(0x02, REG);
100	outb(0x02, VAL);
101	release_region(REG, 2);
102}
103
104static inline void superio_select(int ldn)
105{
106	outb(LDNREG, REG);
107	outb(ldn, VAL);
108}
109
110static inline int superio_inb(int reg)
111{
112	outb(reg, REG);
113	return inb(VAL);
114}
115
116static inline void superio_outb(int val, int reg)
117{
118	outb(reg, REG);
119	outb(val, VAL);
120}
121
122static inline int superio_inw(int reg)
123{
124	int val;
125
126	outb(reg++, REG);
127	val = inb(VAL) << 8;
128	outb(reg, REG);
129	val |= inb(VAL);
130	return val;
131}
132
133static inline void superio_outw(int val, int reg)
134{
135	outb(reg++, REG);
136	outb(val >> 8, VAL);
137	outb(reg, REG);
138	outb(val, VAL);
139}
140
141static inline void superio_set_mask(int mask, int reg)
142{
143	u8 curr_val = superio_inb(reg);
144	u8 new_val = curr_val | mask;
145
146	if (curr_val != new_val)
147		superio_outb(new_val, reg);
148}
149
150static inline void superio_clear_mask(int mask, int reg)
151{
152	u8 curr_val = superio_inb(reg);
153	u8 new_val = curr_val & ~mask;
154
155	if (curr_val != new_val)
156		superio_outb(new_val, reg);
157}
158
159static int it87_gpio_request(struct gpio_chip *chip, unsigned gpio_num)
160{
161	u8 mask, group;
162	int rc = 0;
163	struct it87_gpio *it87_gpio = gpiochip_get_data(chip);
164
165	mask = 1 << (gpio_num % 8);
166	group = (gpio_num / 8);
167
168	spin_lock(&it87_gpio->lock);
169
170	rc = superio_enter();
171	if (rc)
172		goto exit;
173
174	/* not all the IT87xx chips support Simple I/O and not all of
175	 * them allow all the lines to be set/unset to Simple I/O.
176	 */
177	if (group < it87_gpio->simple_size)
178		superio_set_mask(mask, group + it87_gpio->simple_base);
179
180	/* clear output enable, setting the pin to input, as all the
181	 * newly-exported GPIO interfaces are set to input.
182	 */
183	superio_clear_mask(mask, group + it87_gpio->output_base);
184
185	superio_exit();
186
187exit:
188	spin_unlock(&it87_gpio->lock);
189	return rc;
190}
191
192static int it87_gpio_get(struct gpio_chip *chip, unsigned gpio_num)
193{
194	u16 reg;
195	u8 mask;
196	struct it87_gpio *it87_gpio = gpiochip_get_data(chip);
197
198	mask = 1 << (gpio_num % 8);
199	reg = (gpio_num / 8) + it87_gpio->io_base;
200
201	return !!(inb(reg) & mask);
202}
203
204static int it87_gpio_direction_in(struct gpio_chip *chip, unsigned gpio_num)
205{
206	u8 mask, group;
207	int rc = 0;
208	struct it87_gpio *it87_gpio = gpiochip_get_data(chip);
209
210	mask = 1 << (gpio_num % 8);
211	group = (gpio_num / 8);
212
213	spin_lock(&it87_gpio->lock);
214
215	rc = superio_enter();
216	if (rc)
217		goto exit;
218
219	/* clear the output enable bit */
220	superio_clear_mask(mask, group + it87_gpio->output_base);
221
222	superio_exit();
223
224exit:
225	spin_unlock(&it87_gpio->lock);
226	return rc;
227}
228
229static void it87_gpio_set(struct gpio_chip *chip,
230			  unsigned gpio_num, int val)
231{
232	u8 mask, curr_vals;
233	u16 reg;
234	struct it87_gpio *it87_gpio = gpiochip_get_data(chip);
235
236	mask = 1 << (gpio_num % 8);
237	reg = (gpio_num / 8) + it87_gpio->io_base;
238
239	curr_vals = inb(reg);
240	if (val)
241		outb(curr_vals | mask, reg);
242	else
243		outb(curr_vals & ~mask, reg);
244}
245
246static int it87_gpio_direction_out(struct gpio_chip *chip,
247				   unsigned gpio_num, int val)
248{
249	u8 mask, group;
250	int rc = 0;
251	struct it87_gpio *it87_gpio = gpiochip_get_data(chip);
252
253	mask = 1 << (gpio_num % 8);
254	group = (gpio_num / 8);
255
256	spin_lock(&it87_gpio->lock);
257
258	rc = superio_enter();
259	if (rc)
260		goto exit;
261
262	/* set the output enable bit */
263	superio_set_mask(mask, group + it87_gpio->output_base);
264
265	it87_gpio_set(chip, gpio_num, val);
266
267	superio_exit();
268
269exit:
270	spin_unlock(&it87_gpio->lock);
271	return rc;
272}
273
274static struct gpio_chip it87_template_chip = {
275	.label			= KBUILD_MODNAME,
276	.owner			= THIS_MODULE,
277	.request		= it87_gpio_request,
278	.get			= it87_gpio_get,
279	.direction_input	= it87_gpio_direction_in,
280	.set			= it87_gpio_set,
281	.direction_output	= it87_gpio_direction_out,
282	.base			= -1
283};
284
285static int __init it87_gpio_init(void)
286{
287	int rc = 0, i;
288	u16 chip_type;
289	u8 chip_rev, gpio_ba_reg;
290	char *labels, **labels_table;
291
292	struct it87_gpio *it87_gpio = &it87_gpio_chip;
293
294	rc = superio_enter();
295	if (rc)
296		return rc;
297
298	chip_type = superio_inw(CHIPID);
299	chip_rev  = superio_inb(CHIPREV) & 0x0f;
300	superio_exit();
301
302	it87_gpio->chip = it87_template_chip;
303
304	switch (chip_type) {
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
305	case IT8728_ID:
306	case IT8732_ID:
 
 
307		gpio_ba_reg = 0x62;
308		it87_gpio->io_size = 8;
309		it87_gpio->output_base = 0xc8;
310		it87_gpio->simple_base = 0xc0;
311		it87_gpio->simple_size = 5;
312		it87_gpio->chip.ngpio = 64;
313		break;
314	case IT8761_ID:
315		gpio_ba_reg = 0x60;
316		it87_gpio->io_size = 4;
317		it87_gpio->output_base = 0xf0;
318		it87_gpio->simple_size = 0;
319		it87_gpio->chip.ngpio = 16;
320		break;
321	case NO_DEV_ID:
322		pr_err("no device\n");
323		return -ENODEV;
324	default:
325		pr_err("Unknown Chip found, Chip %04x Revision %x\n",
326		       chip_type, chip_rev);
327		return -ENODEV;
328	}
329
330	rc = superio_enter();
331	if (rc)
332		return rc;
333
334	superio_select(GPIO);
335
336	/* fetch GPIO base address */
337	it87_gpio->io_base = superio_inw(gpio_ba_reg);
338
339	superio_exit();
340
341	pr_info("Found Chip IT%04x rev %x. %u GPIO lines starting at %04xh\n",
342		chip_type, chip_rev, it87_gpio->chip.ngpio,
343		it87_gpio->io_base);
344
345	if (!request_region(it87_gpio->io_base, it87_gpio->io_size,
346							KBUILD_MODNAME))
347		return -EBUSY;
348
349	/* Set up aliases for the GPIO connection.
350	 *
351	 * ITE documentation for recent chips such as the IT8728F
352	 * refers to the GPIO lines as GPxy, with a coordinates system
353	 * where x is the GPIO group (starting from 1) and y is the
354	 * bit within the group.
355	 *
356	 * By creating these aliases, we make it easier to understand
357	 * to which GPIO pin we're referring to.
358	 */
359	labels = kcalloc(it87_gpio->chip.ngpio, sizeof("it87_gpXY"),
360								GFP_KERNEL);
361	labels_table = kcalloc(it87_gpio->chip.ngpio, sizeof(const char *),
362								GFP_KERNEL);
363
364	if (!labels || !labels_table) {
365		rc = -ENOMEM;
366		goto labels_free;
367	}
368
369	for (i = 0; i < it87_gpio->chip.ngpio; i++) {
370		char *label = &labels[i * sizeof("it87_gpXY")];
371
372		sprintf(label, "it87_gp%u%u", 1+(i/8), i%8);
373		labels_table[i] = label;
374	}
375
376	it87_gpio->chip.names = (const char *const*)labels_table;
377
378	rc = gpiochip_add_data(&it87_gpio->chip, it87_gpio);
379	if (rc)
380		goto labels_free;
381
382	return 0;
383
384labels_free:
385	kfree(labels_table);
386	kfree(labels);
387	release_region(it87_gpio->io_base, it87_gpio->io_size);
388	return rc;
389}
390
391static void __exit it87_gpio_exit(void)
392{
393	struct it87_gpio *it87_gpio = &it87_gpio_chip;
394
395	gpiochip_remove(&it87_gpio->chip);
396	release_region(it87_gpio->io_base, it87_gpio->io_size);
397	kfree(it87_gpio->chip.names[0]);
398	kfree(it87_gpio->chip.names);
399}
400
401module_init(it87_gpio_init);
402module_exit(it87_gpio_exit);
403
404MODULE_AUTHOR("Diego Elio Pettenò <flameeyes@flameeyes.eu>");
405MODULE_DESCRIPTION("GPIO interface for IT87xx Super I/O chips");
406MODULE_LICENSE("GPL");