733 lines
		
	
	
		
			19 KiB
		
	
	
	
		
			C
		
	
	
	
	
	
			
		
		
	
	
			733 lines
		
	
	
		
			19 KiB
		
	
	
	
		
			C
		
	
	
	
	
	
| // SPDX-License-Identifier: GPL-2.0+
 | |
| /*
 | |
|  * GPIO interface for Winbond Super I/O chips
 | |
|  * Currently, only W83627UHG (Nuvoton NCT6627UD) is supported.
 | |
|  *
 | |
|  * Author: Maciej S. Szmigiero <mail@maciej.szmigiero.name>
 | |
|  */
 | |
| 
 | |
| #define pr_fmt(fmt) KBUILD_MODNAME ": " fmt
 | |
| 
 | |
| #include <linux/gpio/driver.h>
 | |
| #include <linux/ioport.h>
 | |
| #include <linux/isa.h>
 | |
| #include <linux/module.h>
 | |
| 
 | |
| #define WB_GPIO_DRIVER_NAME		KBUILD_MODNAME
 | |
| 
 | |
| #define WB_SIO_BASE			0x2e
 | |
| #define WB_SIO_BASE_HIGH		0x4e
 | |
| 
 | |
| #define WB_SIO_EXT_ENTER_KEY		0x87
 | |
| #define WB_SIO_EXT_EXIT_KEY		0xaa
 | |
| 
 | |
| /* global chip registers */
 | |
| 
 | |
| #define WB_SIO_REG_LOGICAL		0x07
 | |
| 
 | |
| #define WB_SIO_REG_CHIP_MSB		0x20
 | |
| #define WB_SIO_REG_CHIP_LSB		0x21
 | |
| 
 | |
| #define WB_SIO_CHIP_ID_W83627UHG	0xa230
 | |
| #define WB_SIO_CHIP_ID_W83627UHG_MASK	GENMASK(15, 4)
 | |
| 
 | |
| #define WB_SIO_REG_DPD			0x22
 | |
| #define WB_SIO_REG_DPD_UARTA		4
 | |
| #define WB_SIO_REG_DPD_UARTB		5
 | |
| 
 | |
| #define WB_SIO_REG_IDPD		0x23
 | |
| #define WB_SIO_REG_IDPD_UARTC		4
 | |
| #define WB_SIO_REG_IDPD_UARTD		5
 | |
| #define WB_SIO_REG_IDPD_UARTE		6
 | |
| #define WB_SIO_REG_IDPD_UARTF		7
 | |
| 
 | |
| #define WB_SIO_REG_GLOBAL_OPT		0x24
 | |
| #define WB_SIO_REG_GO_ENFDC		1
 | |
| 
 | |
| #define WB_SIO_REG_OVTGPIO3456		0x29
 | |
| #define WB_SIO_REG_OG3456_G3PP		3
 | |
| #define WB_SIO_REG_OG3456_G4PP		4
 | |
| #define WB_SIO_REG_OG3456_G5PP		5
 | |
| #define WB_SIO_REG_OG3456_G6PP		7
 | |
| 
 | |
| #define WB_SIO_REG_I2C_PS		0x2a
 | |
| #define WB_SIO_REG_I2CPS_I2CFS		1
 | |
| 
 | |
| #define WB_SIO_REG_GPIO1_MF		0x2c
 | |
| #define WB_SIO_REG_G1MF_G1PP		6
 | |
| #define WB_SIO_REG_G1MF_G2PP		7
 | |
| #define WB_SIO_REG_G1MF_FS_MASK	GENMASK(1, 0)
 | |
| #define WB_SIO_REG_G1MF_FS_IR_OFF	0
 | |
| #define WB_SIO_REG_G1MF_FS_IR		1
 | |
| #define WB_SIO_REG_G1MF_FS_GPIO1	2
 | |
| #define WB_SIO_REG_G1MF_FS_UARTB	3
 | |
| 
 | |
| /* not an actual device number, just a value meaning 'no device' */
 | |
| #define WB_SIO_DEV_NONE		0xff
 | |
| 
 | |
| /* registers with offsets >= 0x30 are specific for a particular device */
 | |
| 
 | |
| /* UART B logical device */
 | |
| #define WB_SIO_DEV_UARTB		0x03
 | |
| #define WB_SIO_UARTB_REG_ENABLE	0x30
 | |
| #define WB_SIO_UARTB_ENABLE_ON		0
 | |
| 
 | |
| /* UART C logical device */
 | |
| #define WB_SIO_DEV_UARTC		0x06
 | |
| #define WB_SIO_UARTC_REG_ENABLE	0x30
 | |
| #define WB_SIO_UARTC_ENABLE_ON		0
 | |
| 
 | |
| /* GPIO3, GPIO4 logical device */
 | |
