Received: by 2002:a05:6358:d09b:b0:dc:cd0c:909e with SMTP id jc27csp469568rwb; Wed, 16 Nov 2022 03:28:04 -0800 (PST) X-Google-Smtp-Source: AA0mqf4q5G6sbCWxd+60yPSD1rFrezx8CNf6hOA6Pd3sUqHf499Sd72Qo7KxlCiXDZU3oWSmu+jG X-Received: by 2002:a17:906:5fc9:b0:781:c97c:84d1 with SMTP id k9-20020a1709065fc900b00781c97c84d1mr17236013ejv.147.1668598083795; Wed, 16 Nov 2022 03:28:03 -0800 (PST) ARC-Seal: i=1; a=rsa-sha256; t=1668598083; cv=none; d=google.com; s=arc-20160816; b=Ego4TQiJ18RJ+ZKuY/K6Ky3kkeTjamtH0uf4yJ0SM0ad8TqnmK7QfQVqzi6EuqzHJM dUz/MDGLftOkHreyx3WPyQ6tHQE3LLo12NEBnLQ4J+3KyHwDPxpA3fW05I3Vfjx2D5dg jeFn70UBqe/AUsnCs4EJYBbCGRgPKiD5YKUZZzsTpKm06EKRsOtfhRsMrHMz9t4JzklV 8oyuOPSaktqxSiqnlGrBFKsoeHDqc75CkM3LSihsEgG/OCPWl6VIVDtifEF+uDjEteWh Sjdp64I9Mp3uMPQdn2SZR0zQPfH5pizSLAHOTf3rGD8pIgDRGWKpEsIy8Wz7iTyHoejd Ackg== ARC-Message-Signature: i=1; a=rsa-sha256; c=relaxed/relaxed; d=google.com; s=arc-20160816; h=list-id:precedence:content-transfer-encoding:content-language :in-reply-to:mime-version:user-agent:date:message-id:from:references :cc:to:subject; bh=M+s26MoXyue3H6YcVDSojQmg2KdsJ3xXC/jov7zQ8xU=; b=qbGl2aQKX1WSN2ScBSyH5WQkff7z2WCIwsf9AVOcHu0cWG00AkwrQRzp/KYIN5LSvz ZYJ++9tSubCJcjOjWZWgZMJfQ/NbTAb/2Xd6rkTZgyh+W3lxYg29E5ok/+CF7AESlx3Q zjqyPfpVlEnIcLppxePFyeHqFGwkU0llon0+YEYDFIVx57CvAZaRZZINjpy5omyS/FWQ PD04cU19DErqqrtOiLmQrUgkEv03/bALcHYDZMzAWsN0FuwmyQnZhFDb+8MdVHPfG3TB BKmfTsm4T6qr+hvnARpcrz15j/DBShD37Qv3YJ7HZy4bkC1Px/bgsZNeirIUk+2uAWxp kFGA== ARC-Authentication-Results: i=1; mx.google.com; spf=pass (google.com: domain of linux-kernel-owner@vger.kernel.org designates 2620:137:e000::1:20 as permitted sender) smtp.mailfrom=linux-kernel-owner@vger.kernel.org Return-Path: Received: from out1.vger.email (out1.vger.email. [2620:137:e000::1:20]) by mx.google.com with ESMTP id q17-20020a056402519100b004674aa77346si15180396edd.72.2022.11.16.03.27.40; Wed, 16 Nov 2022 03:28:03 -0800 (PST) Received-SPF: pass (google.com: domain of linux-kernel-owner@vger.kernel.org designates 2620:137:e000::1:20 as permitted sender) client-ip=2620:137:e000::1:20; Authentication-Results: mx.google.com; spf=pass (google.com: domain of linux-kernel-owner@vger.kernel.org designates 2620:137:e000::1:20 as permitted sender) smtp.mailfrom=linux-kernel-owner@vger.kernel.org Received: (majordomo@vger.kernel.org) by vger.kernel.org via listexpand id S231620AbiKPKDV (ORCPT + 91 others); Wed, 16 Nov 2022 05:03:21 -0500 Received: from lindbergh.monkeyblade.net ([23.128.96.19]:42242 "EHLO lindbergh.monkeyblade.net" rhost-flags-OK-OK-OK-OK) by vger.kernel.org with ESMTP id S231177AbiKPKDS (ORCPT ); Wed, 16 Nov 2022 05:03:18 -0500 Received: from loongson.cn (mail.loongson.cn [114.242.206.163]) by lindbergh.monkeyblade.net (Postfix) with ESMTP id E9C44C25; Wed, 16 Nov 2022 02:03:15 -0800 (PST) Received: from loongson.cn (unknown [113.200.148.30]) by gateway (Coremail) with SMTP id _____8Dx_NhitXRjJ74HAA--.22409S3; Wed, 16 Nov 2022 18:03:14 +0800 (CST) Received: from [10.130.0.63] (unknown [113.200.148.30]) by localhost.localdomain (Coremail) with SMTP id AQAAf8Dx9VZetXRjusEUAA--.36668S3; Wed, 16 Nov 2022 18:03:12 +0800 (CST) Subject: Re: [PATCH v3 1/2] gpio: loongson: add dts/acpi gpio support To: Yinbo Zhu , Linus Walleij , Bartosz Golaszewski , Rob Herring , Krzysztof Kozlowski , WANG Xuerui , Jiaxun Yang , Thomas Bogendoerfer , Juxin Gao , Bibo Mao , Yanteng Si , linux-gpio@vger.kernel.org, devicetree@vger.kernel.org, linux-kernel@vger.kernel.org, loongarch@lists.linux.dev, linux-mips@vger.kernel.org, Arnaud Patard , Huacai Chen Cc: lvjianmin , zhanghongchen , Liu Peibao References: <20221116065335.8823-1-zhuyinbo@loongson.cn> From: Qing Zhang Message-ID: <086f8ff4-563d-8f4d-585e-59205854f66c@loongson.cn> Date: Wed, 16 Nov 2022 18:03:10 +0800 User-Agent: Mozilla/5.0 (X11; Linux mips64; rv:68.0) Gecko/20100101 Thunderbird/68.7.0 MIME-Version: 1.0 In-Reply-To: <20221116065335.8823-1-zhuyinbo@loongson.cn> Content-Type: text/plain; charset=utf-8; format=flowed Content-Language: en-US Content-Transfer-Encoding: 8bit X-CM-TRANSID: AQAAf8Dx9VZetXRjusEUAA--.36668S3 X-CM-SenderInfo: x2kd0wptlqwqxorr0wxvrqhubq/ X-Coremail-Antispam: 1Uk129KBjvAXoW3tw1UCFy7WrWkXr18GF18uFg_yoW8Cr4DKo W7JFZ3urW8Z347J3WYqrySqF47Z3Wqqa1vy3s2kFs8Gan8t3s8tr9rJ3y3XFy0vF1FqFyx ZFyfWa1xtFWxtFWDn29KB7ZKAUJUUUUf529EdanIXcx71UUUUU7KY7ZEXasCq-sGcSsGvf J3Ic02F40EFcxC0VAKzVAqx4xG6I80ebIjqfuFe4nvWSU5nxnvy29KBjDU0xBIdaVrnRJU UUPvb4IE77IF4wAFF20E14v26r1j6r4UM7CY07I20VC2zVCF04k26cxKx2IYs7xG6rWj6s 0DM7CIcVAFz4kK6r1Y6r17M28lY4IEw2IIxxk0rwA2F7IY1VAKz4vEj48ve4kI8wA2z4x0 Y4vE2Ix0cI8IcVAFwI0_Xr0_Ar1l84ACjcxK6xIIjxv20xvEc7CjxVAFwI0_Gr0_Cr1l84 ACjcxK6I8E87Iv67AKxVWxJr0_GcWl84ACjcxK6I8E87Iv6xkF7I0E14v26F4UJVW0owAa w2AFwI0_JF0_Jw1le2I262IYc4CY6c8Ij28IcVAaY2xG8wAqjxCEc2xF0cIa020Ex4CE44 I27wAqx4xG64xvF2IEw4CE5I8CrVC2j2WlYx0E2Ix0cI8IcVAFwI0_JF0_Jw1lYx0Ex4A2 jsIE14v26r4UJVWxJr1lOx8S6xCaFVCjc4AY6r1j6r4UM4x0Y48IcVAKI48JMxk0xIA0c2 IEe2xFo4CEbIxvr21lc7CjxVAaw2AFwI0_Jw0_GFyl42xK82IYc2Ij64vIr41l4I8I3I0E 4IkC6x0Yz7v_Jr0_Gr1l4IxYO2xFxVAFwI0_JF0_Jw1lx2IqxVAqx4xG67AKxVWUJVWUGw C20s026x8GjcxK67AKxVWUGVWUWwC2zVAF1VAY17CE14v26r4a6rW5MIIYrxkI7VAKI48J MIIF0xvE2Ix0cI8IcVAFwI0_JFI_Gr1lIxAIcVC0I7IYx2IY6xkF7I0E14v26r4j6F4UMI IF0xvE42xK8VAvwI8IcIk0rVWUJVWUCwCI42IY6I8E87Iv67AKxVW8Jr0_Cr1UMIIF0xvE x4A2jsIEc7CjxVAFwI0_Gr1j6F4UJbIYCTnIWIevJa73UjIFyTuYvjxU289NDUUUU X-Spam-Status: No, score=-1.9 required=5.0 tests=BAYES_00,NICE_REPLY_A, SPF_HELO_PASS,SPF_PASS autolearn=ham autolearn_force=no version=3.4.6 X-Spam-Checker-Version: SpamAssassin 3.4.6 (2021-04-09) on lindbergh.monkeyblade.net Precedence: bulk List-ID: X-Mailing-List: linux-kernel@vger.kernel.org Hi, yinbo On 2022/11/16 下午2:53, Yinbo Zhu wrote: > The latest Loongson series platform use dts or acpi framework to > register gpio device resources, such as the Loongson-2 series > SoC of LOONGARCH architecture. In order to support dts, acpi and > compatibility with previous platform device resources in driver, > this patch was added. > > Signed-off-by: lvjianmin > Signed-off-by: zhanghongchen > Signed-off-by: Liu Peibao > Signed-off-by: Juxin Gao > Signed-off-by: Yinbo Zhu > --- > Change in v3: > 1. Move the gpio platform data struct from arch/ into include/linux/ > platform_data/. > 2. Replace platform_gpio_data with loongson_gpio_platform_data in .c. > 3. Add maintainer in MAINTAINERS file for include/linux/platform_data/ > gpio-loongson.h and gpio-loongson.c > Change in v2: > 1. Fixup of_loongson_gpio_get_props and remove the parse logic about > "loongson,conf_offset", "loongson,out_offset", "loongson,in_offset", > "loongson,gpio_base", "loongson,support_irq" then kernel driver will > initial them that depend compatible except "loongson,gpio_base". > > MAINTAINERS | 8 + > drivers/gpio/Kconfig | 6 +- > drivers/gpio/gpio-loongson.c | 424 ++++++++++++++++---- > include/linux/platform_data/gpio-loongson.h | 22 + > 4 files changed, 385 insertions(+), 75 deletions(-) > create mode 100644 include/linux/platform_data/gpio-loongson.h > > diff --git a/MAINTAINERS b/MAINTAINERS > index 5114db9c8f32..bbd7a0d946eb 100644 > --- a/MAINTAINERS > +++ b/MAINTAINERS > @@ -12051,6 +12051,14 @@ S: Maintained > F: Documentation/devicetree/bindings/hwinfo/loongson,ls2k-chipid.yaml > F: drivers/soc/loongson/loongson2_guts.c > > +LOONGSON SERIES GPIO DRIVER > +M: Huacai Chen > +M: Yinbo Zhu > +L: linux-gpio@vger.kernel.org > +S: Maintained > +F: drivers/gpio/gpio-loongson.c > +F: include/linux/platform_data/gpio-loongson.h > + > LSILOGIC MPT FUSION DRIVERS (FC/SAS/SPI) > M: Sathya Prakash > M: Sreekanth Reddy > diff --git a/drivers/gpio/Kconfig b/drivers/gpio/Kconfig > index a01af1180616..fb8f0075a8ae 100644 > --- a/drivers/gpio/Kconfig > +++ b/drivers/gpio/Kconfig > @@ -376,10 +376,10 @@ config GPIO_LOGICVC > programmable logic block. > > config GPIO_LOONGSON > - bool "Loongson-2/3 GPIO support" > - depends on CPU_LOONGSON2EF || CPU_LOONGSON64 > + bool "Loongson series GPIO support" > + depends on CPU_LOONGSON2EF || CPU_LOONGSON64 || LOONGARCH I did not see the dts file related to mips (eg: 2K1000), If there is no plan to support or validate them, I recommend delete "cpu_loongson64". Thanks, - Qing > help > - Driver for GPIO functionality on Loongson-2F/3A/3B processors. > + Driver for GPIO functionality on Loongson seires processors. > > config GPIO_LPC18XX > tristate "NXP LPC18XX/43XX GPIO support" > diff --git a/drivers/gpio/gpio-loongson.c b/drivers/gpio/gpio-loongson.c > index a42145873cc9..1e553db03cf8 100644 > --- a/drivers/gpio/gpio-loongson.c > +++ b/drivers/gpio/gpio-loongson.c > @@ -1,13 +1,15 @@ > // SPDX-License-Identifier: GPL-2.0-or-later > /* > - * Loongson-2F/3A/3B GPIO Support > + * Loongson Series GPIO Support > * > - * Copyright (c) 2008 Richard Liu, STMicroelectronics > + * Copyright (c) 2008 Richard Liu, STMicroelectronics > * Copyright (c) 2008-2010 Arnaud Patard > * Copyright (c) 2013 Hongbing Hu > * Copyright (c) 2014 Huacai Chen > + * Copyright (c) 2022-2023 Yinbo Zhu > */ > > +#include > #include > #include > #include > @@ -16,120 +18,398 @@ > #include > #include > #include > +#include > #include > -#include > - > -#define STLS2F_N_GPIO 4 > -#define STLS3A_N_GPIO 16 > - > -#ifdef CONFIG_CPU_LOONGSON64 > -#define LOONGSON_N_GPIO STLS3A_N_GPIO > +#if defined(CONFIG_LOONGARCH) > +#include > +#elif defined(CONFIG_CPU_LOONGSON2EF) > +#include > #else > -#define LOONGSON_N_GPIO STLS2F_N_GPIO > +#include > #endif > > -/* > - * Offset into the register where we read lines, we write them from offset 0. > - * This offset is the only thing that stand between us and using > - * GPIO_GENERIC. > - */ > -#define LOONGSON_GPIO_IN_OFFSET 16 > +#define LOONGSON_GPIO_IN(x) (x->base + x->in_offset) > +#define LOONGSON_GPIO_OUT(x) (x->base + x->out_offset) > +#define LOONGSON_GPIO_OEN(x) (x->base + x->conf_offset) > + > +#define LOONGSON_GPIO_IN_BYTE(x, gpio) (x->base +\ > + x->in_offset + gpio) > +#define LOONGSON_GPIO_OUT_BYTE(x, gpio) (x->base +\ > + x->out_offset + gpio) > +#define LOONGSON_GPIO_OEN_BYTE(x, gpio) (x->base +\ > + x->conf_offset + gpio) > + > +struct loongson_gpio_chip { > + struct gpio_chip chip; > + spinlock_t lock; > + void __iomem *base; > + int conf_offset; > + int out_offset; > + int in_offset; > + u16 *gsi_idx_map; > + u16 mapsize; > + bool support_irq; > +}; > + > +static int loongson_gpio_request( > + struct gpio_chip *chip, unsigned int pin) > +{ > + if (pin >= chip->ngpio) > + return -EINVAL; > + else > + return 0; > +} > + > +static inline void __set_direction(struct loongson_gpio_chip *lgpio, > + unsigned int pin, int input) > +{ > + u64 qval; > + u8 bval; > + > + if (!strcmp(lgpio->chip.label, "loongson,ls2k-gpio")) { > + qval = readq(LOONGSON_GPIO_OEN(lgpio)); > + if (input) > + qval |= 1ULL << pin; > + else > + qval &= ~(1ULL << pin); > + writeq(qval, LOONGSON_GPIO_OEN(lgpio)); > + return; > + } > > -static DEFINE_SPINLOCK(gpio_lock); > + if (!strcmp(lgpio->chip.label, "loongson,ls7a-gpio") || > + !strncmp(lgpio->chip.label, "LOON0002", 8)) { > + if (input) > + bval = 1; > + else > + bval = 0; > + writeb(bval, LOONGSON_GPIO_OEN_BYTE(lgpio, pin)); > + return; > + } > + > + if (!strcmp(lgpio->chip.label, "loongson,platform-gpio")) { > + if (input) > + LOONGSON_GPIOIE |= BIT(pin); > + else > + LOONGSON_GPIOIE &= ~BIT(pin); > + return; > + } > +} > > -static int loongson_gpio_get_value(struct gpio_chip *chip, unsigned gpio) > +static void __set_level(struct loongson_gpio_chip *lgpio, unsigned int pin, > + int high) > { > - u32 val; > + u64 qval; > + u8 bval; > + > + if (!strcmp(lgpio->chip.label, "loongson,ls2k-gpio")) { > + qval = readq(LOONGSON_GPIO_OUT(lgpio)); > + if (high) > + qval |= 1ULL << pin; > + else > + qval &= ~(1ULL << pin); > + writeq(qval, LOONGSON_GPIO_OUT(lgpio)); > + return; > + } > > - spin_lock(&gpio_lock); > - val = LOONGSON_GPIODATA; > - spin_unlock(&gpio_lock); > + if (!strcmp(lgpio->chip.label, "loongson,ls7a-gpio") || > + !strncmp(lgpio->chip.label, "LOON0002", 8)) { > + if (high) > + bval = 1; > + else > + bval = 0; > + writeb(bval, LOONGSON_GPIO_OUT_BYTE(lgpio, pin)); > + return; > + } > > - return !!(val & BIT(gpio + LOONGSON_GPIO_IN_OFFSET)); > + if (!strcmp(lgpio->chip.label, "loongson,platform-gpio")) { > + if (LOONGSON_GPIODATA) > + LOONGSON_GPIODATA |= BIT(pin); > + else > + LOONGSON_GPIODATA &= ~BIT(pin); > + return; > + } > } > > -static void loongson_gpio_set_value(struct gpio_chip *chip, > - unsigned gpio, int value) > +static int loongson_gpio_direction_input( > + struct gpio_chip *chip, unsigned int pin) > { > - u32 val; > + unsigned long flags; > + struct loongson_gpio_chip *lgpio = > + container_of(chip, struct loongson_gpio_chip, chip); > > - spin_lock(&gpio_lock); > - val = LOONGSON_GPIODATA; > - if (value) > - val |= BIT(gpio); > - else > - val &= ~BIT(gpio); > - LOONGSON_GPIODATA = val; > - spin_unlock(&gpio_lock); > + spin_lock_irqsave(&lgpio->lock, flags); > + __set_direction(lgpio, pin, 1); > + spin_unlock_irqrestore(&lgpio->lock, flags); > + > + return 0; > } > > -static int loongson_gpio_direction_input(struct gpio_chip *chip, unsigned gpio) > +static int loongson_gpio_direction_output( > + struct gpio_chip *chip, unsigned int pin, > + int value) > { > - u32 temp; > + struct loongson_gpio_chip *lgpio = > + container_of(chip, struct loongson_gpio_chip, chip); > + unsigned long flags; > > - spin_lock(&gpio_lock); > - temp = LOONGSON_GPIOIE; > - temp |= BIT(gpio); > - LOONGSON_GPIOIE = temp; > - spin_unlock(&gpio_lock); > + spin_lock_irqsave(&lgpio->lock, flags); > + __set_level(lgpio, pin, value); > + __set_direction(lgpio, pin, 0); > + spin_unlock_irqrestore(&lgpio->lock, flags); > > return 0; > } > > -static int loongson_gpio_direction_output(struct gpio_chip *chip, > - unsigned gpio, int level) > +static int loongson_gpio_get(struct gpio_chip *chip, unsigned int pin) > +{ > + u64 qval; > + u8 bval; > + int val; > + struct loongson_gpio_chip *lgpio = > + container_of(chip, struct loongson_gpio_chip, chip); > + > + if (!strcmp(lgpio->chip.label, "loongson,ls2k-gpio")) { > + qval = readq(LOONGSON_GPIO_IN(lgpio)); > + return ((qval & (1ULL << pin)) != 0); > + } > + > + if (!strcmp(lgpio->chip.label, "loongson,ls7a-gpio") || > + !strncmp(lgpio->chip.label, "LOON0002", 8)) { > + bval = readb(LOONGSON_GPIO_IN_BYTE(lgpio, pin)); > + return (bval & 1); > + } > + > + if (!strcmp(lgpio->chip.label, "loongson,platform-gpio")) { > + val = LOONGSON_GPIODATA; > + return !!(val & BIT(pin + lgpio->in_offset)); > + } > + > + return -ENXIO; > +} > + > +static void loongson_gpio_set(struct gpio_chip *chip, unsigned int pin, > + int value) > { > - u32 temp; > + unsigned long flags; > + struct loongson_gpio_chip *lgpio = > + container_of(chip, struct loongson_gpio_chip, chip); > > - loongson_gpio_set_value(chip, gpio, level); > - spin_lock(&gpio_lock); > - temp = LOONGSON_GPIOIE; > - temp &= ~BIT(gpio); > - LOONGSON_GPIOIE = temp; > - spin_unlock(&gpio_lock); > + spin_lock_irqsave(&lgpio->lock, flags); > + __set_level(lgpio, pin, value); > + spin_unlock_irqrestore(&lgpio->lock, flags); > +} > + > +static int loongson_gpio_to_irq( > + struct gpio_chip *chip, unsigned int offset) > +{ > + struct platform_device *pdev = > + container_of(chip->parent, struct platform_device, dev); > + struct loongson_gpio_chip *lgpio = > + container_of(chip, struct loongson_gpio_chip, chip); > + > + if (offset >= chip->ngpio) > + return -EINVAL; > + > + if ((lgpio->gsi_idx_map != NULL) && (offset < lgpio->mapsize)) > + offset = lgpio->gsi_idx_map[offset]; > + > + return platform_get_irq(pdev, offset); > +} > + > +static int loongson_gpio_init( > + struct device *dev, struct loongson_gpio_chip *lgpio, > + struct device_node *np, void __iomem *base) > +{ > + lgpio->chip.request = loongson_gpio_request; > + lgpio->chip.direction_input = loongson_gpio_direction_input; > + lgpio->chip.get = loongson_gpio_get; > + lgpio->chip.direction_output = loongson_gpio_direction_output; > + lgpio->chip.set = loongson_gpio_set; > + lgpio->chip.can_sleep = 0; > + lgpio->chip.of_node = np; > + lgpio->chip.parent = dev; > + spin_lock_init(&lgpio->lock); > + lgpio->base = (void __iomem *)base; > + > + if (!strcmp(lgpio->chip.label, "loongson,ls7a-gpio") || > + !strncmp(lgpio->chip.label, "LOON0002", 8) || > + !strcmp(lgpio->chip.label, "loongson,ls2k-gpio")) > + lgpio->chip.to_irq = loongson_gpio_to_irq; > + > + gpiochip_add(&lgpio->chip); > > return 0; > } > > +static void of_loongson_gpio_get_props(struct device_node *np, > + struct loongson_gpio_chip *lgpio) > +{ > + const char *name; > + > + of_property_read_u32(np, "ngpios", (u32 *)&lgpio->chip.ngpio); > + > + of_property_read_string(np, "compatible", &name); > + lgpio->chip.label = kstrdup(name, GFP_KERNEL); > + > + if (!strcmp(name, "loongson,ls2k-gpio")) { > + lgpio->support_irq = true; > + lgpio->conf_offset = 0x0; > + lgpio->out_offset = 0x10; > + lgpio->in_offset = 0x20; > + return; > + } > + > + if (!strcmp(name, "loongson,ls7a-gpio")) { > + lgpio->support_irq = true; > + lgpio->conf_offset = 0x800; > + lgpio->out_offset = 0x900; > + lgpio->in_offset = 0xa00; > + return; > + } > +} > + > +static void acpi_loongson_gpio_get_props(struct platform_device *pdev, > + struct loongson_gpio_chip *lgpio) > +{ > + > + struct device *dev = &pdev->dev; > + int rval; > + > + device_property_read_u32(dev, "ngpios", (u32 *)&lgpio->chip.ngpio); > + device_property_read_u32(dev, "gpio_base", (u32 *)&lgpio->chip.base); > + device_property_read_u32(dev, "conf_offset", > + (u32 *)&lgpio->conf_offset); > + device_property_read_u32(dev, "out_offset", > + (u32 *)&lgpio->out_offset); > + device_property_read_u32(dev, "in_offset", (u32 *)&lgpio->in_offset); > + > + rval = device_property_read_u16_array(dev, "gsi_idx_map", NULL, 0); > + if (rval > 0) { > + lgpio->gsi_idx_map = > + kmalloc_array(rval, sizeof(*lgpio->gsi_idx_map), > + GFP_KERNEL); > + if (unlikely(!lgpio->gsi_idx_map)) { > + dev_err(dev, "Alloc gsi_idx_map fail!\n"); > + } else { > + lgpio->mapsize = rval; > + device_property_read_u16_array(dev, "gsi_idx_map", > + lgpio->gsi_idx_map, lgpio->mapsize); > + } > + } > + > + lgpio->chip.label = kstrdup(pdev->name, GFP_KERNEL); > +} > + > +static void platform_loongson_gpio_get_props(struct platform_device *pdev, > + struct loongson_gpio_chip *lgpio) > +{ > + struct loongson_gpio_platform_data *gpio_data = > + (struct loongson_gpio_platform_data *)pdev->dev.platform_data; > + > + lgpio->chip.ngpio = gpio_data->ngpio; > + lgpio->chip.base = gpio_data->gpio_base; > + lgpio->conf_offset = gpio_data->gpio_conf; > + lgpio->out_offset = gpio_data->gpio_out; > + lgpio->in_offset = gpio_data->gpio_in; > + lgpio->chip.label = kstrdup(gpio_data->label, GFP_KERNEL); > +} > + > static int loongson_gpio_probe(struct platform_device *pdev) > { > - struct gpio_chip *gc; > + struct resource *iores; > + void __iomem *base; > + struct loongson_gpio_chip *lgpio; > + struct device_node *np = pdev->dev.of_node; > struct device *dev = &pdev->dev; > + int ret = 0; > > - gc = devm_kzalloc(dev, sizeof(*gc), GFP_KERNEL); > - if (!gc) > + lgpio = kzalloc(sizeof(struct loongson_gpio_chip), GFP_KERNEL); > + if (!lgpio) > return -ENOMEM; > > - gc->label = "loongson-gpio-chip"; > - gc->base = 0; > - gc->ngpio = LOONGSON_N_GPIO; > - gc->get = loongson_gpio_get_value; > - gc->set = loongson_gpio_set_value; > - gc->direction_input = loongson_gpio_direction_input; > - gc->direction_output = loongson_gpio_direction_output; > + if (np) > + of_loongson_gpio_get_props(np, lgpio); > + else if (ACPI_COMPANION(&pdev->dev)) > + acpi_loongson_gpio_get_props(pdev, lgpio); > + else > + platform_loongson_gpio_get_props(pdev, lgpio); > + > + iores = platform_get_resource(pdev, IORESOURCE_MEM, 0); > + if (!iores) { > + ret = -ENODEV; > + goto out; > + } > + > + if (!request_mem_region(iores->start, resource_size(iores), > + pdev->name)) { > + ret = -EBUSY; > + goto out; > + } > + > + base = ioremap(iores->start, resource_size(iores)); > + if (!base) { > + ret = -ENOMEM; > + goto out; > + } > + > + platform_set_drvdata(pdev, lgpio); > + > + loongson_gpio_init(dev, lgpio, np, base); > + > + return 0; > +out: > + pr_err("%s: %s: missing mandatory property\n", __func__, np->name); > + return ret; > +} > + > +static int loongson_gpio_remove(struct platform_device *pdev) > +{ > + struct loongson_gpio_chip *lgpio = platform_get_drvdata(pdev); > + struct resource *mem; > + > + platform_set_drvdata(pdev, NULL); > > - return gpiochip_add_data(gc, NULL); > + gpiochip_remove(&lgpio->chip); > + iounmap(lgpio->base); > + kfree(lgpio->gsi_idx_map); > + kfree(lgpio); > + mem = platform_get_resource(pdev, IORESOURCE_MEM, 0); > + release_mem_region(mem->start, resource_size(mem)); > + > + return 0; > } > > +static const struct of_device_id loongson_gpio_dt_ids[] = { > + { .compatible = "loongson,ls2k-gpio"}, > + { .compatible = "loongson,ls7a-gpio"}, > + {} > +}; > +MODULE_DEVICE_TABLE(of, loongson_gpio_dt_ids); > + > +static const struct acpi_device_id loongson_gpio_acpi_match[] = { > + {"LOON0002"}, > + {} > +}; > +MODULE_DEVICE_TABLE(acpi, loongson_gpio_acpi_match); > + > static struct platform_driver loongson_gpio_driver = { > .driver = { > .name = "loongson-gpio", > + .owner = THIS_MODULE, > + .of_match_table = loongson_gpio_dt_ids, > + .acpi_match_table = ACPI_PTR(loongson_gpio_acpi_match), > }, > .probe = loongson_gpio_probe, > + .remove = loongson_gpio_remove, > }; > > static int __init loongson_gpio_setup(void) > { > - struct platform_device *pdev; > - int ret; > - > - ret = platform_driver_register(&loongson_gpio_driver); > - if (ret) { > - pr_err("error registering loongson GPIO driver\n"); > - return ret; > - } > - > - pdev = platform_device_register_simple("loongson-gpio", -1, NULL, 0); > - return PTR_ERR_OR_ZERO(pdev); > + return platform_driver_register(&loongson_gpio_driver); > } > postcore_initcall(loongson_gpio_setup); > + > +static void __exit loongson_gpio_exit(void) > +{ > + platform_driver_unregister(&loongson_gpio_driver); > +} > diff --git a/include/linux/platform_data/gpio-loongson.h b/include/linux/platform_data/gpio-loongson.h > new file mode 100644 > index 000000000000..f102d2650576 > --- /dev/null > +++ b/include/linux/platform_data/gpio-loongson.h > @@ -0,0 +1,22 @@ > +/* SPDX-License-Identifier: GPL-2.0+ */ > +/* > + * Author: Yinbo Zhu > + * Copyright (C) 2022-2023 Loongson Technology Corporation Limited > + */ > + > +#ifndef __LOONGSON_GPIO_PLATFORM_H > +#define __LOONGSON_GPIO_PLATFORM_H > + > +/* ============== Data structrues =============== */ > + > +struct loongson_gpio_platform_data { > + u32 gpio_conf; > + u32 gpio_out; > + u32 gpio_in; > + u32 support_irq; > + char *label; > + int gpio_base; > + int ngpio; > +}; > + > +#endif >