linux-imx

/*

 *  linux/drivers/pinctrl/pinctrl-lantiq.c

 *  based on linux/drivers/pinctrl/pinctrl-pxa3xx.c

 *

 *  This program is free software; you can redistribute it and/or modify

 *  it under the terms of the GNU General Public License version 2 as

 *  publishhed by the Free Software Foundation.

 *

 *  Copyright (C) 2012 John Crispin <john@phrozen.org>

 */

​

#include <linux/module.h>

#include <linux/device.h>

#include <linux/io.h>

#include <linux/platform_device.h>

#include <linux/slab.h>

#include <linux/of.h>

​

#include "pinctrl-lantiq.h"

​

static int ltq_get_group_count(struct pinctrl_dev *pctrldev)

{

    struct ltq_pinmux_info *info = pinctrl_dev_get_drvdata(pctrldev);

    return info->num_grps;

}

​

static const char *ltq_get_group_name(struct pinctrl_dev *pctrldev,

                     unsigned selector)

{

    struct ltq_pinmux_info *info = pinctrl_dev_get_drvdata(pctrldev);

    if (selector >= info->num_grps)

        return NULL;

    return info->grps[selector].name;

}

​

static int ltq_get_group_pins(struct pinctrl_dev *pctrldev,

                 unsigned selector,

                 const unsigned **pins,

                 unsigned *num_pins)

{

    struct ltq_pinmux_info *info = pinctrl_dev_get_drvdata(pctrldev);

    if (selector >= info->num_grps)

        return -EINVAL;

    *pins = info->grps[selector].pins;

    *num_pins = info->grps[selector].npins;

    return 0;

}

​

static void ltq_pinctrl_dt_free_map(struct pinctrl_dev *pctldev,

                    struct pinctrl_map *map, unsigned num_maps)

{

    int i;

​

    for (i = 0; i < num_maps; i++)

        if (map[i].type == PIN_MAP_TYPE_CONFIGS_PIN ||

            map[i].type == PIN_MAP_TYPE_CONFIGS_GROUP)

            kfree(map[i].data.configs.configs);

    kfree(map);

}

​

static void ltq_pinctrl_pin_dbg_show(struct pinctrl_dev *pctldev,

                    struct seq_file *s,

                    unsigned offset)

{

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

}

​

static void ltq_pinctrl_dt_subnode_to_map(struct pinctrl_dev *pctldev,

                struct device_node *np,

                struct pinctrl_map **map)

{

    struct ltq_pinmux_info *info = pinctrl_dev_get_drvdata(pctldev);

    struct property *pins = of_find_property(np, "lantiq,pins", NULL);

    struct property *groups = of_find_property(np, "lantiq,groups", NULL);

    unsigned long configs[3];

    unsigned num_configs = 0;

    struct property *prop;

    const char *group, *pin;

    const char *function;

    int ret, i;

​

    if (!pins && !groups) {

        dev_err(pctldev->dev, "%pOFn defines neither pins nor groups\n",

            np);

        return;

    }

​

    if (pins && groups) {

        dev_err(pctldev->dev, "%pOFn defines both pins and groups\n",

            np);

        return;

    }