| #define WB_SIO_DEV_GPIO34		0x07
 | |
| #define WB_SIO_GPIO34_REG_ENABLE	0x30
 | |
| #define WB_SIO_GPIO34_ENABLE_3		0
 | |
| #define WB_SIO_GPIO34_ENABLE_4		1
 | |
| #define WB_SIO_GPIO34_REG_IO3		0xe0
 | |
| #define WB_SIO_GPIO34_REG_DATA3	0xe1
 | |
| #define WB_SIO_GPIO34_REG_INV3		0xe2
 | |
| #define WB_SIO_GPIO34_REG_IO4		0xe4
 | |
| #define WB_SIO_GPIO34_REG_DATA4	0xe5
 | |
| #define WB_SIO_GPIO34_REG_INV4		0xe6
 | |
| 
 | |
| /* WDTO, PLED, GPIO5, GPIO6 logical device */
 | |
| #define WB_SIO_DEV_WDGPIO56		0x08
 | |
| #define WB_SIO_WDGPIO56_REG_ENABLE	0x30
 | |
| #define WB_SIO_WDGPIO56_ENABLE_5	1
 | |
| #define WB_SIO_WDGPIO56_ENABLE_6	2
 | |
| #define WB_SIO_WDGPIO56_REG_IO5	0xe0
 | |
| #define WB_SIO_WDGPIO56_REG_DATA5	0xe1
 | |
| #define WB_SIO_WDGPIO56_REG_INV5	0xe2
 | |
| #define WB_SIO_WDGPIO56_REG_IO6	0xe4
 | |
| #define WB_SIO_WDGPIO56_REG_DATA6	0xe5
 | |
| #define WB_SIO_WDGPIO56_REG_INV6	0xe6
 | |
| 
 | |
| /* GPIO1, GPIO2, SUSLED logical device */
 | |
| #define WB_SIO_DEV_GPIO12		0x09
 | |
| #define WB_SIO_GPIO12_REG_ENABLE	0x30
 | |
| #define WB_SIO_GPIO12_ENABLE_1		0
 | |
| #define WB_SIO_GPIO12_ENABLE_2		1
 | |
| #define WB_SIO_GPIO12_REG_IO1		0xe0
 | |
| #define WB_SIO_GPIO12_REG_DATA1	0xe1
 | |
| #define WB_SIO_GPIO12_REG_INV1		0xe2
 | |
| #define WB_SIO_GPIO12_REG_IO2		0xe4
 | |
| #define WB_SIO_GPIO12_REG_DATA2	0xe5
 | |
| #define WB_SIO_GPIO12_REG_INV2		0xe6
 | |
| 
 | |
| /* UART D logical device */
 | |
| #define WB_SIO_DEV_UARTD		0x0d
 | |
| #define WB_SIO_UARTD_REG_ENABLE	0x30
 | |
| #define WB_SIO_UARTD_ENABLE_ON		0
 | |
| 
 | |
| /* UART E logical device */
 | |
| #define WB_SIO_DEV_UARTE		0x0e
 | |
| #define WB_SIO_UARTE_REG_ENABLE	0x30
 | |
| #define WB_SIO_UARTE_ENABLE_ON		0
 | |
| 
 | |
| /*
 | |
|  * for a description what a particular field of this struct means please see
 | |
|  * a description of the relevant module parameter at the bottom of this file
 | |
|  */
 | |
| struct winbond_gpio_params {
 | |
| 	unsigned long base;
 | |
| 	unsigned long gpios;
 | |
| 	unsigned long ppgpios;
 | |
| 	unsigned long odgpios;
 | |
| 	bool pledgpio;
 | |
| 	bool beepgpio;
 | |
| 	bool i2cgpio;
 | |
| };
 | |
| 
 | |
| static struct winbond_gpio_params params;
 | |
| 
 | |
| static int winbond_sio_enter(unsigned long base)
 | |
| {
 | |
| 	if (!request_muxed_region(base, 2, WB_GPIO_DRIVER_NAME))
 | |
| 		return -EBUSY;
 | |
| 
 | |
| 	/*
 | |
| 	 * datasheet says two successive writes of the "key" value are needed
 | |
| 	 * in order for chip to enter the "Extended Function Mode"
 | |
| 	 */
 | |
| 	outb(WB_SIO_EXT_ENTER_KEY, base);
 | |
| 	outb(WB_SIO_EXT_ENTER_KEY, base);
 | |
| 
 | |
| 	return 0;
 | |
| }
 | |
| 
 | |
| static void winbond_sio_select_logical(unsigned long base, u8 dev)
 | |
| {
 | |
| 	outb(WB_SIO_REG_LOGICAL, base);
 | |
| 	outb(dev, base + 1);
 | |
| }
 | |
| 
 | |
| static void winbond_sio_leave(unsigned long base)
 | |
