[PATCH v6 3/3] pinctrl: nuvoton: Add ma35d1 pinctrl and GPIO driver

Jacky Huang ychuang570808 at gmail.com
Wed Mar 13 03:25:34 PDT 2024



On 2024/3/13 下午 04:04, Dan Carpenter wrote:
> On Wed, Mar 13, 2024 at 03:57:19AM +0000, Jacky Huang wrote:
>> +static int ma35_gpiolib_register(struct platform_device *pdev, struct ma35_pinctrl *npctl)
>> +{
>> +	struct ma35_pin_ctrl *ctrl = npctl->ctrl;
>> +	struct ma35_pin_bank *bank = ctrl->pin_banks;
>> +	int ret;
>> +	int i;
>> +
>> +	for (i = 0; i < ctrl->nr_banks; ++i, ++bank) {
>> +		if (!bank->valid) {
>> +			dev_warn(&pdev->dev, "bank %s is not valid\n",
>> +				 bank->np->name);
>> +			continue;
>> +		}
>> +		bank->irqtype = 0;
>> +		bank->irqinten = 0;
>> +		bank->chip.label = bank->name;
>> +		bank->chip.of_gpio_n_cells = 2;
>> +		bank->chip.parent = &pdev->dev;
>> +		bank->chip.request = ma35_gpio_core_to_request;
>> +		bank->chip.direction_input = ma35_gpio_core_direction_in;
>> +		bank->chip.direction_output = ma35_gpio_core_direction_out;
>> +		bank->chip.get = ma35_gpio_core_get;
>> +		bank->chip.set = ma35_gpio_core_set;
>> +		bank->chip.base = -1;
>> +		bank->chip.ngpio = bank->nr_pins;
>> +		bank->chip.can_sleep = false;
>> +		spin_lock_init(&bank->lock);
>> +
>> +		if (bank->irq > 0) {
>> +			struct gpio_irq_chip *girq;
>> +
>> +			girq = &bank->chip.irq;
>> +			gpio_irq_chip_set_chip(girq, &ma35_gpio_irqchip);
>> +			girq->parent_handler = ma35_irq_demux_intgroup;
>> +			girq->num_parents = 1;
>> +
>> +			girq->parents = devm_kcalloc(&pdev->dev, 1, sizeof(*girq->parents),
>> +						     GFP_KERNEL);
>> +			if (!girq->parents)
>> +				return -ENOMEM;
> ret = -ENOMEM;
> goto fail;
>
> regards,
> dan carpenter

Thanks, I will fix it.

>> +
>> +			girq->parents[0] = bank->irq;
>> +			girq->default_type = IRQ_TYPE_NONE;
>> +			girq->handler = handle_level_irq;
>> +		}
>> +
>> +		ret = gpiochip_add_data(&bank->chip, bank);
>> +		if (ret) {
>> +			dev_err(&pdev->dev, "failed to register gpio_chip %s, error code: %d\n",
>> +				bank->chip.label, ret);
>> +			goto fail;
>> +		}
>> +	}
>> +	return 0;
>> +
>> +fail:
>> +	for (--i, --bank; i >= 0; --i, --bank) {
>> +		if (!bank->valid)
>> +			continue;
>> +		gpiochip_remove(&bank->chip);
>> +	}
>> +	return ret;
>> +}

Best Regards,
Jacky Huang




More information about the linux-arm-kernel mailing list