[linux.git] / drivers / gpio / gpio-it87.c

/*
 *  GPIO interface for IT87xx Super I/O chips
 *
 *  Author: Diego Elio Pettenò <[email protected]>
 *
 *  Based on it87_wdt.c     by Oliver Schuster
 *           gpio-it8761e.c by Denis Turischev
 *           gpio-stmpe.c   by Rabin Vincent
 *
 *  This program is free software; you can redistribute it and/or modify
 *  it under the terms of the GNU General Public License 2 as published
 *  by the Free Software Foundation.
 *
 *  This program is distributed in the hope that it will be useful,
 *  but WITHOUT ANY WARRANTY; without even the implied warranty of
 *  MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
 *  GNU General Public License for more details.
 *
 *  You should have received a copy of the GNU General Public License
 *  along with this program; see the file COPYING.  If not, write to
 *  the Free Software Foundation, 675 Mass Ave, Cambridge, MA 02139, USA.
 */

#define pr_fmt(fmt) KBUILD_MODNAME ": " fmt

#include <linux/init.h>
#include <linux/kernel.h>
#include <linux/module.h>
#include <linux/io.h>
#include <linux/errno.h>
#include <linux/ioport.h>
#include <linux/slab.h>
#include <linux/gpio.h>

/* Chip Id numbers */
#define NO_DEV_ID	0xffff
#define IT8620_ID	0x8620
#define IT8628_ID	0x8628
#define IT8728_ID	0x8728
#define IT8732_ID	0x8732
#define IT8761_ID	0x8761

/* IO Ports */
#define REG		0x2e
#define VAL		0x2f

/* Logical device Numbers LDN */
#define GPIO		0x07

/* Configuration Registers and Functions */
#define LDNREG		0x07
#define CHIPID		0x20
#define CHIPREV		0x22

/**
 * struct it87_gpio - it87-specific GPIO chip
 * @chip the underlying gpio_chip structure
 * @lock a lock to avoid races between operations
 * @io_base base address for gpio ports
 * @io_size size of the port rage starting from io_base.
 * @output_base Super I/O register address for Output Enable register
 * @simple_base Super I/O 'Simple I/O' Enable register
 * @simple_size Super IO 'Simple I/O' Enable register size; this is
 *	required because IT87xx chips might only provide Simple I/O
 *	switches on a subset of lines, whereas the others keep the
 *	same status all time.
 */
struct it87_gpio {
	struct gpio_chip chip;
	spinlock_t lock;
	u16 io_base;
	u16 io_size;
	u8 output_base;
	u8 simple_base;
	u8 simple_size;
};

static struct it87_gpio it87_gpio_chip = {
	.lock = __SPIN_LOCK_UNLOCKED(it87_gpio_chip.lock),
};

/* Superio chip access functions; copied from wdt_it87 */

static inline int superio_enter(void)
{
	/*
	 * Try to reserve REG and REG + 1 for exclusive access.
	 */
	if (!request_muxed_region(REG, 2, KBUILD_MODNAME))
		return -EBUSY;

	outb(0x87, REG);
	outb(0x01, REG);
	outb(0x55, REG);
	outb(0x55, REG);
	return 0;
}

static inline void superio_exit(void)
{
	outb(0x02, REG);
	outb(0x02, VAL);
	release_region(REG, 2);
}

static inline void superio_select(int ldn)
{
	outb(LDNREG, REG);
	outb(ldn, VAL);
}

static inline int superio_inb(int reg)
{
	outb(reg, REG);
	return inb(VAL);
}

static inline void superio_outb(int val, int reg)
{
	outb(reg, REG);
	outb(val, VAL);
}

static inline int superio_inw(int reg)
{
	int val;

	outb(reg++, REG);
	val = inb(VAL) << 8;
	outb(reg, REG);
	val |= inb(VAL);
	return val;
}

static inline void superio_outw(int val, int reg)
{
	outb(reg++, REG);
	outb(val >> 8, VAL);
	outb(reg, REG);
	outb(val, VAL);
}