| {
 | |
| 	outb(WB_SIO_EXT_EXIT_KEY, base);
 | |
| 
 | |
| 	release_region(base, 2);
 | |
| }
 | |
| 
 | |
| static void winbond_sio_reg_write(unsigned long base, u8 reg, u8 data)
 | |
| {
 | |
| 	outb(reg, base);
 | |
| 	outb(data, base + 1);
 | |
| }
 | |
| 
 | |
| static u8 winbond_sio_reg_read(unsigned long base, u8 reg)
 | |
| {
 | |
| 	outb(reg, base);
 | |
| 	return inb(base + 1);
 | |
| }
 | |
| 
 | |
| static void winbond_sio_reg_bset(unsigned long base, u8 reg, u8 bit)
 | |
| {
 | |
| 	u8 val;
 | |
| 
 | |
| 	val = winbond_sio_reg_read(base, reg);
 | |
| 	val |= BIT(bit);
 | |
| 	winbond_sio_reg_write(base, reg, val);
 | |
| }
 | |
| 
 | |
| static void winbond_sio_reg_bclear(unsigned long base, u8 reg, u8 bit)
 | |
| {
 | |
| 	u8 val;
 | |
| 
 | |
| 	val = winbond_sio_reg_read(base, reg);
 | |
| 	val &= ~BIT(bit);
 | |
| 	winbond_sio_reg_write(base, reg, val);
 | |
| }
 | |
| 
 | |
| static bool winbond_sio_reg_btest(unsigned long base, u8 reg, u8 bit)
 | |
| {
 | |
| 	return winbond_sio_reg_read(base, reg) & BIT(bit);
 | |
| }
 | |
| 
 | |
| /**
 | |
|  * struct winbond_gpio_port_conflict - possibly conflicting device information
 | |
|  * @name:	device name (NULL means no conflicting device defined)
 | |
|  * @dev:	Super I/O logical device number where the testreg register
 | |
|  *		is located (or WB_SIO_DEV_NONE - don't select any
 | |
|  *		logical device)
 | |
|  * @testreg:	register number where the testbit bit is located
 | |
|  * @testbit:	index of a bit to check whether an actual conflict exists
 | |
|  * @warnonly:	if set then a conflict isn't fatal (just warn about it),
 | |
|  *		otherwise disable the particular GPIO port if a conflict
 | |
|  *		is detected
 | |
|  */
 | |
| struct winbond_gpio_port_conflict {
 | |
| 	const char *name;
 | |
| 	u8 dev;
 | |
| 	u8 testreg;
 | |
| 	u8 testbit;
 | |
| 	bool warnonly;
 | |
| };
 | |
| 
 | |
| /**
 | |
|  * struct winbond_gpio_info - information about a particular GPIO port (device)
 | |
|  * @dev:		Super I/O logical device number of the registers
 | |
|  *			specified below
 | |
|  * @enablereg:		port enable bit register number
 | |
|  * @enablebit:		index of a port enable bit
 | |
|  * @outputreg:		output driver mode bit register number
 | |
|  * @outputppbit:	index of a push-pull output driver mode bit
 | |
|  * @ioreg:		data direction register number
 | |
|  * @invreg:		pin data inversion register number
 | |
|  * @datareg:		pin data register number
 | |
|  * @conflict:		description of a device that possibly conflicts with
 | |
|  *			this port
 | |
|  */
 | |
| struct winbond_gpio_info {
 | |
| 	u8 dev;
 | |
| 	u8 enablereg;
 | |
| 	u8 enablebit;
 | |
| 	u8 outputreg;
 | |
| 	u8 outputppbit;
 | |
| 	u8 ioreg;
 | |
| 	u8 invreg;
 | |
| 	u8 datareg;
 | |
| 	struct winbond_gpio_port_conflict conflict;
 | |
| };
 | |
| 
 | |
