Quelle  pinctrl-mt8135.c   Sprache: C

// SPDX-License-Identifier: GPL-2.0-only
/*
 * Copyright (c) 2014 MediaTek Inc.
 * Author: Hongzhou.Yang <hongzhou.yang@mediatek.com>
 */

#include <linux/init.h>
#include <linux/platform_device.h>
#include <linux/of.h>
#include <linux/pinctrl/pinctrl.h>
#include <linux/regmap.h>
#include <dt-bindings/pinctrl/mt65xx.h>

#include "pinctrl-mtk-common.h"
#include "pinctrl-mtk-mt8135.h"

#define DRV_BASE1    0x500
#define DRV_BASE2    0x510
#define PUPD_BASE1    0x400
#define PUPD_BASE2    0x450
#define R0_BASE1    0x4d0
#define R1_BASE1    0x200
#define R1_BASE2    0x250

struct mtk_spec_pull_set {
 unsigned char pin;
 unsigned char pupd_bit;
 unsigned short pupd_offset;
 unsigned short r0_offset;
 unsigned short r1_offset;
 unsigned char r0_bit;
 unsigned char r1_bit;
};

#define SPEC_PULL(_pin, _pupd_offset, _pupd_bit, _r0_offset, \
 _r0_bit, _r1_offset, _r1_bit) \
 { \
  .pin = _pin, \
  .pupd_offset = _pupd_offset, \
  .pupd_bit = _pupd_bit, \
  .r0_offset = _r0_offset, \
  .r0_bit = _r0_bit, \
  .r1_offset = _r1_offset, \
  .r1_bit = _r1_bit, \
 }

static const struct mtk_drv_group_desc mt8135_drv_grp[] =  {
 /* E8E4E2 2/4/6/8/10/12/14/16 */
 MTK_DRV_GRP(2, 16, 0, 2, 2),
 /* E8E4  4/8/12/16 */
 MTK_DRV_GRP(4, 16, 1, 2, 4),
 /* E4E2  2/4/6/8 */
 MTK_DRV_GRP(2, 8, 0, 1, 2),
 /* E16E8E4 4/8/12/16/20/24/28/32 */
 MTK_DRV_GRP(4, 32, 0, 2, 4)
};