static inline void superio_set_mask(int mask, int reg)
{
	u8 curr_val = superio_inb(reg);
	u8 new_val = curr_val | mask;

	if (curr_val != new_val)
		superio_outb(new_val, reg);
}

static inline void superio_clear_mask(int mask, int reg)
{
	u8 curr_val = superio_inb(reg);
	u8 new_val = curr_val & ~mask;

	if (curr_val != new_val)
		superio_outb(new_val, reg);
}

static int it87_gpio_request(struct gpio_chip *chip, unsigned gpio_num)
{
	u8 mask, group;
	int rc = 0;
	struct it87_gpio *it87_gpio = gpiochip_get_data(chip);

	mask = 1 << (gpio_num % 8);
	group = (gpio_num / 8);

	spin_lock(&it87_gpio->lock);

	rc = superio_enter();
	if (rc)
		goto exit;

	/* not all the IT87xx chips support Simple I/O and not all of
	 * them allow all the lines to be set/unset to Simple I/O.
	 */
	if (group < it87_gpio->simple_size)
		superio_set_mask(mask, group + it87_gpio->simple_base);

	/* clear output enable, setting the pin to input, as all the
	 * newly-exported GPIO interfaces are set to input.
	 */
	superio_clear_mask(mask, group + it87_gpio->output_base);

	superio_exit();

exit:
	spin_unlock(&it87_gpio->lock);
	return rc;
}

static int it87_gpio_get(struct gpio_chip *chip, unsigned gpio_num)
{
	u16 reg;
	u8 mask;
	struct it87_gpio *it87_gpio = gpiochip_get_data(chip);

	mask = 1 << (gpio_num % 8);
	reg = (gpio_num / 8) + it87_gpio->io_base;

	return !!(inb(reg) & mask);
}

static int it87_gpio_direction_in(struct gpio_chip *chip, unsigned gpio_num)
{
	u8 mask, group;
	int rc = 0;
	struct it87_gpio *it87_gpio = gpiochip_get_data(chip);

	mask = 1 << (gpio_num % 8);
	group = (gpio_num / 8);

	spin_lock(&it87_gpio->lock);

	rc = superio_enter();
	if (rc)
		goto exit;

	/* clear the output enable bit */
	superio_clear_mask(mask, group + it87_gpio->output_base);

	superio_exit();

exit:
	spin_unlock(&it87_gpio->lock);
	return rc;
}

static void it87_gpio_set(struct gpio_chip *chip,
			  unsigned gpio_num, int val)
{
	u8 mask, curr_vals;
	u16 reg;
	struct it87_gpio *it87_gpio = gpiochip_get_data(chip);

	mask = 1 << (gpio_num % 8);
	reg = (gpio_num / 8) + it87_gpio->io_base;

	curr_vals = inb(reg);
	if (val)
		outb(curr_vals | mask, reg);
	else
		outb(curr_vals & ~mask, reg);
}

static int it87_gpio_direction_out(struct gpio_chip *chip,
				   unsigned gpio_num, int val)
{
	u8 mask, group;
	int rc = 0;
	struct it87_gpio *it87_gpio = gpiochip_get_data(chip);

	mask = 1 << (gpio_num % 8);
	group = (gpio_num / 8);

	spin_lock(&it87_gpio->lock);

	rc = superio_enter();
	if (rc)
		goto exit;

	/* set the output enable bit */
	superio_set_mask(mask, group + it87_gpio->output_base);

	it87_gpio_set(chip, gpio_num, val);

	superio_exit();

exit:
	spin_unlock(&it87_gpio->lock);
	return rc;
}

static struct gpio_chip it87_template_chip = {
	.label			= KBUILD_MODNAME,
	.owner			= THIS_MODULE,
	.request		= it87_gpio_request,
	.get			= it87_gpio_get,
	.direction_input	= it87_gpio_direction_in,
	.set			= it87_gpio_set,
	.direction_output	= it87_gpio_direction_out,
	.base			= -1
};