| static const struct winbond_gpio_info winbond_gpio_infos[6] = {
 | |
| 	{ /* 0 */
 | |
| 		.dev = WB_SIO_DEV_GPIO12,
 | |
| 		.enablereg = WB_SIO_GPIO12_REG_ENABLE,
 | |
| 		.enablebit = WB_SIO_GPIO12_ENABLE_1,
 | |
| 		.outputreg = WB_SIO_REG_GPIO1_MF,
 | |
| 		.outputppbit = WB_SIO_REG_G1MF_G1PP,
 | |
| 		.ioreg = WB_SIO_GPIO12_REG_IO1,
 | |
| 		.invreg = WB_SIO_GPIO12_REG_INV1,
 | |
| 		.datareg = WB_SIO_GPIO12_REG_DATA1,
 | |
| 		.conflict = {
 | |
| 			.name = "UARTB",
 | |
| 			.dev = WB_SIO_DEV_UARTB,
 | |
| 			.testreg = WB_SIO_UARTB_REG_ENABLE,
 | |
| 			.testbit = WB_SIO_UARTB_ENABLE_ON,
 | |
| 			.warnonly = true
 | |
| 		}
 | |
| 	},
 | |
| 	{ /* 1 */
 | |
| 		.dev = WB_SIO_DEV_GPIO12,
 | |
| 		.enablereg = WB_SIO_GPIO12_REG_ENABLE,
 | |
| 		.enablebit = WB_SIO_GPIO12_ENABLE_2,
 | |
| 		.outputreg = WB_SIO_REG_GPIO1_MF,
 | |
| 		.outputppbit = WB_SIO_REG_G1MF_G2PP,
 | |
| 		.ioreg = WB_SIO_GPIO12_REG_IO2,
 | |
| 		.invreg = WB_SIO_GPIO12_REG_INV2,
 | |
| 		.datareg = WB_SIO_GPIO12_REG_DATA2
 | |
| 		/* special conflict handling so doesn't use conflict data */
 | |
| 	},
 | |
| 	{ /* 2 */
 | |
| 		.dev = WB_SIO_DEV_GPIO34,
 | |
| 		.enablereg = WB_SIO_GPIO34_REG_ENABLE,
 | |
| 		.enablebit = WB_SIO_GPIO34_ENABLE_3,
 | |
| 		.outputreg = WB_SIO_REG_OVTGPIO3456,
 | |
| 		.outputppbit = WB_SIO_REG_OG3456_G3PP,
 | |
| 		.ioreg = WB_SIO_GPIO34_REG_IO3,
 | |
| 		.invreg = WB_SIO_GPIO34_REG_INV3,
 | |
| 		.datareg = WB_SIO_GPIO34_REG_DATA3,
 | |
| 		.conflict = {
 | |
| 			.name = "UARTC",
 | |
| 			.dev = WB_SIO_DEV_UARTC,
 | |
| 			.testreg = WB_SIO_UARTC_REG_ENABLE,
 | |
| 			.testbit = WB_SIO_UARTC_ENABLE_ON,
 | |
| 			.warnonly = true
 | |
| 		}
 | |
| 	},
 | |
| 	{ /* 3 */
 | |
| 		.dev = WB_SIO_DEV_GPIO34,
 | |
| 		.enablereg = WB_SIO_GPIO34_REG_ENABLE,
 | |
| 		.enablebit = WB_SIO_GPIO34_ENABLE_4,
 | |
| 		.outputreg = WB_SIO_REG_OVTGPIO3456,
 | |
| 		.outputppbit = WB_SIO_REG_OG3456_G4PP,
 | |
| 		.ioreg = WB_SIO_GPIO34_REG_IO4,
 | |
| 		.invreg = WB_SIO_GPIO34_REG_INV4,
 | |
| 		.datareg = WB_SIO_GPIO34_REG_DATA4,
 | |
| 		.conflict = {
 | |
| 			.name = "UARTD",
 | |
| 			.dev = WB_SIO_DEV_UARTD,
 | |
| 			.testreg = WB_SIO_UARTD_REG_ENABLE,
 | |
| 			.testbit = WB_SIO_UARTD_ENABLE_ON,
 | |
| 			.warnonly = true
 | |
| 		}
 | |
| 	},
 | |
| 	{ /* 4 */
 | |
| 		.dev = WB_SIO_DEV_WDGPIO56,
 | |
| 		.enablereg = WB_SIO_WDGPIO56_REG_ENABLE,
 | |
| 		.enablebit = WB_SIO_WDGPIO56_ENABLE_5,
 | |
| 		.outputreg = WB_SIO_REG_OVTGPIO3456,
 | |
| 		.outputppbit = WB_SIO_REG_OG3456_G5PP,
 | |
| 		.ioreg = WB_SIO_WDGPIO56_REG_IO5,
 | |
| 		.invreg = WB_SIO_WDGPIO56_REG_INV5,
 | |
| 		.datareg = WB_SIO_WDGPIO56_REG_DATA5,
 | |
| 		.conflict = {
 | |
| 			.name = "UARTE",
 | |
| 			.dev = WB_SIO_DEV_UARTE,
 | |
| 			.testreg = WB_SIO_UARTE_REG_ENABLE,
 | |
| 			.testbit = WB_SIO_UARTE_ENABLE_ON,
 | |
| 			.warnonly = true
 | |
| 		}
 | |
| 	},
 | |
| 	{ /* 5 */
 | |
| 		.dev = WB_SIO_DEV_WDGPIO56,
 | |
| 		.enablereg = WB_SIO_WDGPIO56_REG_ENABLE,
 | |
| 		.enablebit = WB_SIO_WDGPIO56_ENABLE_6,
 | |
| 		.outputreg = WB_SIO_REG_OVTGPIO3456,
 | |
| 		.outputppbit = WB_SIO_REG_OG3456_G6PP,
 | |
| 		.ioreg = WB_SIO_WDGPIO56_REG_IO6,
 | |
| 		.invreg = WB_SIO_WDGPIO56_REG_INV6,
 | |
| 		.datareg = WB_SIO_WDGPIO56_REG_DATA6,
 | |
| 		.conflict = {
 | |
| 			.name = "FDC",
 | |
| 			.dev = WB_SIO_DEV_NONE,
 | |
| 			.testreg = WB_SIO_REG_GLOBAL_OPT,
 | |
| 			.testbit = WB_SIO_REG_GO_ENFDC,
 | |
| 			.warnonly = false
 | |
| 		}
 | |
| 	}
 | |
| };
 | |
