mirror of
https://github.com/torvalds/linux.git
synced 2024-12-25 20:32:22 +00:00
8ef364b3ce
Since commit 3e030b0b4e
("pinctrl: uniphier: allow to have pinctrl
node under syscon node"), this driver has kept compatibility for the
old DT files. Several releases have passed since then, so remove
the obsoleted compatibles and clean up the code.
Signed-off-by: Masahiro Yamada <yamada.masahiro@socionext.com>
Signed-off-by: Linus Walleij <linus.walleij@linaro.org>
735 lines
19 KiB
C
735 lines
19 KiB
C
/*
|
|
* Copyright (C) 2015-2017 Socionext Inc.
|
|
* Author: Masahiro Yamada <yamada.masahiro@socionext.com>
|
|
*
|
|
* This program is free software; you can redistribute it and/or modify
|
|
* it under the terms of the GNU General Public License as published by
|
|
* the Free Software Foundation; either version 2 of the License, or
|
|
* (at your option) any later version.
|
|
*
|
|
* This program is distributed in the hope that 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/export.h>
|
|
#include <linux/mfd/syscon.h>
|
|
#include <linux/of.h>
|
|
#include <linux/pinctrl/pinconf.h>
|
|
#include <linux/pinctrl/pinconf-generic.h>
|
|
#include <linux/pinctrl/pinctrl.h>
|
|
#include <linux/pinctrl/pinmux.h>
|
|
#include <linux/platform_device.h>
|
|
#include <linux/regmap.h>
|
|
|
|
#include "../core.h"
|
|
#include "../pinctrl-utils.h"
|
|
#include "pinctrl-uniphier.h"
|
|
|
|
#define UNIPHIER_PINCTRL_PINMUX_BASE 0x1000
|
|
#define UNIPHIER_PINCTRL_LOAD_PINMUX 0x1700
|
|
#define UNIPHIER_PINCTRL_DRVCTRL_BASE 0x1800
|
|
#define UNIPHIER_PINCTRL_DRV2CTRL_BASE 0x1900
|
|
#define UNIPHIER_PINCTRL_DRV3CTRL_BASE 0x1980
|
|
#define UNIPHIER_PINCTRL_PUPDCTRL_BASE 0x1a00
|
|
#define UNIPHIER_PINCTRL_IECTRL 0x1d00
|
|
|
|
struct uniphier_pinctrl_priv {
|
|
struct pinctrl_desc pctldesc;
|
|
struct pinctrl_dev *pctldev;
|
|
struct regmap *regmap;
|
|
struct uniphier_pinctrl_socdata *socdata;
|
|
};
|
|
|
|
static int uniphier_pctl_get_groups_count(struct pinctrl_dev *pctldev)
|
|
{
|
|
struct uniphier_pinctrl_priv *priv = pinctrl_dev_get_drvdata(pctldev);
|
|
|
|
return priv->socdata->groups_count;
|
|
}
|
|
|
|
static const char *uniphier_pctl_get_group_name(struct pinctrl_dev *pctldev,
|
|
unsigned selector)
|
|
{
|
|
struct uniphier_pinctrl_priv *priv = pinctrl_dev_get_drvdata(pctldev);
|
|
|
|
return priv->socdata->groups[selector].name;
|
|
}
|
|
|
|
static int uniphier_pctl_get_group_pins(struct pinctrl_dev *pctldev,
|
|
unsigned selector,
|
|
const unsigned **pins,
|
|
unsigned *num_pins)
|
|
{
|
|
struct uniphier_pinctrl_priv *priv = pinctrl_dev_get_drvdata(pctldev);
|
|
|
|
*pins = priv->socdata->groups[selector].pins;
|
|
*num_pins = priv->socdata->groups[selector].num_pins;
|
|
|
|
return 0;
|
|
}
|
|
|
|
#ifdef CONFIG_DEBUG_FS
|
|
static void uniphier_pctl_pin_dbg_show(struct pinctrl_dev *pctldev,
|
|
struct seq_file *s, unsigned offset)
|
|
{
|
|
const struct pin_desc *desc = pin_desc_get(pctldev, offset);
|
|
const char *pull_dir, *drv_type;
|
|
|
|
switch (uniphier_pin_get_pull_dir(desc->drv_data)) {
|
|
case UNIPHIER_PIN_PULL_UP:
|
|
pull_dir = "UP";
|
|
break;
|
|
case UNIPHIER_PIN_PULL_DOWN:
|
|
pull_dir = "DOWN";
|
|
break;
|
|
case UNIPHIER_PIN_PULL_UP_FIXED:
|
|
pull_dir = "UP(FIXED)";
|
|
break;
|
|
case UNIPHIER_PIN_PULL_DOWN_FIXED:
|
|
pull_dir = "DOWN(FIXED)";
|
|
break;
|
|
case UNIPHIER_PIN_PULL_NONE:
|
|
pull_dir = "NONE";
|
|
break;
|
|
default:
|
|
BUG();
|
|
}
|
|
|
|
switch (uniphier_pin_get_drv_type(desc->drv_data)) {
|
|
case UNIPHIER_PIN_DRV_1BIT:
|
|
drv_type = "4/8(mA)";
|
|
break;
|
|
case UNIPHIER_PIN_DRV_2BIT:
|
|
drv_type = "8/12/16/20(mA)";
|
|
break;
|
|
case UNIPHIER_PIN_DRV_3BIT:
|
|
drv_type = "4/5/7/9/11/12/14/16(mA)";
|
|
break;
|
|
case UNIPHIER_PIN_DRV_FIXED4:
|
|
drv_type = "4(mA)";
|
|
break;
|
|
case UNIPHIER_PIN_DRV_FIXED5:
|
|
drv_type = "5(mA)";
|
|
break;
|
|
case UNIPHIER_PIN_DRV_FIXED8:
|
|
drv_type = "8(mA)";
|
|
break;
|
|
case UNIPHIER_PIN_DRV_NONE:
|
|
drv_type = "NONE";
|
|
break;
|
|
default:
|
|
BUG();
|
|
}
|
|
|
|
seq_printf(s, " PULL_DIR=%s DRV_TYPE=%s", pull_dir, drv_type);
|
|
}
|
|
#endif
|
|
|
|
static const struct pinctrl_ops uniphier_pctlops = {
|
|
.get_groups_count = uniphier_pctl_get_groups_count,
|
|
.get_group_name = uniphier_pctl_get_group_name,
|
|
.get_group_pins = uniphier_pctl_get_group_pins,
|
|
#ifdef CONFIG_DEBUG_FS
|
|
.pin_dbg_show = uniphier_pctl_pin_dbg_show,
|
|
#endif
|
|
.dt_node_to_map = pinconf_generic_dt_node_to_map_all,
|
|
.dt_free_map = pinctrl_utils_free_map,
|
|
};
|
|
|
|
static int uniphier_conf_pin_bias_get(struct pinctrl_dev *pctldev,
|
|
const struct pin_desc *desc,
|
|
enum pin_config_param param)
|
|
{
|
|
struct uniphier_pinctrl_priv *priv = pinctrl_dev_get_drvdata(pctldev);
|
|
enum uniphier_pin_pull_dir pull_dir =
|
|
uniphier_pin_get_pull_dir(desc->drv_data);
|
|
unsigned int pupdctrl, reg, shift, val;
|
|
unsigned int expected = 1;
|
|
int ret;
|
|
|
|
switch (param) {
|
|
case PIN_CONFIG_BIAS_DISABLE:
|
|
if (pull_dir == UNIPHIER_PIN_PULL_NONE)
|
|
return 0;
|
|
if (pull_dir == UNIPHIER_PIN_PULL_UP_FIXED ||
|
|
pull_dir == UNIPHIER_PIN_PULL_DOWN_FIXED)
|
|
return -EINVAL;
|
|
expected = 0;
|
|
break;
|
|
case PIN_CONFIG_BIAS_PULL_UP:
|
|
if (pull_dir == UNIPHIER_PIN_PULL_UP_FIXED)
|
|
return 0;
|
|
if (pull_dir != UNIPHIER_PIN_PULL_UP)
|
|
return -EINVAL;
|
|
break;
|
|
case PIN_CONFIG_BIAS_PULL_DOWN:
|
|
if (pull_dir == UNIPHIER_PIN_PULL_DOWN_FIXED)
|
|
return 0;
|
|
if (pull_dir != UNIPHIER_PIN_PULL_DOWN)
|
|
return -EINVAL;
|
|
break;
|
|
default:
|
|
BUG();
|
|
}
|
|
|
|
pupdctrl = uniphier_pin_get_pupdctrl(desc->drv_data);
|
|
|
|
reg = UNIPHIER_PINCTRL_PUPDCTRL_BASE + pupdctrl / 32 * 4;
|
|
shift = pupdctrl % 32;
|
|
|
|
ret = regmap_read(priv->regmap, reg, &val);
|
|
if (ret)
|
|
return ret;
|
|
|
|
val = (val >> shift) & 1;
|
|
|
|
return (val == expected) ? 0 : -EINVAL;
|
|
}
|
|
|
|
static int uniphier_conf_pin_drive_get(struct pinctrl_dev *pctldev,
|
|
const struct pin_desc *desc,
|
|
u16 *strength)
|
|
{
|
|
struct uniphier_pinctrl_priv *priv = pinctrl_dev_get_drvdata(pctldev);
|
|
enum uniphier_pin_drv_type type =
|
|
uniphier_pin_get_drv_type(desc->drv_data);
|
|
const unsigned int strength_1bit[] = {4, 8};
|
|
const unsigned int strength_2bit[] = {8, 12, 16, 20};
|
|
const unsigned int strength_3bit[] = {4, 5, 7, 9, 11, 12, 14, 16};
|
|
const unsigned int *supported_strength;
|
|
unsigned int drvctrl, reg, shift, mask, width, val;
|
|
int ret;
|
|
|
|
switch (type) {
|
|
case UNIPHIER_PIN_DRV_1BIT:
|
|
supported_strength = strength_1bit;
|
|
reg = UNIPHIER_PINCTRL_DRVCTRL_BASE;
|
|
width = 1;
|
|
break;
|
|
case UNIPHIER_PIN_DRV_2BIT:
|
|
supported_strength = strength_2bit;
|
|
reg = UNIPHIER_PINCTRL_DRV2CTRL_BASE;
|
|
width = 2;
|
|
break;
|
|
case UNIPHIER_PIN_DRV_3BIT:
|
|
supported_strength = strength_3bit;
|
|
reg = UNIPHIER_PINCTRL_DRV3CTRL_BASE;
|
|
width = 4;
|
|
break;
|
|
case UNIPHIER_PIN_DRV_FIXED4:
|
|
*strength = 4;
|
|
return 0;
|
|
case UNIPHIER_PIN_DRV_FIXED5:
|
|
*strength = 5;
|
|
return 0;
|
|
case UNIPHIER_PIN_DRV_FIXED8:
|
|
*strength = 8;
|
|
return 0;
|
|
default:
|
|
/* drive strength control is not supported for this pin */
|
|
return -EINVAL;
|
|
}
|
|
|
|
drvctrl = uniphier_pin_get_drvctrl(desc->drv_data);
|
|
drvctrl *= width;
|
|
|
|
reg += drvctrl / 32 * 4;
|
|
shift = drvctrl % 32;
|
|
mask = (1U << width) - 1;
|
|
|
|
ret = regmap_read(priv->regmap, reg, &val);
|
|
if (ret)
|
|
return ret;
|
|
|
|
*strength = supported_strength[(val >> shift) & mask];
|
|
|
|
return 0;
|
|
}
|
|
|
|
static int uniphier_conf_pin_input_enable_get(struct pinctrl_dev *pctldev,
|
|
const struct pin_desc *desc)
|
|
{
|
|
struct uniphier_pinctrl_priv *priv = pinctrl_dev_get_drvdata(pctldev);
|
|
unsigned int iectrl = uniphier_pin_get_iectrl(desc->drv_data);
|
|
unsigned int val;
|
|
int ret;
|
|
|
|
if (iectrl == UNIPHIER_PIN_IECTRL_NONE)
|
|
/* This pin is always input-enabled. */
|
|
return 0;
|
|
|
|
ret = regmap_read(priv->regmap, UNIPHIER_PINCTRL_IECTRL, &val);
|
|
if (ret)
|
|
return ret;
|
|
|
|
return val & BIT(iectrl) ? 0 : -EINVAL;
|
|
}
|
|
|
|
static int uniphier_conf_pin_config_get(struct pinctrl_dev *pctldev,
|
|
unsigned pin,
|
|
unsigned long *configs)
|
|
{
|
|
const struct pin_desc *desc = pin_desc_get(pctldev, pin);
|
|
enum pin_config_param param = pinconf_to_config_param(*configs);
|
|
bool has_arg = false;
|
|
u16 arg;
|
|
int ret;
|
|
|
|
switch (param) {
|
|
case PIN_CONFIG_BIAS_DISABLE:
|
|
case PIN_CONFIG_BIAS_PULL_UP:
|
|
case PIN_CONFIG_BIAS_PULL_DOWN:
|
|
ret = uniphier_conf_pin_bias_get(pctldev, desc, param);
|
|
break;
|
|
case PIN_CONFIG_DRIVE_STRENGTH:
|
|
ret = uniphier_conf_pin_drive_get(pctldev, desc, &arg);
|
|
has_arg = true;
|
|
break;
|
|
case PIN_CONFIG_INPUT_ENABLE:
|
|
ret = uniphier_conf_pin_input_enable_get(pctldev, desc);
|
|
break;
|
|
default:
|
|
/* unsupported parameter */
|
|
ret = -EINVAL;
|
|
break;
|
|
}
|
|
|
|
if (ret == 0 && has_arg)
|
|
*configs = pinconf_to_config_packed(param, arg);
|
|
|
|
return ret;
|
|
}
|
|
|
|
static int uniphier_conf_pin_bias_set(struct pinctrl_dev *pctldev,
|
|
const struct pin_desc *desc,
|
|
enum pin_config_param param, u32 arg)
|
|
{
|
|
struct uniphier_pinctrl_priv *priv = pinctrl_dev_get_drvdata(pctldev);
|
|
enum uniphier_pin_pull_dir pull_dir =
|
|
uniphier_pin_get_pull_dir(desc->drv_data);
|
|
unsigned int pupdctrl, reg, shift;
|
|
unsigned int val = 1;
|
|
|
|
switch (param) {
|
|
case PIN_CONFIG_BIAS_DISABLE:
|
|
if (pull_dir == UNIPHIER_PIN_PULL_NONE)
|
|
return 0;
|
|
if (pull_dir == UNIPHIER_PIN_PULL_UP_FIXED ||
|
|
pull_dir == UNIPHIER_PIN_PULL_DOWN_FIXED) {
|
|
dev_err(pctldev->dev,
|
|
"can not disable pull register for pin %s\n",
|
|
desc->name);
|
|
return -EINVAL;
|
|
}
|
|
val = 0;
|
|
break;
|
|
case PIN_CONFIG_BIAS_PULL_UP:
|
|
if (pull_dir == UNIPHIER_PIN_PULL_UP_FIXED && arg != 0)
|
|
return 0;
|
|
if (pull_dir != UNIPHIER_PIN_PULL_UP) {
|
|
dev_err(pctldev->dev,
|
|
"pull-up is unsupported for pin %s\n",
|
|
desc->name);
|
|
return -EINVAL;
|
|
}
|
|
if (arg == 0) {
|
|
dev_err(pctldev->dev, "pull-up can not be total\n");
|
|
return -EINVAL;
|
|
}
|
|
break;
|
|
case PIN_CONFIG_BIAS_PULL_DOWN:
|
|
if (pull_dir == UNIPHIER_PIN_PULL_DOWN_FIXED && arg != 0)
|
|
return 0;
|
|
if (pull_dir != UNIPHIER_PIN_PULL_DOWN) {
|
|
dev_err(pctldev->dev,
|
|
"pull-down is unsupported for pin %s\n",
|
|
desc->name);
|
|
return -EINVAL;
|
|
}
|
|
if (arg == 0) {
|
|
dev_err(pctldev->dev, "pull-down can not be total\n");
|
|
return -EINVAL;
|
|
}
|
|
break;
|
|
case PIN_CONFIG_BIAS_PULL_PIN_DEFAULT:
|
|
if (pull_dir == UNIPHIER_PIN_PULL_NONE) {
|
|
dev_err(pctldev->dev,
|
|
"pull-up/down is unsupported for pin %s\n",
|
|
desc->name);
|
|
return -EINVAL;
|
|
}
|
|
|
|
if (arg == 0)
|
|
return 0; /* configuration ingored */
|
|
break;
|
|
default:
|
|
BUG();
|
|
}
|
|
|
|
pupdctrl = uniphier_pin_get_pupdctrl(desc->drv_data);
|
|
|
|
reg = UNIPHIER_PINCTRL_PUPDCTRL_BASE + pupdctrl / 32 * 4;
|
|
shift = pupdctrl % 32;
|
|
|
|
return regmap_update_bits(priv->regmap, reg, 1 << shift, val << shift);
|
|
}
|
|
|
|
static int uniphier_conf_pin_drive_set(struct pinctrl_dev *pctldev,
|
|
const struct pin_desc *desc,
|
|
u16 strength)
|
|
{
|
|
struct uniphier_pinctrl_priv *priv = pinctrl_dev_get_drvdata(pctldev);
|
|
enum uniphier_pin_drv_type type =
|
|
uniphier_pin_get_drv_type(desc->drv_data);
|
|
const unsigned int strength_1bit[] = {4, 8, -1};
|
|
const unsigned int strength_2bit[] = {8, 12, 16, 20, -1};
|
|
const unsigned int strength_3bit[] = {4, 5, 7, 9, 11, 12, 14, 16, -1};
|
|
const unsigned int *supported_strength;
|
|
unsigned int drvctrl, reg, shift, mask, width, val;
|
|
|
|
switch (type) {
|
|
case UNIPHIER_PIN_DRV_1BIT:
|
|
supported_strength = strength_1bit;
|
|
reg = UNIPHIER_PINCTRL_DRVCTRL_BASE;
|
|
width = 1;
|
|
break;
|
|
case UNIPHIER_PIN_DRV_2BIT:
|
|
supported_strength = strength_2bit;
|
|
reg = UNIPHIER_PINCTRL_DRV2CTRL_BASE;
|
|
width = 2;
|
|
break;
|
|
case UNIPHIER_PIN_DRV_3BIT:
|
|
supported_strength = strength_3bit;
|
|
reg = UNIPHIER_PINCTRL_DRV3CTRL_BASE;
|
|
width = 4;
|
|
break;
|
|
default:
|
|
dev_err(pctldev->dev,
|
|
"cannot change drive strength for pin %s\n",
|
|
desc->name);
|
|
return -EINVAL;
|
|
}
|
|
|
|
for (val = 0; supported_strength[val] > 0; val++) {
|
|
if (supported_strength[val] > strength)
|
|
break;
|
|
}
|
|
|
|
if (val == 0) {
|
|
dev_err(pctldev->dev,
|
|
"unsupported drive strength %u mA for pin %s\n",
|
|
strength, desc->name);
|
|
return -EINVAL;
|
|
}
|
|
|
|
val--;
|
|
|
|
drvctrl = uniphier_pin_get_drvctrl(desc->drv_data);
|
|
drvctrl *= width;
|
|
|
|
reg += drvctrl / 32 * 4;
|
|
shift = drvctrl % 32;
|
|
mask = (1U << width) - 1;
|
|
|
|
return regmap_update_bits(priv->regmap, reg,
|
|
mask << shift, val << shift);
|
|
}
|
|
|
|
static int uniphier_conf_pin_input_enable(struct pinctrl_dev *pctldev,
|
|
const struct pin_desc *desc,
|
|
u16 enable)
|
|
{
|
|
struct uniphier_pinctrl_priv *priv = pinctrl_dev_get_drvdata(pctldev);
|
|
unsigned int iectrl = uniphier_pin_get_iectrl(desc->drv_data);
|
|
unsigned int reg, mask;
|
|
|
|
/*
|
|
* Multiple pins share one input enable, per-pin disabling is
|
|
* impossible.
|
|
*/
|
|
if (!(priv->socdata->caps & UNIPHIER_PINCTRL_CAPS_PERPIN_IECTRL) &&
|
|
!enable)
|
|
return -EINVAL;
|
|
|
|
/* UNIPHIER_PIN_IECTRL_NONE means the pin is always input-enabled */
|
|
if (iectrl == UNIPHIER_PIN_IECTRL_NONE)
|
|
return enable ? 0 : -EINVAL;
|
|
|
|
reg = UNIPHIER_PINCTRL_IECTRL + iectrl / 32 * 4;
|
|
mask = BIT(iectrl % 32);
|
|
|
|
return regmap_update_bits(priv->regmap, reg, mask, enable ? mask : 0);
|
|
}
|
|
|
|
static int uniphier_conf_pin_config_set(struct pinctrl_dev *pctldev,
|
|
unsigned pin,
|
|
unsigned long *configs,
|
|
unsigned num_configs)
|
|
{
|
|
const struct pin_desc *desc = pin_desc_get(pctldev, pin);
|
|
int i, ret;
|
|
|
|
for (i = 0; i < num_configs; i++) {
|
|
enum pin_config_param param =
|
|
pinconf_to_config_param(configs[i]);
|
|
u32 arg = pinconf_to_config_argument(configs[i]);
|
|
|
|
switch (param) {
|
|
case PIN_CONFIG_BIAS_DISABLE:
|
|
case PIN_CONFIG_BIAS_PULL_UP:
|
|
case PIN_CONFIG_BIAS_PULL_DOWN:
|
|
case PIN_CONFIG_BIAS_PULL_PIN_DEFAULT:
|
|
ret = uniphier_conf_pin_bias_set(pctldev, desc,
|
|
param, arg);
|
|
break;
|
|
case PIN_CONFIG_DRIVE_STRENGTH:
|
|
ret = uniphier_conf_pin_drive_set(pctldev, desc, arg);
|
|
break;
|
|
case PIN_CONFIG_INPUT_ENABLE:
|
|
ret = uniphier_conf_pin_input_enable(pctldev, desc,
|
|
arg);
|
|
break;
|
|
default:
|
|
dev_err(pctldev->dev,
|
|
"unsupported configuration parameter %u\n",
|
|
param);
|
|
return -EINVAL;
|
|
}
|
|
|
|
if (ret)
|
|
return ret;
|
|
}
|
|
|
|
return 0;
|
|
}
|
|
|
|
static int uniphier_conf_pin_config_group_set(struct pinctrl_dev *pctldev,
|
|
unsigned selector,
|
|
unsigned long *configs,
|
|
unsigned num_configs)
|
|
{
|
|
struct uniphier_pinctrl_priv *priv = pinctrl_dev_get_drvdata(pctldev);
|
|
const unsigned *pins = priv->socdata->groups[selector].pins;
|
|
unsigned num_pins = priv->socdata->groups[selector].num_pins;
|
|
int i, ret;
|
|
|
|
for (i = 0; i < num_pins; i++) {
|
|
ret = uniphier_conf_pin_config_set(pctldev, pins[i],
|
|
configs, num_configs);
|
|
if (ret)
|
|
return ret;
|
|
}
|
|
|
|
return 0;
|
|
}
|
|
|
|
static const struct pinconf_ops uniphier_confops = {
|
|
.is_generic = true,
|
|
.pin_config_get = uniphier_conf_pin_config_get,
|
|
.pin_config_set = uniphier_conf_pin_config_set,
|
|
.pin_config_group_set = uniphier_conf_pin_config_group_set,
|
|
};
|
|
|
|
static int uniphier_pmx_get_functions_count(struct pinctrl_dev *pctldev)
|
|
{
|
|
struct uniphier_pinctrl_priv *priv = pinctrl_dev_get_drvdata(pctldev);
|
|
|
|
return priv->socdata->functions_count;
|
|
}
|
|
|
|
static const char *uniphier_pmx_get_function_name(struct pinctrl_dev *pctldev,
|
|
unsigned selector)
|
|
{
|
|
struct uniphier_pinctrl_priv *priv = pinctrl_dev_get_drvdata(pctldev);
|
|
|
|
return priv->socdata->functions[selector].name;
|
|
}
|
|
|
|
static int uniphier_pmx_get_function_groups(struct pinctrl_dev *pctldev,
|
|
unsigned selector,
|
|
const char * const **groups,
|
|
unsigned *num_groups)
|
|
{
|
|
struct uniphier_pinctrl_priv *priv = pinctrl_dev_get_drvdata(pctldev);
|
|
|
|
*groups = priv->socdata->functions[selector].groups;
|
|
*num_groups = priv->socdata->functions[selector].num_groups;
|
|
|
|
return 0;
|
|
}
|
|
|
|
static int uniphier_pmx_set_one_mux(struct pinctrl_dev *pctldev, unsigned pin,
|
|
int muxval)
|
|
{
|
|
struct uniphier_pinctrl_priv *priv = pinctrl_dev_get_drvdata(pctldev);
|
|
unsigned int mux_bits, reg_stride, reg, reg_end, shift, mask;
|
|
bool load_pinctrl;
|
|
int ret;
|
|
|
|
/* some pins need input-enabling */
|
|
ret = uniphier_conf_pin_input_enable(pctldev,
|
|
pin_desc_get(pctldev, pin), 1);
|
|
if (ret)
|
|
return ret;
|
|
|
|
if (muxval < 0)
|
|
return 0; /* dedicated pin; nothing to do for pin-mux */
|
|
|
|
if (priv->socdata->caps & UNIPHIER_PINCTRL_CAPS_DBGMUX_SEPARATE) {
|
|
/*
|
|
* Mode reg_offset bit_position
|
|
* Normal 4 * n shift+3:shift
|
|
* Debug 4 * n shift+7:shift+4
|
|
*/
|
|
mux_bits = 4;
|
|
reg_stride = 8;
|
|
load_pinctrl = true;
|
|
} else {
|
|
/*
|
|
* Mode reg_offset bit_position
|
|
* Normal 8 * n shift+3:shift
|
|
* Debug 8 * n + 4 shift+3:shift
|
|
*/
|
|
mux_bits = 8;
|
|
reg_stride = 4;
|
|
load_pinctrl = false;
|
|
}
|
|
|
|
reg = UNIPHIER_PINCTRL_PINMUX_BASE + pin * mux_bits / 32 * reg_stride;
|
|
reg_end = reg + reg_stride;
|
|
shift = pin * mux_bits % 32;
|
|
mask = (1U << mux_bits) - 1;
|
|
|
|
/*
|
|
* If reg_stride is greater than 4, the MSB of each pinsel shall be
|
|
* stored in the offset+4.
|
|
*/
|
|
for (; reg < reg_end; reg += 4) {
|
|
ret = regmap_update_bits(priv->regmap, reg,
|
|
mask << shift, muxval << shift);
|
|
if (ret)
|
|
return ret;
|
|
muxval >>= mux_bits;
|
|
}
|
|
|
|
if (load_pinctrl) {
|
|
ret = regmap_write(priv->regmap,
|
|
UNIPHIER_PINCTRL_LOAD_PINMUX, 1);
|
|
if (ret)
|
|
return ret;
|
|
}
|
|
|
|
return 0;
|
|
}
|
|
|
|
static int uniphier_pmx_set_mux(struct pinctrl_dev *pctldev,
|
|
unsigned func_selector,
|
|
unsigned group_selector)
|
|
{
|
|
struct uniphier_pinctrl_priv *priv = pinctrl_dev_get_drvdata(pctldev);
|
|
const struct uniphier_pinctrl_group *grp =
|
|
&priv->socdata->groups[group_selector];
|
|
int i;
|
|
int ret;
|
|
|
|
for (i = 0; i < grp->num_pins; i++) {
|
|
ret = uniphier_pmx_set_one_mux(pctldev, grp->pins[i],
|
|
grp->muxvals[i]);
|
|
if (ret)
|
|
return ret;
|
|
}
|
|
|
|
return 0;
|
|
}
|
|
|
|
static int uniphier_pmx_gpio_request_enable(struct pinctrl_dev *pctldev,
|
|
struct pinctrl_gpio_range *range,
|
|
unsigned offset)
|
|
{
|
|
struct uniphier_pinctrl_priv *priv = pinctrl_dev_get_drvdata(pctldev);
|
|
const struct uniphier_pinctrl_group *groups = priv->socdata->groups;
|
|
int groups_count = priv->socdata->groups_count;
|
|
enum uniphier_pinmux_gpio_range_type range_type;
|
|
int i, j;
|
|
|
|
if (strstr(range->name, "irq"))
|
|
range_type = UNIPHIER_PINMUX_GPIO_RANGE_IRQ;
|
|
else
|
|
range_type = UNIPHIER_PINMUX_GPIO_RANGE_PORT;
|
|
|
|
for (i = 0; i < groups_count; i++) {
|
|
if (groups[i].range_type != range_type)
|
|
continue;
|
|
|
|
for (j = 0; j < groups[i].num_pins; j++)
|
|
if (groups[i].pins[j] == offset)
|
|
goto found;
|
|
}
|
|
|
|
dev_err(pctldev->dev, "pin %u does not support GPIO\n", offset);
|
|
return -EINVAL;
|
|
|
|
found:
|
|
return uniphier_pmx_set_one_mux(pctldev, offset, groups[i].muxvals[j]);
|
|
}
|
|
|
|
static const struct pinmux_ops uniphier_pmxops = {
|
|
.get_functions_count = uniphier_pmx_get_functions_count,
|
|
.get_function_name = uniphier_pmx_get_function_name,
|
|
.get_function_groups = uniphier_pmx_get_function_groups,
|
|
.set_mux = uniphier_pmx_set_mux,
|
|
.gpio_request_enable = uniphier_pmx_gpio_request_enable,
|
|
.strict = true,
|
|
};
|
|
|
|
int uniphier_pinctrl_probe(struct platform_device *pdev,
|
|
struct uniphier_pinctrl_socdata *socdata)
|
|
{
|
|
struct device *dev = &pdev->dev;
|
|
struct uniphier_pinctrl_priv *priv;
|
|
struct device_node *parent;
|
|
|
|
if (!socdata ||
|
|
!socdata->pins || !socdata->npins ||
|
|
!socdata->groups || !socdata->groups_count ||
|
|
!socdata->functions || !socdata->functions_count) {
|
|
dev_err(dev, "pinctrl socdata lacks necessary members\n");
|
|
return -EINVAL;
|
|
}
|
|
|
|
priv = devm_kzalloc(dev, sizeof(*priv), GFP_KERNEL);
|
|
if (!priv)
|
|
return -ENOMEM;
|
|
|
|
parent = of_get_parent(dev->of_node);
|
|
priv->regmap = syscon_node_to_regmap(parent);
|
|
of_node_put(parent);
|
|
|
|
if (IS_ERR(priv->regmap)) {
|
|
dev_err(dev, "failed to get regmap\n");
|
|
return PTR_ERR(priv->regmap);
|
|
}
|
|
|
|
priv->socdata = socdata;
|
|
priv->pctldesc.name = dev->driver->name;
|
|
priv->pctldesc.pins = socdata->pins;
|
|
priv->pctldesc.npins = socdata->npins;
|
|
priv->pctldesc.pctlops = &uniphier_pctlops;
|
|
priv->pctldesc.pmxops = &uniphier_pmxops;
|
|
priv->pctldesc.confops = &uniphier_confops;
|
|
priv->pctldesc.owner = dev->driver->owner;
|
|
|
|
priv->pctldev = devm_pinctrl_register(dev, &priv->pctldesc, priv);
|
|
if (IS_ERR(priv->pctldev)) {
|
|
dev_err(dev, "failed to register UniPhier pinctrl driver\n");
|
|
return PTR_ERR(priv->pctldev);
|
|
}
|
|
|
|
platform_set_drvdata(pdev, priv);
|
|
|
|
return 0;
|
|
}
|
|
EXPORT_SYMBOL_GPL(uniphier_pinctrl_probe);
|