linux-imx

// SPDX-License-Identifier: GPL-2.0

/*

 * Driver core interface to the pinctrl subsystem.

 *

 * Copyright (C) 2012 ST-Ericsson SA

 * Written on behalf of Linaro for ST-Ericsson

 * Based on bits of regulator core, gpio core and clk core

 *

 * Author: Linus Walleij <linus.walleij@linaro.org>

 */

​

#include <linux/device.h>

#include <linux/pinctrl/devinfo.h>

#include <linux/pinctrl/consumer.h>

#include <linux/slab.h>

​

/**

 * pinctrl_bind_pins() - called by the device core before probe

 * @dev: the device that is just about to probe

 */

int pinctrl_bind_pins(struct device *dev)

{

    int ret;

​

    if (dev->of_node_reused)

        return 0;

​

    dev->pins = devm_kzalloc(dev, sizeof(*(dev->pins)), GFP_KERNEL);

    if (!dev->pins)

        return -ENOMEM;

​

    dev->pins->p = devm_pinctrl_get(dev);

    if (IS_ERR(dev->pins->p)) {

        dev_dbg(dev, "no pinctrl handle\n");

        ret = PTR_ERR(dev->pins->p);

        goto cleanup_alloc;

    }

​

    dev->pins->default_state = pinctrl_lookup_state(dev->pins->p,

                    PINCTRL_STATE_DEFAULT);

    if (IS_ERR(dev->pins->default_state)) {

        dev_dbg(dev, "no default pinctrl state\n");

        ret = 0;

        goto cleanup_get;

    }

​

    dev->pins->init_state = pinctrl_lookup_state(dev->pins->p,

                    PINCTRL_STATE_INIT);

    if (IS_ERR(dev->pins->init_state)) {

        /* Not supplying this state is perfectly legal */

        dev_dbg(dev, "no init pinctrl state\n");

​

        ret = pinctrl_select_state(dev->pins->p,

                       dev->pins->default_state);

    } else {

        ret = pinctrl_select_state(dev->pins->p, dev->pins->init_state);

    }

​

    if (ret) {

        dev_dbg(dev, "failed to activate initial pinctrl state\n");

        goto cleanup_get;

    }

​