2012-02-01 21:04:47 +00:00
|
|
|
/*
|
|
|
|
* Driver for the NVIDIA Tegra pinmux
|
|
|
|
*
|
2012-04-11 18:53:09 +00:00
|
|
|
* Copyright (c) 2011-2012, NVIDIA CORPORATION. All rights reserved.
|
2012-02-01 21:04:47 +00:00
|
|
|
*
|
|
|
|
* Derived from code:
|
|
|
|
* Copyright (C) 2010 Google, Inc.
|
|
|
|
* Copyright (C) 2010 NVIDIA Corporation
|
|
|
|
* Copyright (C) 2009-2011 ST-Ericsson AB
|
|
|
|
*
|
|
|
|
* This program is free software; you can redistribute it and/or modify it
|
|
|
|
* under the terms and conditions of the GNU General Public License,
|
|
|
|
* version 2, as published by the Free Software Foundation.
|
|
|
|
*
|
|
|
|
* This program is distributed in the hope it will be useful, but WITHOUT
|
|
|
|
* ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or
|
|
|
|
* FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for
|
|
|
|
* more details.
|
|
|
|
*/
|
|
|
|
|
|
|
|
#include <linux/err.h>
|
|
|
|
#include <linux/init.h>
|
|
|
|
#include <linux/io.h>
|
|
|
|
#include <linux/module.h>
|
2012-04-11 18:53:09 +00:00
|
|
|
#include <linux/of.h>
|
|
|
|
#include <linux/platform_device.h>
|
2012-04-04 15:27:50 +00:00
|
|
|
#include <linux/pinctrl/machine.h>
|
2012-02-01 21:04:47 +00:00
|
|
|
#include <linux/pinctrl/pinctrl.h>
|
|
|
|
#include <linux/pinctrl/pinmux.h>
|
|
|
|
#include <linux/pinctrl/pinconf.h>
|
2012-04-04 15:27:50 +00:00
|
|
|
#include <linux/slab.h>
|
2012-02-01 21:04:47 +00:00
|
|
|
|
2012-04-11 18:53:09 +00:00
|
|
|
#include "core.h"
|
2012-02-01 21:04:47 +00:00
|
|
|
#include "pinctrl-tegra.h"
|
2013-08-21 11:23:38 +00:00
|
|
|
#include "pinctrl-utils.h"
|
2012-02-01 21:04:47 +00:00
|
|
|
|
|
|
|
struct tegra_pmx {
|
|
|
|
struct device *dev;
|
|
|
|
struct pinctrl_dev *pctl;
|
|
|
|
|
|
|
|
const struct tegra_pinctrl_soc_data *soc;
|
2014-03-07 19:22:16 +00:00
|
|
|
const char **group_pins;
|
2012-02-01 21:04:47 +00:00
|
|
|
|
|
|
|
int nbanks;
|
|
|
|
void __iomem **regs;
|
|
|
|
};
|
|
|
|
|
|
|
|
static inline u32 pmx_readl(struct tegra_pmx *pmx, u32 bank, u32 reg)
|
|
|
|
{
|
|
|
|
return readl(pmx->regs[bank] + reg);
|
|
|
|
}
|
|
|
|
|
|
|
|
static inline void pmx_writel(struct tegra_pmx *pmx, u32 val, u32 bank, u32 reg)
|
|
|
|
{
|
|
|
|
writel(val, pmx->regs[bank] + reg);
|
|
|
|
}
|
|
|
|
|
2012-03-30 05:55:40 +00:00
|
|
|
static int tegra_pinctrl_get_groups_count(struct pinctrl_dev *pctldev)
|
2012-02-01 21:04:47 +00:00
|
|
|
{
|
|
|
|
struct tegra_pmx *pmx = pinctrl_dev_get_drvdata(pctldev);
|
|
|
|
|
2012-03-30 05:55:40 +00:00
|
|
|
return pmx->soc->ngroups;
|
2012-02-01 21:04:47 +00:00
|
|
|
}
|
|
|
|
|
|
|
|
static const char *tegra_pinctrl_get_group_name(struct pinctrl_dev *pctldev,
|
|
|
|
unsigned group)
|
|
|
|
{
|
|
|
|
struct tegra_pmx *pmx = pinctrl_dev_get_drvdata(pctldev);
|
|
|
|
|
|
|
|
return pmx->soc->groups[group].name;
|
|
|
|
}
|
|
|
|
|
|
|
|
static int tegra_pinctrl_get_group_pins(struct pinctrl_dev *pctldev,
|
|
|
|
unsigned group,
|
|
|
|
const unsigned **pins,
|
|
|
|
unsigned *num_pins)
|
|
|
|
{
|
|
|
|
struct tegra_pmx *pmx = pinctrl_dev_get_drvdata(pctldev);
|
|
|
|
|
|
|
|
*pins = pmx->soc->groups[group].pins;
|
|
|
|
*num_pins = pmx->soc->groups[group].npins;
|
|
|
|
|
|
|
|
return 0;
|
|
|
|
}
|
|
|
|
|
2012-04-11 21:42:56 +00:00
|
|
|
#ifdef CONFIG_DEBUG_FS
|
2012-02-01 21:04:47 +00:00
|
|
|
static void tegra_pinctrl_pin_dbg_show(struct pinctrl_dev *pctldev,
|
|
|
|
struct seq_file *s,
|
|
|
|
unsigned offset)
|
|
|
|
{
|
2012-04-11 18:53:09 +00:00
|
|
|
seq_printf(s, " %s", dev_name(pctldev->dev));
|
2012-02-01 21:04:47 +00:00
|
|
|
}
|
2012-04-11 21:42:56 +00:00
|
|
|
#endif
|
2012-02-01 21:04:47 +00:00
|
|
|
|
2012-04-04 15:27:50 +00:00
|
|
|
static const struct cfg_param {
|
|
|
|
const char *property;
|
|
|
|
enum tegra_pinconf_param param;
|
|
|
|
} cfg_params[] = {
|
|
|
|
{"nvidia,pull", TEGRA_PINCONF_PARAM_PULL},
|
|
|
|
{"nvidia,tristate", TEGRA_PINCONF_PARAM_TRISTATE},
|
|
|
|
{"nvidia,enable-input", TEGRA_PINCONF_PARAM_ENABLE_INPUT},
|
|
|
|
{"nvidia,open-drain", TEGRA_PINCONF_PARAM_OPEN_DRAIN},
|
|
|
|
{"nvidia,lock", TEGRA_PINCONF_PARAM_LOCK},
|
|
|
|
{"nvidia,io-reset", TEGRA_PINCONF_PARAM_IORESET},
|
2013-01-08 07:32:36 +00:00
|
|
|
{"nvidia,rcv-sel", TEGRA_PINCONF_PARAM_RCV_SEL},
|
2015-02-24 21:00:50 +00:00
|
|
|
{"nvidia,io-hv", TEGRA_PINCONF_PARAM_RCV_SEL},
|
2012-04-04 15:27:50 +00:00
|
|
|
{"nvidia,high-speed-mode", TEGRA_PINCONF_PARAM_HIGH_SPEED_MODE},
|
|
|
|
{"nvidia,schmitt", TEGRA_PINCONF_PARAM_SCHMITT},
|
|
|
|
{"nvidia,low-power-mode", TEGRA_PINCONF_PARAM_LOW_POWER_MODE},
|
|
|
|
{"nvidia,pull-down-strength", TEGRA_PINCONF_PARAM_DRIVE_DOWN_STRENGTH},
|
|
|
|
{"nvidia,pull-up-strength", TEGRA_PINCONF_PARAM_DRIVE_UP_STRENGTH},
|
|
|
|
{"nvidia,slew-rate-falling", TEGRA_PINCONF_PARAM_SLEW_RATE_FALLING},
|
|
|
|
{"nvidia,slew-rate-rising", TEGRA_PINCONF_PARAM_SLEW_RATE_RISING},
|
2013-01-08 07:32:36 +00:00
|
|
|
{"nvidia,drive-type", TEGRA_PINCONF_PARAM_DRIVE_TYPE},
|
2012-04-04 15:27:50 +00:00
|
|
|
};
|
|
|
|
|
2013-08-21 11:23:38 +00:00
|
|
|
static int tegra_pinctrl_dt_subnode_to_map(struct pinctrl_dev *pctldev,
|
2012-11-11 02:31:31 +00:00
|
|
|
struct device_node *np,
|
|
|
|
struct pinctrl_map **map,
|
|
|
|
unsigned *reserved_maps,
|
|
|
|
unsigned *num_maps)
|
2012-04-04 15:27:50 +00:00
|
|
|
{
|
2013-08-21 11:23:38 +00:00
|
|
|
struct device *dev = pctldev->dev;
|
2012-04-04 15:27:50 +00:00
|
|
|
int ret, i;
|
|
|
|
const char *function;
|
|
|
|
u32 val;
|
|
|
|
unsigned long config;
|
|
|
|
unsigned long *configs = NULL;
|
|
|
|
unsigned num_configs = 0;
|
|
|
|
unsigned reserve;
|
|
|
|
struct property *prop;
|
|
|
|
const char *group;
|
|
|
|
|
|
|
|
ret = of_property_read_string(np, "nvidia,function", &function);
|
2012-04-23 16:05:22 +00:00
|
|
|
if (ret < 0) {
|
|
|
|
/* EINVAL=missing, which is fine since it's optional */
|
|
|
|
if (ret != -EINVAL)
|
|
|
|
dev_err(dev,
|
|
|
|
"could not parse property nvidia,function\n");
|
2012-04-04 15:27:50 +00:00
|
|
|
function = NULL;
|
2012-04-23 16:05:22 +00:00
|
|
|
}
|
2012-04-04 15:27:50 +00:00
|
|
|
|
|
|
|
for (i = 0; i < ARRAY_SIZE(cfg_params); i++) {
|
|
|
|
ret = of_property_read_u32(np, cfg_params[i].property, &val);
|
|
|
|
if (!ret) {
|
|
|
|
config = TEGRA_PINCONF_PACK(cfg_params[i].param, val);
|
2013-08-21 11:23:38 +00:00
|
|
|
ret = pinctrl_utils_add_config(pctldev, &configs,
|
|
|
|
&num_configs, config);
|
2012-04-04 15:27:50 +00:00
|
|
|
if (ret < 0)
|
|
|
|
goto exit;
|
2012-04-23 16:05:22 +00:00
|
|
|
/* EINVAL=missing, which is fine since it's optional */
|
|
|
|
} else if (ret != -EINVAL) {
|
|
|
|
dev_err(dev, "could not parse property %s\n",
|
|
|
|
cfg_params[i].property);
|
2012-04-04 15:27:50 +00:00
|
|
|
}
|
|
|
|
}
|
|
|
|
|
|
|
|
reserve = 0;
|
|
|
|
if (function != NULL)
|
|
|
|
reserve++;
|
|
|
|
if (num_configs)
|
|
|
|
reserve++;
|
|
|
|
ret = of_property_count_strings(np, "nvidia,pins");
|
2012-04-23 16:05:22 +00:00
|
|
|
if (ret < 0) {
|
|
|
|
dev_err(dev, "could not parse property nvidia,pins\n");
|
2012-04-04 15:27:50 +00:00
|
|
|
goto exit;
|
2012-04-23 16:05:22 +00:00
|
|
|
}
|
2012-04-04 15:27:50 +00:00
|
|
|
reserve *= ret;
|
|
|
|
|
2013-08-21 11:23:38 +00:00
|
|
|
ret = pinctrl_utils_reserve_map(pctldev, map, reserved_maps,
|
|
|
|
num_maps, reserve);
|
2012-04-04 15:27:50 +00:00
|
|
|
if (ret < 0)
|
|
|
|
goto exit;
|
|
|
|
|
|
|
|
of_property_for_each_string(np, "nvidia,pins", prop, group) {
|
|
|
|
if (function) {
|
2013-08-21 11:23:38 +00:00
|
|
|
ret = pinctrl_utils_add_map_mux(pctldev, map,
|
|
|
|
reserved_maps, num_maps, group,
|
|
|
|
function);
|
2012-04-04 15:27:50 +00:00
|
|
|
if (ret < 0)
|
|
|
|
goto exit;
|
|
|
|
}
|
|
|
|
|
|
|
|
if (num_configs) {
|
2013-08-21 11:23:38 +00:00
|
|
|
ret = pinctrl_utils_add_map_configs(pctldev, map,
|
|
|
|
reserved_maps, num_maps, group,
|
|
|
|
configs, num_configs,
|
|
|
|
PIN_MAP_TYPE_CONFIGS_GROUP);
|
2012-04-04 15:27:50 +00:00
|
|
|
if (ret < 0)
|
|
|
|
goto exit;
|
|
|
|
}
|
|
|
|
}
|
|
|
|
|
|
|
|
ret = 0;
|
|
|
|
|
|
|
|
exit:
|
|
|
|
kfree(configs);
|
|
|
|
return ret;
|
|
|
|
}
|
|
|
|
|
2012-11-11 02:31:31 +00:00
|
|
|
static int tegra_pinctrl_dt_node_to_map(struct pinctrl_dev *pctldev,
|
|
|
|
struct device_node *np_config,
|
|
|
|
struct pinctrl_map **map,
|
|
|
|
unsigned *num_maps)
|
2012-04-04 15:27:50 +00:00
|
|
|
{
|
|
|
|
unsigned reserved_maps;
|
|
|
|
struct device_node *np;
|
|
|
|
int ret;
|
|
|
|
|
|
|
|
reserved_maps = 0;
|
|
|
|
*map = NULL;
|
|
|
|
*num_maps = 0;
|
|
|
|
|
|
|
|
for_each_child_of_node(np_config, np) {
|
2013-08-21 11:23:38 +00:00
|
|
|
ret = tegra_pinctrl_dt_subnode_to_map(pctldev, np, map,
|
2012-04-23 16:05:22 +00:00
|
|
|
&reserved_maps, num_maps);
|
2012-04-04 15:27:50 +00:00
|
|
|
if (ret < 0) {
|
2013-08-21 11:23:38 +00:00
|
|
|
pinctrl_utils_dt_free_map(pctldev, *map,
|
|
|
|
*num_maps);
|
2012-04-04 15:27:50 +00:00
|
|
|
return ret;
|
|
|
|
}
|
|
|
|
}
|
|
|
|
|
|
|
|
return 0;
|
|
|
|
}
|
|
|
|
|
2013-02-16 09:25:07 +00:00
|
|
|
static const struct pinctrl_ops tegra_pinctrl_ops = {
|
2012-03-30 05:55:40 +00:00
|
|
|
.get_groups_count = tegra_pinctrl_get_groups_count,
|
2012-02-01 21:04:47 +00:00
|
|
|
.get_group_name = tegra_pinctrl_get_group_name,
|
|
|
|
.get_group_pins = tegra_pinctrl_get_group_pins,
|
2012-04-11 21:42:56 +00:00
|
|
|
#ifdef CONFIG_DEBUG_FS
|
2012-02-01 21:04:47 +00:00
|
|
|
.pin_dbg_show = tegra_pinctrl_pin_dbg_show,
|
2012-04-11 21:42:56 +00:00
|
|
|
#endif
|
2012-04-04 15:27:50 +00:00
|
|
|
.dt_node_to_map = tegra_pinctrl_dt_node_to_map,
|
2013-08-21 11:23:38 +00:00
|
|
|
.dt_free_map = pinctrl_utils_dt_free_map,
|
2012-02-01 21:04:47 +00:00
|
|
|
};
|
|
|
|
|
2012-03-30 05:55:40 +00:00
|
|
|
static int tegra_pinctrl_get_funcs_count(struct pinctrl_dev *pctldev)
|
2012-02-01 21:04:47 +00:00
|
|
|
{
|
|
|
|
struct tegra_pmx *pmx = pinctrl_dev_get_drvdata(pctldev);
|
|
|
|
|
2012-03-30 05:55:40 +00:00
|
|
|
return pmx->soc->nfunctions;
|
2012-02-01 21:04:47 +00:00
|
|
|
}
|
|
|
|
|
|
|
|
static const char *tegra_pinctrl_get_func_name(struct pinctrl_dev *pctldev,
|
|
|
|
unsigned function)
|
|
|
|
{
|
|
|
|
struct tegra_pmx *pmx = pinctrl_dev_get_drvdata(pctldev);
|
|
|
|
|
|
|
|
return pmx->soc->functions[function].name;
|
|
|
|
}
|
|
|
|
|
|
|
|
static int tegra_pinctrl_get_func_groups(struct pinctrl_dev *pctldev,
|
|
|
|
unsigned function,
|
|
|
|
const char * const **groups,
|
|
|
|
unsigned * const num_groups)
|
|
|
|
{
|
|
|
|
struct tegra_pmx *pmx = pinctrl_dev_get_drvdata(pctldev);
|
|
|
|
|
|
|
|
*groups = pmx->soc->functions[function].groups;
|
|
|
|
*num_groups = pmx->soc->functions[function].ngroups;
|
|
|
|
|
|
|
|
return 0;
|
|
|
|
}
|
|
|
|
|
2014-09-03 11:02:56 +00:00
|
|
|
static int tegra_pinctrl_set_mux(struct pinctrl_dev *pctldev,
|
|
|
|
unsigned function,
|
|
|
|
unsigned group)
|
2012-02-01 21:04:47 +00:00
|
|
|
{
|
|
|
|
struct tegra_pmx *pmx = pinctrl_dev_get_drvdata(pctldev);
|
|
|
|
const struct tegra_pingroup *g;
|
|
|
|
int i;
|
|
|
|
u32 val;
|
|
|
|
|
|
|
|
g = &pmx->soc->groups[group];
|
|
|
|
|
2012-04-23 16:05:22 +00:00
|
|
|
if (WARN_ON(g->mux_reg < 0))
|
2012-02-01 21:04:47 +00:00
|
|
|
return -EINVAL;
|
|
|
|
|
|
|
|
for (i = 0; i < ARRAY_SIZE(g->funcs); i++) {
|
|
|
|
if (g->funcs[i] == function)
|
|
|
|
break;
|
|
|
|
}
|
2012-04-23 16:05:22 +00:00
|
|
|
if (WARN_ON(i == ARRAY_SIZE(g->funcs)))
|
2012-02-01 21:04:47 +00:00
|
|
|
return -EINVAL;
|
|
|
|
|
|
|
|
val = pmx_readl(pmx, g->mux_bank, g->mux_reg);
|
|
|
|
val &= ~(0x3 << g->mux_bit);
|
|
|
|
val |= i << g->mux_bit;
|
|
|
|
pmx_writel(pmx, val, g->mux_bank, g->mux_reg);
|
|
|
|
|
|
|
|
return 0;
|
|
|
|
}
|
|
|
|
|
2013-02-16 09:25:07 +00:00
|
|
|
static const struct pinmux_ops tegra_pinmux_ops = {
|
2012-03-30 05:55:40 +00:00
|
|
|
.get_functions_count = tegra_pinctrl_get_funcs_count,
|
2012-02-01 21:04:47 +00:00
|
|
|
.get_function_name = tegra_pinctrl_get_func_name,
|
|
|
|
.get_function_groups = tegra_pinctrl_get_func_groups,
|
2014-09-03 11:02:56 +00:00
|
|
|
.set_mux = tegra_pinctrl_set_mux,
|
2012-02-01 21:04:47 +00:00
|
|
|
};
|
|
|
|
|
|
|
|
static int tegra_pinconf_reg(struct tegra_pmx *pmx,
|
|
|
|
const struct tegra_pingroup *g,
|
|
|
|
enum tegra_pinconf_param param,
|
2012-04-11 21:42:56 +00:00
|
|
|
bool report_err,
|
2012-02-01 21:04:47 +00:00
|
|
|
s8 *bank, s16 *reg, s8 *bit, s8 *width)
|
|
|
|
{
|
|
|
|
switch (param) {
|
|
|
|
case TEGRA_PINCONF_PARAM_PULL:
|
|
|
|
*bank = g->pupd_bank;
|
|
|
|
*reg = g->pupd_reg;
|
|
|
|
*bit = g->pupd_bit;
|
|
|
|
*width = 2;
|
|
|
|
break;
|
|
|
|
case TEGRA_PINCONF_PARAM_TRISTATE:
|
|
|
|
*bank = g->tri_bank;
|
|
|
|
*reg = g->tri_reg;
|
|
|
|
*bit = g->tri_bit;
|
|
|
|
*width = 1;
|
|
|
|
break;
|
|
|
|
case TEGRA_PINCONF_PARAM_ENABLE_INPUT:
|
pinctrl: tegra: remove redundant data table fields
Any SoC which supports the einput, odrain, lock, ioreset, or rcv_sel
options has the relevant HW register fields in the same register as the
mux function selection. Similarly, the drvtype option is always in the
drive register, if it is supported at all. Hence, we don't need to have
struct *_reg fields in the pin group table to define which register and
bank to use for those options. Delete this to save space in the driver's
data tables.
However, many of those options are not supported on all SoCs, or not
supported on some pingroups. We need a way to detect when they are
supported. Previously, this was indicated by setting the struct *_reg
field to -1. With the struct *_reg fields removed, we use the struct
*_bit fields for this purpose instead. The struct *_bit fields need to
be expanded from 5 to 6 bits in order to store a value outside the valid
HW bit range of 0..31.
Even without removing the struct *_reg fields, we still need to add code
to validate the struct *_bit fields, since some struct *_bit fields were
already being set to -1, without an option-specific struct *_reg field to
"guard" them. In other words, before this change, the pinmux driver might
allow some unsupported options to be written to HW.
Signed-off-by: Stephen Warren <swarren@nvidia.com>
Signed-off-by: Linus Walleij <linus.walleij@linaro.org>
2014-04-15 17:00:50 +00:00
|
|
|
*bank = g->mux_bank;
|
|
|
|
*reg = g->mux_reg;
|
2012-02-01 21:04:47 +00:00
|
|
|
*bit = g->einput_bit;
|
|
|
|
*width = 1;
|
|
|
|
break;
|
|
|
|
case TEGRA_PINCONF_PARAM_OPEN_DRAIN:
|
pinctrl: tegra: remove redundant data table fields
Any SoC which supports the einput, odrain, lock, ioreset, or rcv_sel
options has the relevant HW register fields in the same register as the
mux function selection. Similarly, the drvtype option is always in the
drive register, if it is supported at all. Hence, we don't need to have
struct *_reg fields in the pin group table to define which register and
bank to use for those options. Delete this to save space in the driver's
data tables.
However, many of those options are not supported on all SoCs, or not
supported on some pingroups. We need a way to detect when they are
supported. Previously, this was indicated by setting the struct *_reg
field to -1. With the struct *_reg fields removed, we use the struct
*_bit fields for this purpose instead. The struct *_bit fields need to
be expanded from 5 to 6 bits in order to store a value outside the valid
HW bit range of 0..31.
Even without removing the struct *_reg fields, we still need to add code
to validate the struct *_bit fields, since some struct *_bit fields were
already being set to -1, without an option-specific struct *_reg field to
"guard" them. In other words, before this change, the pinmux driver might
allow some unsupported options to be written to HW.
Signed-off-by: Stephen Warren <swarren@nvidia.com>
Signed-off-by: Linus Walleij <linus.walleij@linaro.org>
2014-04-15 17:00:50 +00:00
|
|
|
*bank = g->mux_bank;
|
|
|
|
*reg = g->mux_reg;
|
2012-02-01 21:04:47 +00:00
|
|
|
*bit = g->odrain_bit;
|
|
|
|
*width = 1;
|
|
|
|
break;
|
|
|
|
case TEGRA_PINCONF_PARAM_LOCK:
|
pinctrl: tegra: remove redundant data table fields
Any SoC which supports the einput, odrain, lock, ioreset, or rcv_sel
options has the relevant HW register fields in the same register as the
mux function selection. Similarly, the drvtype option is always in the
drive register, if it is supported at all. Hence, we don't need to have
struct *_reg fields in the pin group table to define which register and
bank to use for those options. Delete this to save space in the driver's
data tables.
However, many of those options are not supported on all SoCs, or not
supported on some pingroups. We need a way to detect when they are
supported. Previously, this was indicated by setting the struct *_reg
field to -1. With the struct *_reg fields removed, we use the struct
*_bit fields for this purpose instead. The struct *_bit fields need to
be expanded from 5 to 6 bits in order to store a value outside the valid
HW bit range of 0..31.
Even without removing the struct *_reg fields, we still need to add code
to validate the struct *_bit fields, since some struct *_bit fields were
already being set to -1, without an option-specific struct *_reg field to
"guard" them. In other words, before this change, the pinmux driver might
allow some unsupported options to be written to HW.
Signed-off-by: Stephen Warren <swarren@nvidia.com>
Signed-off-by: Linus Walleij <linus.walleij@linaro.org>
2014-04-15 17:00:50 +00:00
|
|
|
*bank = g->mux_bank;
|
|
|
|
*reg = g->mux_reg;
|
2012-02-01 21:04:47 +00:00
|
|
|
*bit = g->lock_bit;
|
|
|
|
*width = 1;
|
|
|
|
break;
|
|
|
|
case TEGRA_PINCONF_PARAM_IORESET:
|
pinctrl: tegra: remove redundant data table fields
Any SoC which supports the einput, odrain, lock, ioreset, or rcv_sel
options has the relevant HW register fields in the same register as the
mux function selection. Similarly, the drvtype option is always in the
drive register, if it is supported at all. Hence, we don't need to have
struct *_reg fields in the pin group table to define which register and
bank to use for those options. Delete this to save space in the driver's
data tables.
However, many of those options are not supported on all SoCs, or not
supported on some pingroups. We need a way to detect when they are
supported. Previously, this was indicated by setting the struct *_reg
field to -1. With the struct *_reg fields removed, we use the struct
*_bit fields for this purpose instead. The struct *_bit fields need to
be expanded from 5 to 6 bits in order to store a value outside the valid
HW bit range of 0..31.
Even without removing the struct *_reg fields, we still need to add code
to validate the struct *_bit fields, since some struct *_bit fields were
already being set to -1, without an option-specific struct *_reg field to
"guard" them. In other words, before this change, the pinmux driver might
allow some unsupported options to be written to HW.
Signed-off-by: Stephen Warren <swarren@nvidia.com>
Signed-off-by: Linus Walleij <linus.walleij@linaro.org>
2014-04-15 17:00:50 +00:00
|
|
|
*bank = g->mux_bank;
|
|
|
|
*reg = g->mux_reg;
|
2012-02-01 21:04:47 +00:00
|
|
|
*bit = g->ioreset_bit;
|
|
|
|
*width = 1;
|
|
|
|
break;
|
2013-01-08 07:32:36 +00:00
|
|
|
case TEGRA_PINCONF_PARAM_RCV_SEL:
|
pinctrl: tegra: remove redundant data table fields
Any SoC which supports the einput, odrain, lock, ioreset, or rcv_sel
options has the relevant HW register fields in the same register as the
mux function selection. Similarly, the drvtype option is always in the
drive register, if it is supported at all. Hence, we don't need to have
struct *_reg fields in the pin group table to define which register and
bank to use for those options. Delete this to save space in the driver's
data tables.
However, many of those options are not supported on all SoCs, or not
supported on some pingroups. We need a way to detect when they are
supported. Previously, this was indicated by setting the struct *_reg
field to -1. With the struct *_reg fields removed, we use the struct
*_bit fields for this purpose instead. The struct *_bit fields need to
be expanded from 5 to 6 bits in order to store a value outside the valid
HW bit range of 0..31.
Even without removing the struct *_reg fields, we still need to add code
to validate the struct *_bit fields, since some struct *_bit fields were
already being set to -1, without an option-specific struct *_reg field to
"guard" them. In other words, before this change, the pinmux driver might
allow some unsupported options to be written to HW.
Signed-off-by: Stephen Warren <swarren@nvidia.com>
Signed-off-by: Linus Walleij <linus.walleij@linaro.org>
2014-04-15 17:00:50 +00:00
|
|
|
*bank = g->mux_bank;
|
|
|
|
*reg = g->mux_reg;
|
2013-01-08 07:32:36 +00:00
|
|
|
*bit = g->rcv_sel_bit;
|
|
|
|
*width = 1;
|
|
|
|
break;
|
2012-02-01 21:04:47 +00:00
|
|
|
case TEGRA_PINCONF_PARAM_HIGH_SPEED_MODE:
|
2015-02-24 21:00:49 +00:00
|
|
|
if (pmx->soc->hsm_in_mux) {
|
|
|
|
*bank = g->mux_bank;
|
|
|
|
*reg = g->mux_reg;
|
|
|
|
} else {
|
|
|
|
*bank = g->drv_bank;
|
|
|
|
*reg = g->drv_reg;
|
|
|
|
}
|
2012-02-01 21:04:47 +00:00
|
|
|
*bit = g->hsm_bit;
|
|
|
|
*width = 1;
|
|
|
|
break;
|
|
|
|
case TEGRA_PINCONF_PARAM_SCHMITT:
|
2015-02-24 21:00:49 +00:00
|
|
|
if (pmx->soc->schmitt_in_mux) {
|
|
|
|
*bank = g->mux_bank;
|
|
|
|
*reg = g->mux_reg;
|
|
|
|
} else {
|
|
|
|
*bank = g->drv_bank;
|
|
|
|
*reg = g->drv_reg;
|
|
|
|
}
|
2012-02-01 21:04:47 +00:00
|
|
|
*bit = g->schmitt_bit;
|
|
|
|
*width = 1;
|
|
|
|
break;
|
|
|
|
case TEGRA_PINCONF_PARAM_LOW_POWER_MODE:
|
|
|
|
*bank = g->drv_bank;
|
|
|
|
*reg = g->drv_reg;
|
|
|
|
*bit = g->lpmd_bit;
|
2012-10-17 11:39:36 +00:00
|
|
|
*width = 2;
|
2012-02-01 21:04:47 +00:00
|
|
|
break;
|
|
|
|
case TEGRA_PINCONF_PARAM_DRIVE_DOWN_STRENGTH:
|
|
|
|
*bank = g->drv_bank;
|
|
|
|
*reg = g->drv_reg;
|
|
|
|
*bit = g->drvdn_bit;
|
|
|
|
*width = g->drvdn_width;
|
|
|
|
break;
|
|
|
|
case TEGRA_PINCONF_PARAM_DRIVE_UP_STRENGTH:
|
|
|
|
*bank = g->drv_bank;
|
|
|
|
*reg = g->drv_reg;
|
|
|
|
*bit = g->drvup_bit;
|
|
|
|
*width = g->drvup_width;
|
|
|
|
break;
|
|
|
|
case TEGRA_PINCONF_PARAM_SLEW_RATE_FALLING:
|
|
|
|
*bank = g->drv_bank;
|
|
|
|
*reg = g->drv_reg;
|
|
|
|
*bit = g->slwf_bit;
|
|
|
|
*width = g->slwf_width;
|
|
|
|
break;
|
|
|
|
case TEGRA_PINCONF_PARAM_SLEW_RATE_RISING:
|
|
|
|
*bank = g->drv_bank;
|
|
|
|
*reg = g->drv_reg;
|
|
|
|
*bit = g->slwr_bit;
|
|
|
|
*width = g->slwr_width;
|
|
|
|
break;
|
2013-01-08 07:32:36 +00:00
|
|
|
case TEGRA_PINCONF_PARAM_DRIVE_TYPE:
|
2015-02-24 21:00:49 +00:00
|
|
|
if (pmx->soc->drvtype_in_mux) {
|
|
|
|
*bank = g->mux_bank;
|
|
|
|
*reg = g->mux_reg;
|
|
|
|
} else {
|
|
|
|
*bank = g->drv_bank;
|
|
|
|
*reg = g->drv_reg;
|
|
|
|
}
|
2013-01-08 07:32:36 +00:00
|
|
|
*bit = g->drvtype_bit;
|
|
|
|
*width = 2;
|
|
|
|
break;
|
2012-02-01 21:04:47 +00:00
|
|
|
default:
|
|
|
|
dev_err(pmx->dev, "Invalid config param %04x\n", param);
|
|
|
|
return -ENOTSUPP;
|
|
|
|
}
|
|
|
|
|
pinctrl: tegra: remove redundant data table fields
Any SoC which supports the einput, odrain, lock, ioreset, or rcv_sel
options has the relevant HW register fields in the same register as the
mux function selection. Similarly, the drvtype option is always in the
drive register, if it is supported at all. Hence, we don't need to have
struct *_reg fields in the pin group table to define which register and
bank to use for those options. Delete this to save space in the driver's
data tables.
However, many of those options are not supported on all SoCs, or not
supported on some pingroups. We need a way to detect when they are
supported. Previously, this was indicated by setting the struct *_reg
field to -1. With the struct *_reg fields removed, we use the struct
*_bit fields for this purpose instead. The struct *_bit fields need to
be expanded from 5 to 6 bits in order to store a value outside the valid
HW bit range of 0..31.
Even without removing the struct *_reg fields, we still need to add code
to validate the struct *_bit fields, since some struct *_bit fields were
already being set to -1, without an option-specific struct *_reg field to
"guard" them. In other words, before this change, the pinmux driver might
allow some unsupported options to be written to HW.
Signed-off-by: Stephen Warren <swarren@nvidia.com>
Signed-off-by: Linus Walleij <linus.walleij@linaro.org>
2014-04-15 17:00:50 +00:00
|
|
|
if (*reg < 0 || *bit > 31) {
|
2014-04-14 21:33:42 +00:00
|
|
|
if (report_err) {
|
|
|
|
const char *prop = "unknown";
|
|
|
|
int i;
|
|
|
|
|
|
|
|
for (i = 0; i < ARRAY_SIZE(cfg_params); i++) {
|
|
|
|
if (cfg_params[i].param == param) {
|
|
|
|
prop = cfg_params[i].property;
|
|
|
|
break;
|
|
|
|
}
|
|
|
|
}
|
|
|
|
|
2012-04-11 21:42:56 +00:00
|
|
|
dev_err(pmx->dev,
|
2014-04-14 21:33:42 +00:00
|
|
|
"Config param %04x (%s) not supported on group %s\n",
|
|
|
|
param, prop, g->name);
|
|
|
|
}
|
2012-02-01 21:04:47 +00:00
|
|
|
return -ENOTSUPP;
|
|
|
|
}
|
|
|
|
|
|
|
|
return 0;
|
|
|
|
}
|
|
|
|
|
|
|
|
static int tegra_pinconf_get(struct pinctrl_dev *pctldev,
|
|
|
|
unsigned pin, unsigned long *config)
|
|
|
|
{
|
2012-04-23 16:05:22 +00:00
|
|
|
dev_err(pctldev->dev, "pin_config_get op not supported\n");
|
2012-02-01 21:04:47 +00:00
|
|
|
return -ENOTSUPP;
|
|
|
|
}
|
|
|
|
|
|
|
|
static int tegra_pinconf_set(struct pinctrl_dev *pctldev,
|
2013-08-27 18:32:12 +00:00
|
|
|
unsigned pin, unsigned long *configs,
|
|
|
|
unsigned num_configs)
|
2012-02-01 21:04:47 +00:00
|
|
|
{
|
2012-04-23 16:05:22 +00:00
|
|
|
dev_err(pctldev->dev, "pin_config_set op not supported\n");
|
2012-02-01 21:04:47 +00:00
|
|
|
return -ENOTSUPP;
|
|
|
|
}
|
|
|
|
|
|
|
|
static int tegra_pinconf_group_get(struct pinctrl_dev *pctldev,
|
|
|
|
unsigned group, unsigned long *config)
|
|
|
|
{
|
|
|
|
struct tegra_pmx *pmx = pinctrl_dev_get_drvdata(pctldev);
|
|
|
|
enum tegra_pinconf_param param = TEGRA_PINCONF_UNPACK_PARAM(*config);
|
|
|
|
u16 arg;
|
|
|
|
const struct tegra_pingroup *g;
|
|
|
|
int ret;
|
|
|
|
s8 bank, bit, width;
|
|
|
|
s16 reg;
|
|
|
|
u32 val, mask;
|
|
|
|
|
|
|
|
g = &pmx->soc->groups[group];
|
|
|
|
|
2012-04-11 21:42:56 +00:00
|
|
|
ret = tegra_pinconf_reg(pmx, g, param, true, &bank, ®, &bit,
|
|
|
|
&width);
|
2012-02-01 21:04:47 +00:00
|
|
|
if (ret < 0)
|
|
|
|
return ret;
|
|
|
|
|
|
|
|
val = pmx_readl(pmx, bank, reg);
|
|
|
|
mask = (1 << width) - 1;
|
|
|
|
arg = (val >> bit) & mask;
|
|
|
|
|
|
|
|
*config = TEGRA_PINCONF_PACK(param, arg);
|
|
|
|
|
|
|
|
return 0;
|
|
|
|
}
|
|
|
|
|
|
|
|
static int tegra_pinconf_group_set(struct pinctrl_dev *pctldev,
|
2013-08-27 18:32:12 +00:00
|
|
|
unsigned group, unsigned long *configs,
|
|
|
|
unsigned num_configs)
|
2012-02-01 21:04:47 +00:00
|
|
|
{
|
|
|
|
struct tegra_pmx *pmx = pinctrl_dev_get_drvdata(pctldev);
|
2013-08-27 18:32:12 +00:00
|
|
|
enum tegra_pinconf_param param;
|
|
|
|
u16 arg;
|
2012-02-01 21:04:47 +00:00
|
|
|
const struct tegra_pingroup *g;
|
2013-08-27 18:32:12 +00:00
|
|
|
int ret, i;
|
2012-02-01 21:04:47 +00:00
|
|
|
s8 bank, bit, width;
|
|
|
|
s16 reg;
|
|
|
|
u32 val, mask;
|
|
|
|
|
|
|
|
g = &pmx->soc->groups[group];
|
|
|
|
|
2013-08-27 18:32:12 +00:00
|
|
|
for (i = 0; i < num_configs; i++) {
|
|
|
|
param = TEGRA_PINCONF_UNPACK_PARAM(configs[i]);
|
|
|
|
arg = TEGRA_PINCONF_UNPACK_ARG(configs[i]);
|
2012-02-01 21:04:47 +00:00
|
|
|
|
2013-08-27 18:32:12 +00:00
|
|
|
ret = tegra_pinconf_reg(pmx, g, param, true, &bank, ®, &bit,
|
|
|
|
&width);
|
|
|
|
if (ret < 0)
|
|
|
|
return ret;
|
2012-02-01 21:04:47 +00:00
|
|
|
|
2013-08-27 18:32:12 +00:00
|
|
|
val = pmx_readl(pmx, bank, reg);
|
|
|
|
|
|
|
|
/* LOCK can't be cleared */
|
|
|
|
if (param == TEGRA_PINCONF_PARAM_LOCK) {
|
|
|
|
if ((val & BIT(bit)) && !arg) {
|
|
|
|
dev_err(pctldev->dev, "LOCK bit cannot be cleared\n");
|
|
|
|
return -EINVAL;
|
|
|
|
}
|
2012-04-23 16:05:22 +00:00
|
|
|
}
|
2012-02-01 21:04:47 +00:00
|
|
|
|
2013-08-27 18:32:12 +00:00
|
|
|
/* Special-case Boolean values; allow any non-zero as true */
|
|
|
|
if (width == 1)
|
|
|
|
arg = !!arg;
|
2012-02-01 21:04:47 +00:00
|
|
|
|
2013-08-27 18:32:12 +00:00
|
|
|
/* Range-check user-supplied value */
|
|
|
|
mask = (1 << width) - 1;
|
|
|
|
if (arg & ~mask) {
|
|
|
|
dev_err(pctldev->dev,
|
|
|
|
"config %lx: %x too big for %d bit register\n",
|
|
|
|
configs[i], arg, width);
|
|
|
|
return -EINVAL;
|
|
|
|
}
|
2012-02-01 21:04:47 +00:00
|
|
|
|
2013-08-27 18:32:12 +00:00
|
|
|
/* Update register */
|
|
|
|
val &= ~(mask << bit);
|
|
|
|
val |= arg << bit;
|
|
|
|
pmx_writel(pmx, val, bank, reg);
|
|
|
|
} /* for each config */
|
2012-02-01 21:04:47 +00:00
|
|
|
|
|
|
|
return 0;
|
|
|
|
}
|
|
|
|
|
2012-04-11 21:42:56 +00:00
|
|
|
#ifdef CONFIG_DEBUG_FS
|
2012-02-01 21:04:47 +00:00
|
|
|
static void tegra_pinconf_dbg_show(struct pinctrl_dev *pctldev,
|
|
|
|
struct seq_file *s, unsigned offset)
|
|
|
|
{
|
|
|
|
}
|
|
|
|
|
2012-04-11 21:42:56 +00:00
|
|
|
static const char *strip_prefix(const char *s)
|
|
|
|
{
|
|
|
|
const char *comma = strchr(s, ',');
|
|
|
|
if (!comma)
|
|
|
|
return s;
|
|
|
|
|
|
|
|
return comma + 1;
|
|
|
|
}
|
|
|
|
|
2012-02-01 21:04:47 +00:00
|
|
|
static void tegra_pinconf_group_dbg_show(struct pinctrl_dev *pctldev,
|
2012-04-11 21:42:56 +00:00
|
|
|
struct seq_file *s, unsigned group)
|
|
|
|
{
|
|
|
|
struct tegra_pmx *pmx = pinctrl_dev_get_drvdata(pctldev);
|
|
|
|
const struct tegra_pingroup *g;
|
|
|
|
int i, ret;
|
|
|
|
s8 bank, bit, width;
|
|
|
|
s16 reg;
|
|
|
|
u32 val;
|
|
|
|
|
|
|
|
g = &pmx->soc->groups[group];
|
|
|
|
|
|
|
|
for (i = 0; i < ARRAY_SIZE(cfg_params); i++) {
|
|
|
|
ret = tegra_pinconf_reg(pmx, g, cfg_params[i].param, false,
|
|
|
|
&bank, ®, &bit, &width);
|
|
|
|
if (ret < 0)
|
|
|
|
continue;
|
|
|
|
|
|
|
|
val = pmx_readl(pmx, bank, reg);
|
|
|
|
val >>= bit;
|
|
|
|
val &= (1 << width) - 1;
|
|
|
|
|
|
|
|
seq_printf(s, "\n\t%s=%u",
|
|
|
|
strip_prefix(cfg_params[i].property), val);
|
|
|
|
}
|
|
|
|
}
|
|
|
|
|
|
|
|
static void tegra_pinconf_config_dbg_show(struct pinctrl_dev *pctldev,
|
|
|
|
struct seq_file *s,
|
|
|
|
unsigned long config)
|
2012-02-01 21:04:47 +00:00
|
|
|
{
|
2012-04-11 21:42:56 +00:00
|
|
|
enum tegra_pinconf_param param = TEGRA_PINCONF_UNPACK_PARAM(config);
|
|
|
|
u16 arg = TEGRA_PINCONF_UNPACK_ARG(config);
|
|
|
|
const char *pname = "unknown";
|
|
|
|
int i;
|
|
|
|
|
|
|
|
for (i = 0; i < ARRAY_SIZE(cfg_params); i++) {
|
|
|
|
if (cfg_params[i].param == param) {
|
|
|
|
pname = cfg_params[i].property;
|
|
|
|
break;
|
|
|
|
}
|
|
|
|
}
|
|
|
|
|
|
|
|
seq_printf(s, "%s=%d", strip_prefix(pname), arg);
|
2012-02-01 21:04:47 +00:00
|
|
|
}
|
2012-04-11 21:42:56 +00:00
|
|
|
#endif
|
2012-02-01 21:04:47 +00:00
|
|
|
|
2013-02-16 09:25:07 +00:00
|
|
|
static const struct pinconf_ops tegra_pinconf_ops = {
|
2012-02-01 21:04:47 +00:00
|
|
|
.pin_config_get = tegra_pinconf_get,
|
|
|
|
.pin_config_set = tegra_pinconf_set,
|
|
|
|
.pin_config_group_get = tegra_pinconf_group_get,
|
|
|
|
.pin_config_group_set = tegra_pinconf_group_set,
|
2012-04-11 21:42:56 +00:00
|
|
|
#ifdef CONFIG_DEBUG_FS
|
2012-02-01 21:04:47 +00:00
|
|
|
.pin_config_dbg_show = tegra_pinconf_dbg_show,
|
|
|
|
.pin_config_group_dbg_show = tegra_pinconf_group_dbg_show,
|
2012-04-11 21:42:56 +00:00
|
|
|
.pin_config_config_dbg_show = tegra_pinconf_config_dbg_show,
|
|
|
|
#endif
|
2012-02-01 21:04:47 +00:00
|
|
|
};
|
|
|
|
|
|
|
|
static struct pinctrl_gpio_range tegra_pinctrl_gpio_range = {
|
|
|
|
.name = "Tegra GPIOs",
|
|
|
|
.id = 0,
|
|
|
|
.base = 0,
|
|
|
|
};
|
|
|
|
|
|
|
|
static struct pinctrl_desc tegra_pinctrl_desc = {
|
|
|
|
.pctlops = &tegra_pinctrl_ops,
|
|
|
|
.pmxops = &tegra_pinmux_ops,
|
|
|
|
.confops = &tegra_pinconf_ops,
|
|
|
|
.owner = THIS_MODULE,
|
|
|
|
};
|
|
|
|
|
2015-07-14 08:29:55 +00:00
|
|
|
static bool gpio_node_has_range(void)
|
|
|
|
{
|
|
|
|
struct device_node *np;
|
|
|
|
bool has_prop = false;
|
|
|
|
|
|
|
|
np = of_find_compatible_node(NULL, NULL, "nvidia,tegra30-gpio");
|
|
|
|
if (!np)
|
|
|
|
return has_prop;
|
|
|
|
|
|
|
|
has_prop = of_find_property(np, "gpio-ranges", NULL);
|
|
|
|
|
|
|
|
of_node_put(np);
|
|
|
|
|
|
|
|
return has_prop;
|
|
|
|
}
|
|
|
|
|
2012-12-21 21:10:23 +00:00
|
|
|
int tegra_pinctrl_probe(struct platform_device *pdev,
|
2012-04-11 18:53:09 +00:00
|
|
|
const struct tegra_pinctrl_soc_data *soc_data)
|
2012-02-01 21:04:47 +00:00
|
|
|
{
|
|
|
|
struct tegra_pmx *pmx;
|
|
|
|
struct resource *res;
|
|
|
|
int i;
|
2014-03-07 19:22:16 +00:00
|
|
|
const char **group_pins;
|
|
|
|
int fn, gn, gfn;
|
2012-02-01 21:04:47 +00:00
|
|
|
|
|
|
|
pmx = devm_kzalloc(&pdev->dev, sizeof(*pmx), GFP_KERNEL);
|
|
|
|
if (!pmx) {
|
|
|
|
dev_err(&pdev->dev, "Can't alloc tegra_pmx\n");
|
|
|
|
return -ENOMEM;
|
|
|
|
}
|
|
|
|
pmx->dev = &pdev->dev;
|
2012-04-11 18:53:09 +00:00
|
|
|
pmx->soc = soc_data;
|
2012-02-01 21:04:47 +00:00
|
|
|
|
2014-03-07 19:22:16 +00:00
|
|
|
/*
|
|
|
|
* Each mux group will appear in 4 functions' list of groups.
|
|
|
|
* This over-allocates slightly, since not all groups are mux groups.
|
|
|
|
*/
|
|
|
|
pmx->group_pins = devm_kzalloc(&pdev->dev,
|
|
|
|
soc_data->ngroups * 4 * sizeof(*pmx->group_pins),
|
|
|
|
GFP_KERNEL);
|
|
|
|
if (!pmx->group_pins)
|
|
|
|
return -ENOMEM;
|
|
|
|
|
|
|
|
group_pins = pmx->group_pins;
|
|
|
|
for (fn = 0; fn < soc_data->nfunctions; fn++) {
|
|
|
|
struct tegra_function *func = &soc_data->functions[fn];
|
|
|
|
|
|
|
|
func->groups = group_pins;
|
|
|
|
|
|
|
|
for (gn = 0; gn < soc_data->ngroups; gn++) {
|
|
|
|
const struct tegra_pingroup *g = &soc_data->groups[gn];
|
|
|
|
|
|
|
|
if (g->mux_reg == -1)
|
|
|
|
continue;
|
|
|
|
|
|
|
|
for (gfn = 0; gfn < 4; gfn++)
|
|
|
|
if (g->funcs[gfn] == fn)
|
|
|
|
break;
|
|
|
|
if (gfn == 4)
|
|
|
|
continue;
|
|
|
|
|
|
|
|
BUG_ON(group_pins - pmx->group_pins >=
|
|
|
|
soc_data->ngroups * 4);
|
|
|
|
*group_pins++ = g->name;
|
|
|
|
func->ngroups++;
|
|
|
|
}
|
|
|
|
}
|
|
|
|
|
2012-02-01 21:04:47 +00:00
|
|
|
tegra_pinctrl_gpio_range.npins = pmx->soc->ngpios;
|
2012-04-11 18:53:09 +00:00
|
|
|
tegra_pinctrl_desc.name = dev_name(&pdev->dev);
|
2012-02-01 21:04:47 +00:00
|
|
|
tegra_pinctrl_desc.pins = pmx->soc->pins;
|
|
|
|
tegra_pinctrl_desc.npins = pmx->soc->npins;
|
|
|
|
|
|
|
|
for (i = 0; ; i++) {
|
|
|
|
res = platform_get_resource(pdev, IORESOURCE_MEM, i);
|
|
|
|
if (!res)
|
|
|
|
break;
|
|
|
|
}
|
|
|
|
pmx->nbanks = i;
|
|
|
|
|
|
|
|
pmx->regs = devm_kzalloc(&pdev->dev, pmx->nbanks * sizeof(*pmx->regs),
|
|
|
|
GFP_KERNEL);
|
|
|
|
if (!pmx->regs) {
|
|
|
|
dev_err(&pdev->dev, "Can't alloc regs pointer\n");
|
2014-02-05 13:41:34 +00:00
|
|
|
return -ENOMEM;
|
2012-02-01 21:04:47 +00:00
|
|
|
}
|
|
|
|
|
|
|
|
for (i = 0; i < pmx->nbanks; i++) {
|
|
|
|
res = platform_get_resource(pdev, IORESOURCE_MEM, i);
|
2013-08-27 01:07:23 +00:00
|
|
|
pmx->regs[i] = devm_ioremap_resource(&pdev->dev, res);
|
|
|
|
if (IS_ERR(pmx->regs[i]))
|
|
|
|
return PTR_ERR(pmx->regs[i]);
|
2012-02-01 21:04:47 +00:00
|
|
|
}
|
|
|
|
|
|
|
|
pmx->pctl = pinctrl_register(&tegra_pinctrl_desc, &pdev->dev, pmx);
|
2015-06-09 04:01:16 +00:00
|
|
|
if (IS_ERR(pmx->pctl)) {
|
2012-02-01 21:04:47 +00:00
|
|
|
dev_err(&pdev->dev, "Couldn't register pinctrl driver\n");
|
2015-06-09 04:01:16 +00:00
|
|
|
return PTR_ERR(pmx->pctl);
|
2012-02-01 21:04:47 +00:00
|
|
|
}
|
|
|
|
|
2015-07-14 08:29:55 +00:00
|
|
|
if (!gpio_node_has_range())
|
|
|
|
pinctrl_add_gpio_range(pmx->pctl, &tegra_pinctrl_gpio_range);
|
2012-02-01 21:04:47 +00:00
|
|
|
|
|
|
|
platform_set_drvdata(pdev, pmx);
|
|
|
|
|
|
|
|
dev_dbg(&pdev->dev, "Probed Tegra pinctrl driver\n");
|
|
|
|
|
|
|
|
return 0;
|
|
|
|
}
|
2012-04-11 18:53:09 +00:00
|
|
|
EXPORT_SYMBOL_GPL(tegra_pinctrl_probe);
|
2012-02-01 21:04:47 +00:00
|
|
|
|
2012-11-19 18:26:06 +00:00
|
|
|
int tegra_pinctrl_remove(struct platform_device *pdev)
|
2012-02-01 21:04:47 +00:00
|
|
|
{
|
|
|
|
struct tegra_pmx *pmx = platform_get_drvdata(pdev);
|
|
|
|
|
|
|
|
pinctrl_unregister(pmx->pctl);
|
|
|
|
|
|
|
|
return 0;
|
|
|
|
}
|
2012-04-11 18:53:09 +00:00
|
|
|
EXPORT_SYMBOL_GPL(tegra_pinctrl_remove);
|