| // 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"); |