| 
 | |
| /* returns whether changing a pin is allowed */
 | |
| static bool winbond_gpio_get_info(unsigned int *gpio_num,
 | |
| 				  const struct winbond_gpio_info **info)
 | |
| {
 | |
| 	bool allow_changing = true;
 | |
| 	unsigned long i;
 | |
| 
 | |
| 	for_each_set_bit(i, ¶ms.gpios, BITS_PER_LONG) {
 | |
| 		if (*gpio_num < 8)
 | |
| 			break;
 | |
| 
 | |
| 		*gpio_num -= 8;
 | |
| 	}
 | |
| 
 | |
| 	*info = &winbond_gpio_infos[i];
 | |
| 
 | |
| 	/*
 | |
| 	 * GPIO2 (the second port) shares some pins with a basic PC
 | |
| 	 * functionality, which is very likely controlled by the firmware.
 | |
| 	 * Don't allow changing these pins by default.
 | |
| 	 */
 | |
| 	if (i == 1) {
 | |
| 		if (*gpio_num == 0 && !params.pledgpio)
 | |
| 			allow_changing = false;
 | |
| 		else if (*gpio_num == 1 && !params.beepgpio)
 | |
| 			allow_changing = false;
 | |
| 		else if ((*gpio_num == 5 || *gpio_num == 6) && !params.i2cgpio)
 | |
| 			allow_changing = false;
 | |
| 	}
 | |
| 
 | |
| 	return allow_changing;
 | |
| }
 | |
| 
 | |
| static int winbond_gpio_get(struct gpio_chip *gc, unsigned int offset)
 | |
| {
 | |
| 	unsigned long *base = gpiochip_get_data(gc);
 | |
| 	const struct winbond_gpio_info *info;
 | |
| 	bool val;
 | |
| 
 | |
| 	winbond_gpio_get_info(&offset, &info);
 | |
| 
 | |
| 	val = winbond_sio_enter(*base);
 | |
| 	if (val)
 | |
| 		return val;
 | |
| 
 | |
| 	winbond_sio_select_logical(*base, info->dev);
 | |
| 
 | |
| 	val = winbond_sio_reg_btest(*base, info->datareg, offset);
 | |
| 	if (winbond_sio_reg_btest(*base, info->invreg, offset))
 | |
| 		val = !val;
 | |
| 
 | |
| 	winbond_sio_leave(*base);
 | |
| 
 | |
| 	return val;
 | |
| }
 | |
| 
 | |
| static int winbond_gpio_direction_in(struct gpio_chip *gc, unsigned int offset)
 | |
| {
 | |
| 	unsigned long *base = gpiochip_get_data(gc);
 | |
| 	const struct winbond_gpio_info *info;
 | |
| 	int ret;
 | |
| 
 | |
| 	if (!winbond_gpio_get_info(&offset, &info))
 | |
| 		return -EACCES;
 | |
| 
 | |
| 	ret = winbond_sio_enter(*base);
 | |
| 	if (ret)
 | |
| 		return ret;
 | |
| 
 | |
| 	winbond_sio_select_logical(*base, info->dev);
 | |
| 
 | |
| 	winbond_sio_reg_bset(*base, info->ioreg, offset);
 | |
| 
 | |
| 	winbond_sio_leave(*base);
 | |
| 
 | |
| 	return 0;
 | |
| }
 | |
| 
 | |
| static int winbond_gpio_direction_out(struct gpio_chip *gc,
 | |
| 				      unsigned int offset,
 | |
| 				      int val)
 | |