static int __init it87_gpio_init(void)
{
	int rc = 0, i;
	u16 chip_type;
	u8 chip_rev, gpio_ba_reg;
	char *labels, **labels_table;

	struct it87_gpio *it87_gpio = &it87_gpio_chip;

	rc = superio_enter();
	if (rc)
		return rc;

	chip_type = superio_inw(CHIPID);
	chip_rev  = superio_inb(CHIPREV) & 0x0f;
	superio_exit();

	it87_gpio->chip = it87_template_chip;

	switch (chip_type) {
	case IT8620_ID:
	case IT8628_ID:
		gpio_ba_reg = 0x62;
		it87_gpio->io_size = 11;
		it87_gpio->output_base = 0xc8;
		it87_gpio->simple_size = 0;
		it87_gpio->chip.ngpio = 64;
		break;
	case IT8728_ID:
	case IT8732_ID:
		gpio_ba_reg = 0x62;
		it87_gpio->io_size = 8;
		it87_gpio->output_base = 0xc8;
		it87_gpio->simple_base = 0xc0;
		it87_gpio->simple_size = 5;
		it87_gpio->chip.ngpio = 64;
		break;
	case IT8761_ID:
		gpio_ba_reg = 0x60;
		it87_gpio->io_size = 4;
		it87_gpio->output_base = 0xf0;
		it87_gpio->simple_size = 0;
		it87_gpio->chip.ngpio = 16;
		break;
	case NO_DEV_ID:
		pr_err("no device\n");
		return -ENODEV;
	default:
		pr_err("Unknown Chip found, Chip %04x Revision %x\n",
		       chip_type, chip_rev);
		return -ENODEV;
	}

	rc = superio_enter();
	if (rc)
		return rc;

	superio_select(GPIO);

	/* fetch GPIO base address */
	it87_gpio->io_base = superio_inw(gpio_ba_reg);

	superio_exit();

	pr_info("Found Chip IT%04x rev %x. %u GPIO lines starting at %04xh\n",
		chip_type, chip_rev, it87_gpio->chip.ngpio,
		it87_gpio->io_base);

	if (!request_region(it87_gpio->io_base, it87_gpio->io_size,
							KBUILD_MODNAME))
		return -EBUSY;

	/* Set up aliases for the GPIO connection.
	 *
	 * ITE documentation for recent chips such as the IT8728F
	 * refers to the GPIO lines as GPxy, with a coordinates system
	 * where x is the GPIO group (starting from 1) and y is the
	 * bit within the group.
	 *
	 * By creating these aliases, we make it easier to understand
	 * to which GPIO pin we're referring to.
	 */
	labels = kcalloc(it87_gpio->chip.ngpio, sizeof("it87_gpXY"),
								GFP_KERNEL);
	labels_table = kcalloc(it87_gpio->chip.ngpio, sizeof(const char *),
								GFP_KERNEL);

	if (!labels || !labels_table) {
		rc = -ENOMEM;
		goto labels_free;
	}

	for (i = 0; i < it87_gpio->chip.ngpio; i++) {
		char *label = &labels[i * sizeof("it87_gpXY")];

		sprintf(label, "it87_gp%u%u", 1+(i/8), i%8);
		labels_table[i] = label;
	}

	it87_gpio->chip.names = (const char *const*)labels_table;

	rc = gpiochip_add_data(&it87_gpio->chip, it87_gpio);
	if (rc)
		goto labels_free;

	return 0;

labels_free:
	kfree(labels_table);
	kfree(labels);
	release_region(it87_gpio->io_base, it87_gpio->io_size);
	return rc;
}

static void __exit it87_gpio_exit(void)
{
	struct it87_gpio *it87_gpio = &it87_gpio_chip;

	gpiochip_remove(&it87_gpio->chip);
	release_region(it87_gpio->io_base, it87_gpio->io_size);
	kfree(it87_gpio->chip.names[0]);
	kfree(it87_gpio->chip.names);
}

module_init(it87_gpio_init);
module_exit(it87_gpio_exit);

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