static const struct mtk_pin_drv_grp mt8135_pin_drv[] = {
 MTK_PIN_DRV_GRP(0, DRV_BASE1, 0, 0),
 MTK_PIN_DRV_GRP(1, DRV_BASE1, 0, 0),
 MTK_PIN_DRV_GRP(2, DRV_BASE1, 0, 0),
 MTK_PIN_DRV_GRP(3, DRV_BASE1, 0, 0),
 MTK_PIN_DRV_GRP(4, DRV_BASE1, 4, 0),
 MTK_PIN_DRV_GRP(5, DRV_BASE1, 8, 0),
 MTK_PIN_DRV_GRP(6, DRV_BASE1, 0, 0),
 MTK_PIN_DRV_GRP(7, DRV_BASE1, 0, 0),
 MTK_PIN_DRV_GRP(8, DRV_BASE1, 0, 0),
 MTK_PIN_DRV_GRP(9, DRV_BASE1, 0, 0),

 MTK_PIN_DRV_GRP(10, DRV_BASE1, 12, 1),
 MTK_PIN_DRV_GRP(11, DRV_BASE1, 12, 1),
 MTK_PIN_DRV_GRP(12, DRV_BASE1, 12, 1),
 MTK_PIN_DRV_GRP(13, DRV_BASE1, 12, 1),
 MTK_PIN_DRV_GRP(14, DRV_BASE1, 12, 1),
 MTK_PIN_DRV_GRP(15, DRV_BASE1, 12, 1),
 MTK_PIN_DRV_GRP(16, DRV_BASE1, 12, 1),
 MTK_PIN_DRV_GRP(17, DRV_BASE1, 16, 1),
 MTK_PIN_DRV_GRP(18, DRV_BASE1, 16, 1),
 MTK_PIN_DRV_GRP(19, DRV_BASE1, 16, 1),
 MTK_PIN_DRV_GRP(20, DRV_BASE1, 16, 1),
 MTK_PIN_DRV_GRP(21, DRV_BASE1, 16, 1),
 MTK_PIN_DRV_GRP(22, DRV_BASE1, 16, 1),
 MTK_PIN_DRV_GRP(23, DRV_BASE1, 16, 1),
 MTK_PIN_DRV_GRP(24, DRV_BASE1, 16, 1),
 MTK_PIN_DRV_GRP(33, DRV_BASE1, 24, 1),
 MTK_PIN_DRV_GRP(34, DRV_BASE2, 12, 2),
 MTK_PIN_DRV_GRP(37, DRV_BASE2, 20, 1),
 MTK_PIN_DRV_GRP(38, DRV_BASE2, 20, 1),
 MTK_PIN_DRV_GRP(39, DRV_BASE2, 20, 1),
 MTK_PIN_DRV_GRP(40, DRV_BASE2, 24, 1),
 MTK_PIN_DRV_GRP(41, DRV_BASE2, 24, 1),
 MTK_PIN_DRV_GRP(42, DRV_BASE2, 24, 1),
 MTK_PIN_DRV_GRP(43, DRV_BASE2, 28, 1),
 MTK_PIN_DRV_GRP(44, DRV_BASE2, 28, 1),
 MTK_PIN_DRV_GRP(45, DRV_BASE2, 28, 1),
 MTK_PIN_DRV_GRP(46, DRV_BASE2, 28, 1),
 MTK_PIN_DRV_GRP(47, DRV_BASE2, 28, 1),

 MTK_PIN_DRV_GRP(49, DRV_BASE2+0x10, 0, 1),
 MTK_PIN_DRV_GRP(50, DRV_BASE2+0x10, 4, 1),
 MTK_PIN_DRV_GRP(51, DRV_BASE2+0x10, 8, 1),
 MTK_PIN_DRV_GRP(52, DRV_BASE2+0x10, 12, 2),
 MTK_PIN_DRV_GRP(53, DRV_BASE2+0x10, 16, 1),
 MTK_PIN_DRV_GRP(54, DRV_BASE2+0x10, 20, 1),
 MTK_PIN_DRV_GRP(55, DRV_BASE2+0x10, 24, 1),
 MTK_PIN_DRV_GRP(56, DRV_BASE2+0x10, 28, 1),

 MTK_PIN_DRV_GRP(57, DRV_BASE2+0x20, 0, 1),
 MTK_PIN_DRV_GRP(58, DRV_BASE2+0x20, 0, 1),
 MTK_PIN_DRV_GRP(59, DRV_BASE2+0x20, 0, 1),
 MTK_PIN_DRV_GRP(60, DRV_BASE2+0x20, 0, 1),
 MTK_PIN_DRV_GRP(61, DRV_BASE2+0x20, 0, 1),
 MTK_PIN_DRV_GRP(62, DRV_BASE2+0x20, 0, 1),
 MTK_PIN_DRV_GRP(63, DRV_BASE2+0x20, 4, 1),
 MTK_PIN_DRV_GRP(64, DRV_BASE2+0x20, 8, 1),
 MTK_PIN_DRV_GRP(65, DRV_BASE2+0x20, 12, 1),
 MTK_PIN_DRV_GRP(66, DRV_BASE2+0x20, 16, 1),
 MTK_PIN_DRV_GRP(67, DRV_BASE2+0x20, 20, 1),
 MTK_PIN_DRV_GRP(68, DRV_BASE2+0x20, 24, 1),
 MTK_PIN_DRV_GRP(69, DRV_BASE2+0x20, 28, 1),

 MTK_PIN_DRV_GRP(70, DRV_BASE2+0x30, 0, 1),
 MTK_PIN_DRV_GRP(71, DRV_BASE2+0x30, 4, 1),
 MTK_PIN_DRV_GRP(72, DRV_BASE2+0x30, 8, 1),
 MTK_PIN_DRV_GRP(73, DRV_BASE2+0x30, 12, 1),
 MTK_PIN_DRV_GRP(74, DRV_BASE2+0x30, 16, 1),
 MTK_PIN_DRV_GRP(75, DRV_BASE2+0x30, 20, 1),
 MTK_PIN_DRV_GRP(76, DRV_BASE2+0x30, 24, 1),
 MTK_PIN_DRV_GRP(77, DRV_BASE2+0x30, 28, 3),
 MTK_PIN_DRV_GRP(78, DRV_BASE2+0x30, 28, 3),

 MTK_PIN_DRV_GRP(79, DRV_BASE2+0x40, 0, 3),
 MTK_PIN_DRV_GRP(80, DRV_BASE2+0x40, 4, 3),

 MTK_PIN_DRV_GRP(81, DRV_BASE2+0x30, 28, 3),
 MTK_PIN_DRV_GRP(82, DRV_BASE2+0x30, 28, 3),

 MTK_PIN_DRV_GRP(83, DRV_BASE2+0x40, 8, 3),
 MTK_PIN_DRV_GRP(84, DRV_BASE2+0x40, 8, 3),
 MTK_PIN_DRV_GRP(85, DRV_BASE2+0x40, 12, 3),
 MTK_PIN_DRV_GRP(86, DRV_BASE2+0x40, 16, 3),
 MTK_PIN_DRV_GRP(87, DRV_BASE2+0x40, 8, 3),
 MTK_PIN_DRV_GRP(88, DRV_BASE2+0x40, 8, 3),

 MTK_PIN_DRV_GRP(89, DRV_BASE2+0x50, 12, 0),
 MTK_PIN_DRV_GRP(90, DRV_BASE2+0x50, 12, 0),
 MTK_PIN_DRV_GRP(91, DRV_BASE2+0x50, 12, 0),
 MTK_PIN_DRV_GRP(92, DRV_BASE2+0x50, 12, 0),
 MTK_PIN_DRV_GRP(93, DRV_BASE2+0x50, 12, 0),
 MTK_PIN_DRV_GRP(94, DRV_BASE2+0x50, 12, 0),
 MTK_PIN_DRV_GRP(95, DRV_BASE2+0x50, 12, 0),

 MTK_PIN_DRV_GRP(96, DRV_BASE1+0xb0, 28, 0),

 MTK_PIN_DRV_GRP(97, DRV_BASE2+0x50, 12, 0),
 MTK_PIN_DRV_GRP(98, DRV_BASE2+0x50, 16, 0),
 MTK_PIN_DRV_GRP(99, DRV_BASE2+0x50, 20, 1),
 MTK_PIN_DRV_GRP(102, DRV_BASE2+0x50, 24, 1),
 MTK_PIN_DRV_GRP(103, DRV_BASE2+0x50, 28, 1),


 MTK_PIN_DRV_GRP(104, DRV_BASE2+0x60, 0, 1),
 MTK_PIN_DRV_GRP(105, DRV_BASE2+0x60, 4, 1),
 MTK_PIN_DRV_GRP(106, DRV_BASE2+0x60, 4, 1),
 MTK_PIN_DRV_GRP(107, DRV_BASE2+0x60, 4, 1),
 MTK_PIN_DRV_GRP(108, DRV_BASE2+0x60, 4, 1),
 MTK_PIN_DRV_GRP(109, DRV_BASE2+0x60, 8, 2),
 MTK_PIN_DRV_GRP(110, DRV_BASE2+0x60, 12, 2),
 MTK_PIN_DRV_GRP(111, DRV_BASE2+0x60, 16, 2),
 MTK_PIN_DRV_GRP(112, DRV_BASE2+0x60, 20, 2),
 MTK_PIN_DRV_GRP(113, DRV_BASE2+0x60, 24, 2),
 MTK_PIN_DRV_GRP(114, DRV_BASE2+0x60, 28, 2),

 MTK_PIN_DRV_GRP(115, DRV_BASE2+0x70, 0, 2),
 MTK_PIN_DRV_GRP(116, DRV_BASE2+0x70, 4, 2),
 MTK_PIN_DRV_GRP(117, DRV_BASE2+0x70, 8, 2),
 MTK_PIN_DRV_GRP(118, DRV_BASE2+0x70, 12, 2),
 MTK_PIN_DRV_GRP(119, DRV_BASE2+0x70, 16, 2),
 MTK_PIN_DRV_GRP(120, DRV_BASE2+0x70, 20, 2),

 MTK_PIN_DRV_GRP(181, DRV_BASE1+0xa0, 12, 1),
 MTK_PIN_DRV_GRP(182, DRV_BASE1+0xa0, 16, 1),
 MTK_PIN_DRV_GRP(183, DRV_BASE1+0xa0, 20, 1),
 MTK_PIN_DRV_GRP(184, DRV_BASE1+0xa0, 24, 1),
 MTK_PIN_DRV_GRP(185, DRV_BASE1+0xa0, 28, 1),

 MTK_PIN_DRV_GRP(186, DRV_BASE1+0xb0, 0, 2),
 MTK_PIN_DRV_GRP(187, DRV_BASE1+0xb0, 0, 2),
 MTK_PIN_DRV_GRP(188, DRV_BASE1+0xb0, 0, 2),
 MTK_PIN_DRV_GRP(189, DRV_BASE1+0xb0, 0, 2),
 MTK_PIN_DRV_GRP(190, DRV_BASE1+0xb0, 4, 1),
 MTK_PIN_DRV_GRP(191, DRV_BASE1+0xb0, 8, 1),
 MTK_PIN_DRV_GRP(192, DRV_BASE1+0xb0, 12, 1),

 MTK_PIN_DRV_GRP(197, DRV_BASE1+0xb0, 16, 0),
 MTK_PIN_DRV_GRP(198, DRV_BASE1+0xb0, 16, 0),
 MTK_PIN_DRV_GRP(199, DRV_BASE1+0xb0, 20, 0),
 MTK_PIN_DRV_GRP(200, DRV_BASE1+0xb0, 24, 0),
 MTK_PIN_DRV_GRP(201, DRV_BASE1+0xb0, 16, 0),
 MTK_PIN_DRV_GRP(202, DRV_BASE1+0xb0, 16, 0)
};