| {
 | |
| 	unsigned long *base = gpiochip_get_data(gc);
 | |
| 	const struct winbond_gpio_info *info;
 | |
| 	int ret;
 | |
| 
 | |
| 	if (!winbond_gpio_get_info(&offset, &info))
 | |
| 		return -EACCES;
 | |
| 
 | |
| 	ret = winbond_sio_enter(*base);
 | |
| 	if (ret)
 | |
| 		return ret;
 | |
| 
 | |
| 	winbond_sio_select_logical(*base, info->dev);
 | |
| 
 | |
| 	winbond_sio_reg_bclear(*base, info->ioreg, offset);
 | |
| 
 | |
| 	if (winbond_sio_reg_btest(*base, info->invreg, offset))
 | |
| 		val = !val;
 | |
| 
 | |
| 	if (val)
 | |
| 		winbond_sio_reg_bset(*base, info->datareg, offset);
 | |
| 	else
 | |
| 		winbond_sio_reg_bclear(*base, info->datareg, offset);
 | |
| 
 | |
| 	winbond_sio_leave(*base);
 | |
| 
 | |
| 	return 0;
 | |
| }
 | |
| 
 | |
| static void winbond_gpio_set(struct gpio_chip *gc, unsigned int offset,
 | |
| 			     int val)
 | |
| {
 | |
| 	unsigned long *base = gpiochip_get_data(gc);
 | |
| 	const struct winbond_gpio_info *info;
 | |
| 
 | |
| 	if (!winbond_gpio_get_info(&offset, &info))
 | |
| 		return;
 | |
| 
 | |
| 	if (winbond_sio_enter(*base) != 0)
 | |
| 		return;
 | |
| 
 | |
| 	winbond_sio_select_logical(*base, info->dev);
 | |
| 
 | |
| 	if (winbond_sio_reg_btest(*base, info->invreg, offset))
 | |
| 		val = !val;
 | |
| 
 | |
| 	if (val)
 | |
| 		winbond_sio_reg_bset(*base, info->datareg, offset);
 | |
| 	else
 | |
| 		winbond_sio_reg_bclear(*base, info->datareg, offset);
 | |
| 
 | |
| 	winbond_sio_leave(*base);
 | |
| }
 | |
| 
 | |
| static struct gpio_chip winbond_gpio_chip = {
 | |
| 	.base			= -1,
 | |
| 	.label			= WB_GPIO_DRIVER_NAME,
 | |
| 	.owner			= THIS_MODULE,
 | |
| 	.can_sleep		= true,
 | |
| 	.get			= winbond_gpio_get,
 | |
| 	.direction_input	= winbond_gpio_direction_in,
 | |
| 	.set			= winbond_gpio_set,
 | |
| 	.direction_output	= winbond_gpio_direction_out,
 | |
| };
 | |
| 
 | |
| static void winbond_gpio_configure_port0_pins(unsigned long base)
 | |
| {
 | |
| 	unsigned int val;
 | |
| 
 | |
| 	val = winbond_sio_reg_read(base, WB_SIO_REG_GPIO1_MF);
 | |
| 	if ((val & WB_SIO_REG_G1MF_FS_MASK) == WB_SIO_REG_G1MF_FS_GPIO1)
 | |
| 		return;
 | |
| 
 | |
| 	pr_warn("GPIO1 pins were connected to something else (%.2x), fixing\n",
 | |
| 		val);
 | |
| 
 | |
| 	val &= ~WB_SIO_REG_G1MF_FS_MASK;
 | |
| 	val |= WB_SIO_REG_G1MF_FS_GPIO1;
 | |
| 
 | |
| 	winbond_sio_reg_write(base, WB_SIO_REG_GPIO1_MF, val);
 | |
| }
 | |
| 
 | |
| static void winbond_gpio_configure_port1_check_i2c(unsigned long base)
 | |
| {
 | |
| 	params.i2cgpio = !winbond_sio_reg_btest(base, WB_SIO_REG_I2C_PS,
 | |
| 						WB_SIO_REG_I2CPS_I2CFS);
 | |
| 	if (!params.i2cgpio)
 | |
| 		pr_warn("disabling GPIO2.5 and GPIO2.6 as I2C is enabled\n");
 | |
| }
 | |
| 
 | |
| static bool winbond_gpio_configure_port(unsigned long base, unsigned int idx)
 | |
