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