Quelle  pinctrl-meson-axg-pmx.c   Sprache: C

// SPDX-License-Identifier: (GPL-2.0+ OR MIT)
/*
 * Second generation of pinmux driver for Amlogic Meson-AXG SoC.
 *
 * Copyright (c) 2017 Baylibre SAS.
 * Author:  Jerome Brunet  <jbrunet@baylibre.com>
 *
 * Copyright (c) 2017 Amlogic, Inc. All rights reserved.
 * Author: Xingyu Chen <xingyu.chen@amlogic.com>
 */

/*
 * This new generation of pinctrl IP is mainly adopted by the
 * Meson-AXG SoC and later series, which use 4-width continuous
 * register bit to select the function for each pin.
 *
 * The value 0 is always selecting the GPIO mode, while other
 * values (start from 1) for selecting the function mode.
 */
#include <linux/device.h>
#include <linux/regmap.h>
#include <linux/pinctrl/pinctrl.h>
#include <linux/pinctrl/pinmux.h>

#include "pinctrl-meson.h"
#include "pinctrl-meson-axg-pmx.h"

static int meson_axg_pmx_get_bank(struct meson_pinctrl *pc,
   unsigned int pin,
   const struct meson_pmx_bank **bank)
{
 int i;
 const struct meson_axg_pmx_data *pmx = pc->data->pmx_data;

 for (i = 0; i < pmx->num_pmx_banks; i++)
  if (pin >= pmx->pmx_banks[i].first &&
    pin <= pmx->pmx_banks[i].last) {
   *bank = &pmx->pmx_banks[i];
   return 0;
  }

 return -EINVAL;
}

static int meson_pmx_calc_reg_and_offset(const struct meson_pmx_bank *bank,
   unsigned int pin, unsigned int *reg,
   unsigned int *offset)
{
 int shift;

 shift = pin - bank->first;

 *reg = bank->reg + (bank->offset + (shift << 2)) / 32;
 *offset = (bank->offset + (shift << 2)) % 32;

 return 0;
}

static int meson_axg_pmx_update_function(struct meson_pinctrl *pc,
   unsigned int pin, unsigned int func)
{
 const struct meson_pmx_bank *bank;
 int ret;
 int reg;
 int offset;

 ret = meson_axg_pmx_get_bank(pc, pin, &bank);
 if (ret)
  return ret;

 meson_pmx_calc_reg_and_offset(bank, pin, ®, &offset);

 ret = regmap_update_bits(pc->reg_mux, reg << 2,
  0xf << offset, (func & 0xf) << offset);

 return ret;
}

static int meson_axg_pmx_set_mux(struct pinctrl_dev *pcdev,
   unsigned int func_num, unsigned int group_num)
{
 int i;
 int ret;
 struct meson_pinctrl *pc = pinctrl_dev_get_drvdata(pcdev);
 const struct meson_pmx_func *func = &pc->data->funcs[func_num];
 const struct meson_pmx_group *group = &pc->data->groups[group_num];
 struct meson_pmx_axg_data *pmx_data =
  (struct meson_pmx_axg_data *)group->data;

 dev_dbg(pc->dev, "enable function %s, group %s\n", func->name,
  group->name);

 for (i = 0; i < group->num_pins; i++) {
  ret = meson_axg_pmx_update_function(pc, group->pins[i],
   pmx_data->func);
  if (ret)
   return ret;
 }

 return 0;
}

static int meson_axg_pmx_request_gpio(struct pinctrl_dev *pcdev,
   struct pinctrl_gpio_range *range, unsigned int offset)
{
 struct meson_pinctrl *pc = pinctrl_dev_get_drvdata(pcdev);

 return meson_axg_pmx_update_function(pc, offset, 0);
}

const struct pinmux_ops meson_axg_pmx_ops = {
 .set_mux = meson_axg_pmx_set_mux,
 .get_functions_count = meson_pmx_get_funcs_count,
 .get_function_name = meson_pmx_get_func_name,
 .get_function_groups = meson_pmx_get_groups,
 .gpio_request_enable = meson_axg_pmx_request_gpio,
};
EXPORT_SYMBOL_GPL(meson_axg_pmx_ops);

MODULE_DESCRIPTION("Amlogic Meson AXG second generation pinmux driver");
MODULE_LICENSE("Dual BSD/GPL");