static const struct mtk_spec_pull_set spec_pupd[] = {
 SPEC_PULL(0, PUPD_BASE1, 0, R0_BASE1, 9, R1_BASE1, 0),
 SPEC_PULL(1, PUPD_BASE1, 1, R0_BASE1, 8, R1_BASE1, 1),
 SPEC_PULL(2, PUPD_BASE1, 2, R0_BASE1, 7, R1_BASE1, 2),
 SPEC_PULL(3, PUPD_BASE1, 3, R0_BASE1, 6, R1_BASE1, 3),
 SPEC_PULL(4, PUPD_BASE1, 4, R0_BASE1, 1, R1_BASE1, 4),
 SPEC_PULL(5, PUPD_BASE1, 5, R0_BASE1, 0, R1_BASE1, 5),
 SPEC_PULL(6, PUPD_BASE1, 6, R0_BASE1, 5, R1_BASE1, 6),
 SPEC_PULL(7, PUPD_BASE1, 7, R0_BASE1, 4, R1_BASE1, 7),
 SPEC_PULL(8, PUPD_BASE1, 8, R0_BASE1, 3, R1_BASE1, 8),
 SPEC_PULL(9, PUPD_BASE1, 9, R0_BASE1, 2, R1_BASE1, 9),
 SPEC_PULL(89, PUPD_BASE2, 9, R0_BASE1, 18, R1_BASE2, 9),
 SPEC_PULL(90, PUPD_BASE2, 10, R0_BASE1, 19, R1_BASE2, 10),
 SPEC_PULL(91, PUPD_BASE2, 11, R0_BASE1, 23, R1_BASE2, 11),
 SPEC_PULL(92, PUPD_BASE2, 12, R0_BASE1, 24, R1_BASE2, 12),
 SPEC_PULL(93, PUPD_BASE2, 13, R0_BASE1, 25, R1_BASE2, 13),
 SPEC_PULL(94, PUPD_BASE2, 14, R0_BASE1, 22, R1_BASE2, 14),
 SPEC_PULL(95, PUPD_BASE2, 15, R0_BASE1, 20, R1_BASE2, 15),
 SPEC_PULL(96, PUPD_BASE2+0x10, 0, R0_BASE1, 16, R1_BASE2+0x10, 0),
 SPEC_PULL(97, PUPD_BASE2+0x10, 1, R0_BASE1, 21, R1_BASE2+0x10, 1),
 SPEC_PULL(98, PUPD_BASE2+0x10, 2, R0_BASE1, 17, R1_BASE2+0x10, 2),
 SPEC_PULL(197, PUPD_BASE1+0xc0, 5, R0_BASE1, 13, R1_BASE2+0xc0, 5),
 SPEC_PULL(198, PUPD_BASE2+0xc0, 6, R0_BASE1, 14, R1_BASE2+0xc0, 6),
 SPEC_PULL(199, PUPD_BASE2+0xc0, 7, R0_BASE1, 11, R1_BASE2+0xc0, 7),
 SPEC_PULL(200, PUPD_BASE2+0xc0, 8, R0_BASE1, 10, R1_BASE2+0xc0, 8),
 SPEC_PULL(201, PUPD_BASE2+0xc0, 9, R0_BASE1, 13, R1_BASE2+0xc0, 9),
 SPEC_PULL(202, PUPD_BASE2+0xc0, 10, R0_BASE1, 12, R1_BASE2+0xc0, 10)
};

