Received: by 2002:a05:6358:d09b:b0:dc:cd0c:909e with SMTP id jc27csp1457760rwb; Wed, 16 Nov 2022 18:36:21 -0800 (PST) X-Google-Smtp-Source: AA0mqf6VbFAdVAsJadTFjAPm6Oa6qsuanBogvIts7wDLuttwZ50yDKxD3pctXRwuJh7+L2uRiDrB X-Received: by 2002:aa7:9e4f:0:b0:56b:f3b2:5543 with SMTP id z15-20020aa79e4f000000b0056bf3b25543mr893399pfq.65.1668652581577; Wed, 16 Nov 2022 18:36:21 -0800 (PST) ARC-Seal: i=1; a=rsa-sha256; t=1668652581; cv=none; d=google.com; s=arc-20160816; b=b3dzrzQNSmyp0UmaxLgxzOcAn8U3eR+ZD2FIlwfPtSc+Q2IhNw7YG7MZx+JDsH0xfT o75ihULDkhNwgljHcp0QkZbPlwRl8zuXi4BUXckluzzcli7cjwhyjjjomdT9rq/NTUAP 9rgvszgm4FZuNnibBnYZLzBC4NvgqFe/JeQDGwgCF7rFg5qAq1SNOZ8sgyvvosWMjJyu UPOojlyNAEkPj2VgrZNZvNa0MJpl0WBUx1qPcTsWfrTdgJ9ML74pSMEERyHs5KmMyeFD jtVyfy7lhW5wmCBXYHlmd8kEiCTUNcWtFXPrgF4PZQtcSThCGMSnqc5OAigAs0+6/ApU JAwQ== 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=cdmFZq2Uil7nqHGQhl4/d8rhqegI6C4nEWGbx7GwZ4s=; b=kg4onwOS7Ru038dP/U183YXGglE5+aePnFW3+DYnbrdXlV+lPt2ZWuII7U1KysPh9H dhAS4dcoD4N2Ydc8rXymEdqEV/z2FFlqq5NXYd5JufXFZIjSHPra4CQYJbL+N8bpykzB ddebCFrNaSc2uEXwhTTkUSRttNQBhjET64FkuIodNuUAqgSDo/6WkxHbFFM31U2iUVxH ErPTJrD8gMwfxoL5+AxPJBPYDT/K+bUyTp+/mRrE7ihK7l3qTQtVzHFQzXXYlI6wLyaI 5MjRV+NC8sjV0IYYOzR00NWN7yKEQ5QfEcyjo6ZR3OKvZ0WE9G6tH5pR6OytojS5FW/b WTUw== 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 l4-20020a17090270c400b00186a16f8d94si15360830plt.77.2022.11.16.18.36.07; Wed, 16 Nov 2022 18:36:21 -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 S237885AbiKQBqq (ORCPT + 90 others); Wed, 16 Nov 2022 20:46:46 -0500 Received: from lindbergh.monkeyblade.net ([23.128.96.19]:44572 "EHLO lindbergh.monkeyblade.net" rhost-flags-OK-OK-OK-OK) by vger.kernel.org with ESMTP id S229939AbiKQBqn (ORCPT ); Wed, 16 Nov 2022 20:46:43 -0500 Received: from loongson.cn (mail.loongson.cn [114.242.206.163]) by lindbergh.monkeyblade.net (Postfix) with ESMTP id 5F3C26A6AB; Wed, 16 Nov 2022 17:46:39 -0800 (PST) Received: from loongson.cn (unknown [10.180.13.64]) by gateway (Coremail) with SMTP id _____8BxLtt9knVjtiAIAA--.23339S3; Thu, 17 Nov 2022 09:46:37 +0800 (CST) Received: from [10.180.13.64] (unknown [10.180.13.64]) by localhost.localdomain (Coremail) with SMTP id AQAAf8Cx5VZ4knVjH40VAA--.38066S2; Thu, 17 Nov 2022 09:46:34 +0800 (CST) Subject: Re: [PATCH v3 1/2] gpio: loongson: add dts/acpi gpio support To: Qing Zhang , 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> <086f8ff4-563d-8f4d-585e-59205854f66c@loongson.cn> From: Yinbo Zhu Message-ID: <54570b0b-7b9c-2838-0653-d1cc3ad424eb@loongson.cn> Date: Thu, 17 Nov 2022 09:46:32 +0800 User-Agent: Mozilla/5.0 (X11; Linux loongarch64; rv:68.0) Gecko/20100101 Thunderbird/68.7.0 MIME-Version: 1.0 In-Reply-To: <086f8ff4-563d-8f4d-585e-59205854f66c@loongson.cn> Content-Type: text/plain; charset=utf-8; format=flowed Content-Language: en-US Content-Transfer-Encoding: 8bit X-CM-TRANSID: AQAAf8Cx5VZ4knVjH40VAA--.38066S2 X-CM-SenderInfo: 52kx5xhqerqz5rrqw2lrqou0/ X-Coremail-Antispam: 1Uk129KBjvAXoWfAw1rWrWxuF45uF1fArWUArb_yoW5JryfKo W7Kr1rXrWrJr1jgr1UJr15XF13XF1UJrnFyr17Gry7JF1YyF1UG3yUJrW3t3yUJF1rGryU JFy7GrWIyFy7tF15n29KB7ZKAUJUUUUf529EdanIXcx71UUUUU7KY7ZEXasCq-sGcSsGvf J3Ic02F40EFcxC0VAKzVAqx4xG6I80ebIjqfuFe4nvWSU5nxnvy29KBjDU0xBIdaVrnRJU UUP21xkIjI8I6I8E6xAIw20EY4v20xvaj40_Wr0E3s1l1IIY67AEw4v_Jrv_JF1l8cAvFV AK0II2c7xJM28CjxkF64kEwVA0rcxSw2x7M28EF7xvwVC0I7IYx2IY67AKxVW5JVW7JwA2 z4x0Y4vE2Ix0cI8IcVCY1x0267AKxVWxJVW8Jr1l84ACjcxK6I8E87Iv67AKxVW8Jr0_Cr 1UM28EF7xvwVC2z280aVCY1x0267AKxVW8Jr0_Cr1UM2kKe7AKxVWUAVWUtwAS0I0E0xvY zxvE52x082IY62kv0487Mc804VCY07AIYIkI8VC2zVCFFI0UMc02F40EFcxC0VAKzVAqx4 xG6I80ewAv7VC0I7IYx2IY67AKxVWUAVWUtwAv7VC2z280aVAFwI0_Jr0_Gr1lOx8S6xCa FVCjc4AY6r1j6r4UM4x0Y48IcVAKI48JMxk0xIA0c2IEe2xFo4CEbIxvr21lc7CjxVAaw2 AFwI0_Jw0_GFyl42xK82IYc2Ij64vIr41l42xK82IY6x8ErcxFaVAv8VWrMxC20s026xCa FVCjc4AY6r1j6r4UMxCIbckI1I0E14v26r126r1DMI8I3I0E5I8CrVAFwI0_Jr0_Jr4lx2 IqxVCjr7xvwVAFwI0_JrI_JrWlx4CE17CEb7AF67AKxVW8ZVWrXwCIc40Y0x0EwIxGrwCI 42IY6xIIjxv20xvE14v26r1I6r4UMIIF0xvE2Ix0cI8IcVCY1x0267AKxVW8JVWxJwCI42 IY6xAIw20EY4v20xvaj40_Jr0_JF4lIxAIcVC2z280aVAFwI0_Jr0_Gr1lIxAIcVC2z280 aVCY1x0267AKxVW8JVW8JrUvcSsGvfC2KfnxnUUI43ZEXa7IU81lk3UUUUU== 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 在 2022/11/16 下午6:03, Qing Zhang 写道: > 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 in fact, I have verified about 2k, but I don't plan add dts for mips. and mips was use legacy platform driver but need add a gpio device driver to register device. for legacy platform if someone uses it, add it. and I will adopt your advice to delete "cpu_loongson64". Tks, Yinbo. >>       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 >>