| {
 | |
| 	const struct winbond_gpio_info *info = &winbond_gpio_infos[idx];
 | |
| 	const struct winbond_gpio_port_conflict *conflict = &info->conflict;
 | |
| 
 | |
| 	/* is there a possible conflicting device defined? */
 | |
| 	if (conflict->name != NULL) {
 | |
| 		if (conflict->dev != WB_SIO_DEV_NONE)
 | |
| 			winbond_sio_select_logical(base, conflict->dev);
 | |
| 
 | |
| 		if (winbond_sio_reg_btest(base, conflict->testreg,
 | |
| 					  conflict->testbit)) {
 | |
| 			if (conflict->warnonly)
 | |
| 				pr_warn("enabled GPIO%u share pins with active %s\n",
 | |
| 					idx + 1, conflict->name);
 | |
| 			else {
 | |
| 				pr_warn("disabling GPIO%u as %s is enabled\n",
 | |
| 					idx + 1, conflict->name);
 | |
| 				return false;
 | |
| 			}
 | |
| 		}
 | |
| 	}
 | |
| 
 | |
| 	/* GPIO1 and GPIO2 need some (additional) special handling */
 | |
| 	if (idx == 0)
 | |
| 		winbond_gpio_configure_port0_pins(base);
 | |
| 	else if (idx == 1)
 | |
| 		winbond_gpio_configure_port1_check_i2c(base);
 | |
| 
 | |
| 	winbond_sio_select_logical(base, info->dev);
 | |
| 
 | |
| 	winbond_sio_reg_bset(base, info->enablereg, info->enablebit);
 | |
| 
 | |
| 	if (params.ppgpios & BIT(idx))
 | |
| 		winbond_sio_reg_bset(base, info->outputreg,
 | |
| 				     info->outputppbit);
 | |
| 	else if (params.odgpios & BIT(idx))
 | |
| 		winbond_sio_reg_bclear(base, info->outputreg,
 | |
| 				       info->outputppbit);
 | |
| 	else
 | |
| 		pr_notice("GPIO%u pins are %s\n", idx + 1,
 | |
| 			  winbond_sio_reg_btest(base, info->outputreg,
 | |
| 						info->outputppbit) ?
 | |
| 			  "push-pull" :
 | |
| 			  "open drain");
 | |
| 
 | |
| 	return true;
 | |
| }
 | |
| 
 | |
| static int winbond_gpio_configure(unsigned long base)
 | |
| {
 | |
| 	unsigned long i;
 | |
| 
 | |
| 	for_each_set_bit(i, ¶ms.gpios, BITS_PER_LONG)
 | |
| 		if (!winbond_gpio_configure_port(base, i))
 | |
| 			__clear_bit(i, ¶ms.gpios);
 | |
| 
 | |
| 	if (!params.gpios) {
 | |
| 		pr_err("please use 'gpios' module parameter to select some active GPIO ports to enable\n");
 | |
| 		return -EINVAL;
 | |
| 	}
 | |
| 
 | |
| 	return 0;
 | |
| }
 | |
| 
 | |
| static int winbond_gpio_check_chip(unsigned long base)
 | |
| {
 | |
| 	int ret;
 | |
| 	unsigned int chip;
 | |
| 
 | |
| 	ret = winbond_sio_enter(base);
 | |
| 	if (ret)
 | |
| 		return ret;
 | |
| 
 | |
| 	chip = winbond_sio_reg_read(base, WB_SIO_REG_CHIP_MSB) << 8;
 | |
| 	chip |= winbond_sio_reg_read(base, WB_SIO_REG_CHIP_LSB);
 | |
| 
 | |
| 	pr_notice("chip ID at %lx is %.4x\n", base, chip);
 | |
| 
 | |
| 	if ((chip & WB_SIO_CHIP_ID_W83627UHG_MASK) !=
 | |
| 	    WB_SIO_CHIP_ID_W83627UHG) {
 | |
| 		pr_err("not an our chip\n");
 | |
| 		ret = -ENODEV;
 | |
| 	}
 | |
| 
 | |
| 	winbond_sio_leave(base);
 | |
| 
 | |
| 	return ret;
 | |
| }
 | |
| 
 | |
| static int winbond_gpio_imatch(struct device *dev, unsigned int id)
 | |
| {
 | |
| 	unsigned long gpios_rem;
 | |
| 	int ret;
 | |
| 
 | |
| 	gpios_rem = params.gpios & ~GENMASK(ARRAY_SIZE(winbond_gpio_infos) - 1,
 | |
| 					    0);
 | |
| 	if (gpios_rem) {
 | |
| 		pr_warn("unknown ports (%lx) enabled in GPIO ports bitmask\n",
 | |
| 			gpios_rem);
 | |
| 		params.gpios &= ~gpios_rem;
 | |
| 	}
 | |
| 
 | |
| 	if (params.ppgpios & params.odgpios) {
 | |
| 		pr_err("some GPIO ports are set both to push-pull and open drain mode at the same time\n");
 | |
| 		return 0;
 | |
| 	}
 | |
| 
 | |
| 	if (params.base != 0)
 | |
| 		return winbond_gpio_check_chip(params.base) == 0;
 | |
| 
 | |
| 	/*
 | |
| 	 * if the 'base' module parameter is unset probe two chip default
 | |
| 	 * I/O port bases
 | |
| 	 */
 | |
| 	params.base = WB_SIO_BASE;
 | |
| 	ret = winbond_gpio_check_chip(params.base);
 | |
| 	if (ret == 0)
 | |
| 		return 1;
 | |
| 	if (ret != -ENODEV && ret != -EBUSY)
 | |
| 		return 0;
 | |
| 
 | |
| 	params.base = WB_SIO_BASE_HIGH;
 | |
| 	return winbond_gpio_check_chip(params.base) == 0;
 | |
| }
 | |