static int spec_pull_set(struct regmap *regmap,
  const struct mtk_pinctrl_devdata *devdata,
  unsigned int pin, bool isup, unsigned int r1r0)
{
 unsigned int i;
 unsigned int reg_pupd, reg_set_r0, reg_set_r1;
 unsigned int reg_rst_r0, reg_rst_r1;
 unsigned char align = devdata->port_align;
 bool find = false;

 for (i = 0; i < ARRAY_SIZE(spec_pupd); i++) {
  if (pin == spec_pupd[i].pin) {
   find = true;
   break;
  }
 }

 if (!find)
  return -EINVAL;

 if (isup)
  reg_pupd = spec_pupd[i].pupd_offset + align;
 else
  reg_pupd = spec_pupd[i].pupd_offset + (align << 1);

 regmap_write(regmap, reg_pupd, spec_pupd[i].pupd_bit);

 reg_set_r0 = spec_pupd[i].r0_offset + align;
 reg_rst_r0 = spec_pupd[i].r0_offset + (align << 1);
 reg_set_r1 = spec_pupd[i].r1_offset + align;
 reg_rst_r1 = spec_pupd[i].r1_offset + (align << 1);

 switch (r1r0) {
 case MTK_PUPD_SET_R1R0_00:
  regmap_write(regmap, reg_rst_r0, spec_pupd[i].r0_bit);
  regmap_write(regmap, reg_rst_r1, spec_pupd[i].r1_bit);
  break;
 case MTK_PUPD_SET_R1R0_01:
  regmap_write(regmap, reg_set_r0, spec_pupd[i].r0_bit);
  regmap_write(regmap, reg_rst_r1, spec_pupd[i].r1_bit);
  break;
 case MTK_PUPD_SET_R1R0_10:
  regmap_write(regmap, reg_rst_r0, spec_pupd[i].r0_bit);
  regmap_write(regmap, reg_set_r1, spec_pupd[i].r1_bit);
  break;
 case MTK_PUPD_SET_R1R0_11:
  regmap_write(regmap, reg_set_r0, spec_pupd[i].r0_bit);
  regmap_write(regmap, reg_set_r1, spec_pupd[i].r1_bit);
  break;
 default:
  return -EINVAL;
 }

 return 0;
}

