linux-imx

// SPDX-License-Identifier: GPL-2.0+

//

// Core driver for the imx pin controller

//

// Copyright (C) 2012 Freescale Semiconductor, Inc.

// Copyright (C) 2012 Linaro Ltd.

//

// Author: Dong Aisheng <dong.aisheng@linaro.org>

​

#include <linux/err.h>

#include <linux/init.h>

#include <linux/io.h>

#include <linux/mfd/syscon.h>

#include <linux/of.h>

#include <linux/of_device.h>

#include <linux/of_address.h>

#include <linux/pinctrl/machine.h>

#include <linux/pinctrl/pinconf.h>

#include <linux/pinctrl/pinctrl.h>

#include <linux/pinctrl/pinmux.h>

#include <linux/slab.h>

#include <linux/regmap.h>

​

#include "../core.h"

#include "../pinconf.h"

#include "../pinmux.h"

#include "pinctrl-imx.h"

​

/* The bits in CONFIG cell defined in binding doc*/

#define IMX_NO_PAD_CTL  0x80000000  /* no pin config need */

#define IMX_PAD_SION 0x40000000     /* set SION */

​

static inline const struct group_desc *imx_pinctrl_find_group_by_name(

                struct pinctrl_dev *pctldev,

                const char *name)

{

    const struct group_desc *grp = NULL;

    int i;

​

    for (i = 0; i < pctldev->num_groups; i++) {

        grp = pinctrl_generic_get_group(pctldev, i);

        if (grp && !strcmp(grp->name, name))

            break;

    }

​

    return grp;

}

​

static void imx_pin_dbg_show(struct pinctrl_dev *pctldev, struct seq_file *s,

           unsigned offset)

{

    seq_printf(s, "%s", dev_name(pctldev->dev));

}

​

static int imx_dt_node_to_map(struct pinctrl_dev *pctldev,

            struct device_node *np,

            struct pinctrl_map **map, unsigned *num_maps)

{

    struct imx_pinctrl *ipctl = pinctrl_dev_get_drvdata(pctldev);

    const struct imx_pinctrl_soc_info *info = ipctl->info;

    const struct group_desc *grp;

    struct pinctrl_map *new_map;

    struct device_node *parent;

    struct imx_pin *pin;

    int map_num = 1;

    int i, j;

​

    /*

     * first find the group of this node and check if we need create

     * config maps for pins

     */

    grp = imx_pinctrl_find_group_by_name(pctldev, np->name);

    if (!grp) {

        dev_err(ipctl->dev, "unable to find group for node %pOFn\n", np);

        return -EINVAL;

    }

​

    if (info->flags & IMX_USE_SCU) {

        map_num += grp->num_pins;

    } else {

        for (i = 0; i < grp->num_pins; i++) {

            pin = &((struct imx_pin *)(grp->data))[i];

            if (!(pin->conf.mmio.config & IMX_NO_PAD_CTL))

                map_num++;

        }

    }

​

    new_map = kmalloc_array(map_num, sizeof(struct pinctrl_map),

                GFP_KERNEL);

    if (!new_map)

        return -ENOMEM;

​