| 
 | |
| static int winbond_gpio_iprobe(struct device *dev, unsigned int id)
 | |
| {
 | |
| 	int ret;
 | |
| 
 | |
| 	if (params.base == 0)
 | |
| 		return -EINVAL;
 | |
| 
 | |
| 	ret = winbond_sio_enter(params.base);
 | |
| 	if (ret)
 | |
| 		return ret;
 | |
| 
 | |
| 	ret = winbond_gpio_configure(params.base);
 | |
| 
 | |
| 	winbond_sio_leave(params.base);
 | |
| 
 | |
| 	if (ret)
 | |
| 		return ret;
 | |
| 
 | |
| 	/*
 | |
| 	 * Add 8 gpios for every GPIO port that was enabled in gpios
 | |
| 	 * module parameter (that wasn't disabled earlier in
 | |
| 	 * winbond_gpio_configure() & co. due to, for example, a pin conflict).
 | |
| 	 */
 | |
| 	winbond_gpio_chip.ngpio = hweight_long(params.gpios) * 8;
 | |
| 
 | |
| 	/*
 | |
| 	 * GPIO6 port has only 5 pins, so if it is enabled we have to adjust
 | |
| 	 * the total count appropriately
 | |
| 	 */
 | |
| 	if (params.gpios & BIT(5))
 | |
| 		winbond_gpio_chip.ngpio -= (8 - 5);
 | |
| 
 | |
| 	winbond_gpio_chip.parent = dev;
 | |
| 
 | |
| 	return devm_gpiochip_add_data(dev, &winbond_gpio_chip, ¶ms.base);
 | |
| }
 | |
| 
 | |
| static struct isa_driver winbond_gpio_idriver = {
 | |
| 	.driver = {
 | |
| 		.name	= WB_GPIO_DRIVER_NAME,
 | |
| 	},
 | |
| 	.match	= winbond_gpio_imatch,
 | |
| 	.probe	= winbond_gpio_iprobe,
 | |
| };
 | |
| 
 | |
| module_isa_driver(winbond_gpio_idriver, 1);
 | |
| 
 | |
| module_param_named(base, params.base, ulong, 0444);
 | |
| MODULE_PARM_DESC(base,
 | |
| 		 "I/O port base (when unset - probe chip default ones)");
 | |
| 
 | |
| /* This parameter sets which GPIO devices (ports) we enable */
 | |
| module_param_named(gpios, params.gpios, ulong, 0444);
 | |
| MODULE_PARM_DESC(gpios,
 | |
| 		 "bitmask of GPIO ports to enable (bit 0 - GPIO1, bit 1 - GPIO2, etc.");
 | |
| 
 | |
| /*
 | |
|  * These two parameters below set how we configure GPIO ports output drivers.
 | |
|  * It can't be a one bitmask since we need three values per port: push-pull,
 | |
|  * open-drain and keep as-is (this is the default).
 | |
|  */
 | |
| module_param_named(ppgpios, params.ppgpios, ulong, 0444);
 | |
| MODULE_PARM_DESC(ppgpios,
 | |
| 		 "bitmask of GPIO ports to set to push-pull mode (bit 0 - GPIO1, bit 1 - GPIO2, etc.");
 | |
| 
 | |
| module_param_named(odgpios, params.odgpios, ulong, 0444);
 | |
| MODULE_PARM_DESC(odgpios,
 | |
| 		 "bitmask of GPIO ports to set to open drain mode (bit 0 - GPIO1, bit 1 - GPIO2, etc.");
 | |
| 
 | |
| /*
 | |
|  * GPIO2.0 and GPIO2.1 control a basic PC functionality that we
 | |
|  * don't allow tinkering with by default (it is very likely that the
 | |
|  * firmware owns these pins).
 | |
|  * These two parameters below allow overriding these prohibitions.
 | |
|  */
 | |
| module_param_named(pledgpio, params.pledgpio, bool, 0644);
 | |
| MODULE_PARM_DESC(pledgpio,
 | |
| 		 "enable changing value of GPIO2.0 bit (Power LED), default no.");
 | |
| 
 | |
| module_param_named(beepgpio, params.beepgpio, bool, 0644);
 | |
| MODULE_PARM_DESC(beepgpio,
 | |
| 		 "enable changing value of GPIO2.1 bit (BEEP), default no.");
 | |
| 
 | |
| MODULE_AUTHOR("Maciej S. Szmigiero <mail@maciej.szmigiero.name>");
 | |
| MODULE_DESCRIPTION("GPIO interface for Winbond Super I/O chips");
 | |
| MODULE_LICENSE("GPL");
 |