static const struct mtk_pinctrl_devdata mt8135_pinctrl_data = {
 .pins = mtk_pins_mt8135,
 .npins = ARRAY_SIZE(mtk_pins_mt8135),
 .grp_desc = mt8135_drv_grp,
 .n_grp_cls = ARRAY_SIZE(mt8135_drv_grp),
 .pin_drv_grp = mt8135_pin_drv,
 .n_pin_drv_grps = ARRAY_SIZE(mt8135_pin_drv),
 .spec_pull_set = spec_pull_set,
 .dir_offset = 0x0000,
 .ies_offset = 0x0100,
 .pullen_offset = 0x0200,
 .smt_offset = 0x0300,
 .pullsel_offset = 0x0400,
 .dout_offset = 0x0800,
 .din_offset = 0x0A00,
 .pinmux_offset = 0x0C00,
 .type1_start = 34,
 .type1_end = 149,
 .port_shf = 4,
 .port_mask = 0xf,
 .port_align = 4,
 .mode_mask = 0xf,
 .mode_per_reg = 5,
 .mode_shf = 4,
 .eint_hw = {
  .port_mask = 7,
  .ports     = 6,
  .ap_num    = 192,
  .db_cnt    = 16,
  .db_time = debounce_time_mt2701,
 },
};

static const struct of_device_id mt8135_pctrl_match[] = {
 { .compatible = "mediatek,mt8135-pinctrl", .data = &mt8135_pinctrl_data },
 { }
};

static struct platform_driver mtk_pinctrl_driver = {
 .probe = mtk_pctrl_common_probe,
 .driver = {
  .name = "mediatek-mt8135-pinctrl",
  .of_match_table = mt8135_pctrl_match,
 },
};

static int __init mtk_pinctrl_init(void)
{
 return platform_driver_register(&mtk_pinctrl_driver);
}
arch_initcall(mtk_pinctrl_init);