1234567891011121314151617181920212223242526272829303132333435363738394041424344454647484950515253545556575859606162636465666768697071727374757677787980818283848586878889909192939495969798991001011021031041051061071081091101111121131141151161171181191201211221231241251261271281291301311321331341351361371381391401411421431441451461471481491501511521531541551561571581591601611621631641651661671681691701711721731741751761771781791801811821831841851861871881891901911921931941951961971981992002012022032042052062072082092102112122132142152162172182192202212222232242252262272282292302312322332342352362372382392402412422432442452462472482492502512522532542552562572582592602612622632642652662672682692702712722732742752762772782792802812822832842852862872882892902912922932942952962972982993003013023033043053063073083093103113123133143153163173183193203213223233243253263273283293303313323333343353363373383393403413423433443453463473483493503513523533543553563573583593603613623633643653663673683693703713723733743753763773783793803813823833843853863873883893903913923933943953963973983994004014024034044054064074084094104114124134144154164174184194204214224234244254264274284294304314324334344354364374384394404414424434444454464474484494504514524534544554564574584594604614624634644654664674684694704714724734744754764774784794804814824834844854864874884894904914924934944954964974984995005015025035045055065075085095105115125135145155165175185195205215225235245255265275285295305315325335345355365375385395405415425435445455465475485495505515525535545555565575585595605615625635645655665675685695705715725735745755765775785795805815825835845855865875885895905915925935945955965975985996006016026036046056066076086096106116126136146156166176186196206216226236246256266276286296306316326336346356366376386396406416426436446456466476486496506516526536546556566576586596606616626636646656666676686696706716726736746756766776786796806816826836846856866876886896906916926936946956966976986997007017027037047057067077087097107117127137147157167177187197207217227237247257267277287297307317327337347357367377387397407417427437447457467477487497507517527537547557567577587597607617627637647657667677687697707717727737747757767777787797807817827837847857867877887897907917927937947957967977987998008018028038048058068078088098108118128138148158168178188198208218228238248258268278288298308318328338348358368378388398408418428438448458468478488498508518528538548558568578588598608618628638648658668678688698708718728738748758768778788798808818828838848858868878888898908918928938948958968978988999009019029039049059069079089099109119129139149159169179189199209219229239249259269279289299309319329339349359369379389399409419429439449459469479489499509519529539549559569579589599609619629639649659669679689699709719729739749759769779789799809819829839849859869879889899909919929939949959969979989991000100110021003100410051006100710081009101010111012101310141015101610171018101910201021102210231024102510261027102810291030103110321033103410351036103710381039104010411042104310441045104610471048104910501051105210531054105510561057105810591060106110621063106410651066106710681069107010711072107310741075107610771078107910801081108210831084108510861087108810891090109110921093109410951096109710981099110011011102110311041105 |
- // SPDX-License-Identifier: GPL-2.0-only
- /*
- * Pinctrl for Cirrus Logic Madera codecs
- *
- * Copyright (C) 2016-2018 Cirrus Logic
- */
- #include <linux/err.h>
- #include <linux/module.h>
- #include <linux/platform_device.h>
- #include <linux/regmap.h>
- #include <linux/slab.h>
- #include <linux/pinctrl/machine.h>
- #include <linux/pinctrl/pinctrl.h>
- #include <linux/pinctrl/pinmux.h>
- #include <linux/pinctrl/pinconf.h>
- #include <linux/pinctrl/pinconf-generic.h>
- #include <linux/mfd/madera/core.h>
- #include <linux/mfd/madera/registers.h>
- #include "../pinctrl-utils.h"
- #include "pinctrl-madera.h"
- /*
- * Use pin GPIO names for consistency
- * NOTE: IDs are zero-indexed for coding convenience
- */
- static const struct pinctrl_pin_desc madera_pins[] = {
- PINCTRL_PIN(0, "gpio1"),
- PINCTRL_PIN(1, "gpio2"),
- PINCTRL_PIN(2, "gpio3"),
- PINCTRL_PIN(3, "gpio4"),
- PINCTRL_PIN(4, "gpio5"),
- PINCTRL_PIN(5, "gpio6"),
- PINCTRL_PIN(6, "gpio7"),
- PINCTRL_PIN(7, "gpio8"),
- PINCTRL_PIN(8, "gpio9"),
- PINCTRL_PIN(9, "gpio10"),
- PINCTRL_PIN(10, "gpio11"),
- PINCTRL_PIN(11, "gpio12"),
- PINCTRL_PIN(12, "gpio13"),
- PINCTRL_PIN(13, "gpio14"),
- PINCTRL_PIN(14, "gpio15"),
- PINCTRL_PIN(15, "gpio16"),
- PINCTRL_PIN(16, "gpio17"),
- PINCTRL_PIN(17, "gpio18"),
- PINCTRL_PIN(18, "gpio19"),
- PINCTRL_PIN(19, "gpio20"),
- PINCTRL_PIN(20, "gpio21"),
- PINCTRL_PIN(21, "gpio22"),
- PINCTRL_PIN(22, "gpio23"),
- PINCTRL_PIN(23, "gpio24"),
- PINCTRL_PIN(24, "gpio25"),
- PINCTRL_PIN(25, "gpio26"),
- PINCTRL_PIN(26, "gpio27"),
- PINCTRL_PIN(27, "gpio28"),
- PINCTRL_PIN(28, "gpio29"),
- PINCTRL_PIN(29, "gpio30"),
- PINCTRL_PIN(30, "gpio31"),
- PINCTRL_PIN(31, "gpio32"),
- PINCTRL_PIN(32, "gpio33"),
- PINCTRL_PIN(33, "gpio34"),
- PINCTRL_PIN(34, "gpio35"),
- PINCTRL_PIN(35, "gpio36"),
- PINCTRL_PIN(36, "gpio37"),
- PINCTRL_PIN(37, "gpio38"),
- PINCTRL_PIN(38, "gpio39"),
- PINCTRL_PIN(39, "gpio40"),
- };
- /*
- * All single-pin functions can be mapped to any GPIO, however pinmux applies
- * functions to pin groups and only those groups declared as supporting that
- * function. To make this work we must put each pin in its own dummy group so
- * that the functions can be described as applying to all pins.
- * Since these do not correspond to anything in the actual hardware - they are
- * merely an adaptation to pinctrl's view of the world - we use the same name
- * as the pin to avoid confusion when comparing with datasheet instructions
- */
- static const char * const madera_pin_single_group_names[] = {
- "gpio1", "gpio2", "gpio3", "gpio4", "gpio5", "gpio6", "gpio7",
- "gpio8", "gpio9", "gpio10", "gpio11", "gpio12", "gpio13", "gpio14",
- "gpio15", "gpio16", "gpio17", "gpio18", "gpio19", "gpio20", "gpio21",
- "gpio22", "gpio23", "gpio24", "gpio25", "gpio26", "gpio27", "gpio28",
- "gpio29", "gpio30", "gpio31", "gpio32", "gpio33", "gpio34", "gpio35",
- "gpio36", "gpio37", "gpio38", "gpio39", "gpio40",
- };
- /* set of pin numbers for single-pin groups, zero-indexed */
- static const unsigned int madera_pin_single_group_pins[] = {
- 0, 1, 2, 3, 4, 5, 6,
- 7, 8, 9, 10, 11, 12, 13,
- 14, 15, 16, 17, 18, 19, 20,
- 21, 22, 23, 24, 25, 26, 27,
- 28, 29, 30, 31, 32, 33, 34,
- 35, 36, 37, 38, 39,
- };
- static const char * const madera_aif1_group_names[] = { "aif1" };
- static const char * const madera_aif2_group_names[] = { "aif2" };
- static const char * const madera_aif3_group_names[] = { "aif3" };
- static const char * const madera_aif4_group_names[] = { "aif4" };
- static const char * const madera_mif1_group_names[] = { "mif1" };
- static const char * const madera_mif2_group_names[] = { "mif2" };
- static const char * const madera_mif3_group_names[] = { "mif3" };
- static const char * const madera_dmic3_group_names[] = { "dmic3" };
- static const char * const madera_dmic4_group_names[] = { "dmic4" };
- static const char * const madera_dmic5_group_names[] = { "dmic5" };
- static const char * const madera_dmic6_group_names[] = { "dmic6" };
- static const char * const madera_spk1_group_names[] = { "pdmspk1" };
- static const char * const madera_spk2_group_names[] = { "pdmspk2" };
- /*
- * alt-functions always apply to a single pin group, other functions always
- * apply to all pins
- */
- static const struct {
- const char *name;
- const char * const *group_names;
- u32 func;
- } madera_mux_funcs[] = {
- {
- .name = "aif1",
- .group_names = madera_aif1_group_names,
- .func = 0x000
- },
- {
- .name = "aif2",
- .group_names = madera_aif2_group_names,
- .func = 0x000
- },
- {
- .name = "aif3",
- .group_names = madera_aif3_group_names,
- .func = 0x000
- },
- {
- .name = "aif4",
- .group_names = madera_aif4_group_names,
- .func = 0x000
- },
- {
- .name = "mif1",
- .group_names = madera_mif1_group_names,
- .func = 0x000
- },
- {
- .name = "mif2",
- .group_names = madera_mif2_group_names,
- .func = 0x000
- },
- {
- .name = "mif3",
- .group_names = madera_mif3_group_names,
- .func = 0x000
- },
- {
- .name = "dmic3",
- .group_names = madera_dmic3_group_names,
- .func = 0x000
- },
- {
- .name = "dmic4",
- .group_names = madera_dmic4_group_names,
- .func = 0x000
- },
- {
- .name = "dmic5",
- .group_names = madera_dmic5_group_names,
- .func = 0x000
- },
- {
- .name = "dmic6",
- .group_names = madera_dmic6_group_names,
- .func = 0x000
- },
- {
- .name = "pdmspk1",
- .group_names = madera_spk1_group_names,
- .func = 0x000
- },
- {
- .name = "pdmspk2",
- .group_names = madera_spk2_group_names,
- .func = 0x000
- },
- {
- .name = "io",
- .group_names = madera_pin_single_group_names,
- .func = 0x001
- },
- {
- .name = "dsp-gpio",
- .group_names = madera_pin_single_group_names,
- .func = 0x002
- },
- {
- .name = "irq1",
- .group_names = madera_pin_single_group_names,
- .func = 0x003
- },
- {
- .name = "irq2",
- .group_names = madera_pin_single_group_names,
- .func = 0x004
- },
- {
- .name = "fll1-clk",
- .group_names = madera_pin_single_group_names,
- .func = 0x010
- },
- {
- .name = "fll2-clk",
- .group_names = madera_pin_single_group_names,
- .func = 0x011
- },
- {
- .name = "fll3-clk",
- .group_names = madera_pin_single_group_names,
- .func = 0x012
- },
- {
- .name = "fllao-clk",
- .group_names = madera_pin_single_group_names,
- .func = 0x013
- },
- {
- .name = "fll1-lock",
- .group_names = madera_pin_single_group_names,
- .func = 0x018
- },
- {
- .name = "fll2-lock",
- .group_names = madera_pin_single_group_names,
- .func = 0x019
- },
- {
- .name = "fll3-lock",
- .group_names = madera_pin_single_group_names,
- .func = 0x01a
- },
- {
- .name = "fllao-lock",
- .group_names = madera_pin_single_group_names,
- .func = 0x01b
- },
- {
- .name = "opclk",
- .group_names = madera_pin_single_group_names,
- .func = 0x040
- },
- {
- .name = "opclk-async",
- .group_names = madera_pin_single_group_names,
- .func = 0x041
- },
- {
- .name = "pwm1",
- .group_names = madera_pin_single_group_names,
- .func = 0x048
- },
- {
- .name = "pwm2",
- .group_names = madera_pin_single_group_names,
- .func = 0x049
- },
- {
- .name = "spdif",
- .group_names = madera_pin_single_group_names,
- .func = 0x04c
- },
- {
- .name = "asrc1-in1-lock",
- .group_names = madera_pin_single_group_names,
- .func = 0x088
- },
- {
- .name = "asrc1-in2-lock",
- .group_names = madera_pin_single_group_names,
- .func = 0x089
- },
- {
- .name = "asrc2-in1-lock",
- .group_names = madera_pin_single_group_names,
- .func = 0x08a
- },
- {
- .name = "asrc2-in2-lock",
- .group_names = madera_pin_single_group_names,
- .func = 0x08b
- },
- {
- .name = "spkl-short-circuit",
- .group_names = madera_pin_single_group_names,
- .func = 0x0b6
- },
- {
- .name = "spkr-short-circuit",
- .group_names = madera_pin_single_group_names,
- .func = 0x0b7
- },
- {
- .name = "spk-shutdown",
- .group_names = madera_pin_single_group_names,
- .func = 0x0e0
- },
- {
- .name = "spk-overheat-shutdown",
- .group_names = madera_pin_single_group_names,
- .func = 0x0e1
- },
- {
- .name = "spk-overheat-warn",
- .group_names = madera_pin_single_group_names,
- .func = 0x0e2
- },
- {
- .name = "timer1-sts",
- .group_names = madera_pin_single_group_names,
- .func = 0x140
- },
- {
- .name = "timer2-sts",
- .group_names = madera_pin_single_group_names,
- .func = 0x141
- },
- {
- .name = "timer3-sts",
- .group_names = madera_pin_single_group_names,
- .func = 0x142
- },
- {
- .name = "timer4-sts",
- .group_names = madera_pin_single_group_names,
- .func = 0x143
- },
- {
- .name = "timer5-sts",
- .group_names = madera_pin_single_group_names,
- .func = 0x144
- },
- {
- .name = "timer6-sts",
- .group_names = madera_pin_single_group_names,
- .func = 0x145
- },
- {
- .name = "timer7-sts",
- .group_names = madera_pin_single_group_names,
- .func = 0x146
- },
- {
- .name = "timer8-sts",
- .group_names = madera_pin_single_group_names,
- .func = 0x147
- },
- {
- .name = "log1-fifo-ne",
- .group_names = madera_pin_single_group_names,
- .func = 0x150
- },
- {
- .name = "log2-fifo-ne",
- .group_names = madera_pin_single_group_names,
- .func = 0x151
- },
- {
- .name = "log3-fifo-ne",
- .group_names = madera_pin_single_group_names,
- .func = 0x152
- },
- {
- .name = "log4-fifo-ne",
- .group_names = madera_pin_single_group_names,
- .func = 0x153
- },
- {
- .name = "log5-fifo-ne",
- .group_names = madera_pin_single_group_names,
- .func = 0x154
- },
- {
- .name = "log6-fifo-ne",
- .group_names = madera_pin_single_group_names,
- .func = 0x155
- },
- {
- .name = "log7-fifo-ne",
- .group_names = madera_pin_single_group_names,
- .func = 0x156
- },
- {
- .name = "log8-fifo-ne",
- .group_names = madera_pin_single_group_names,
- .func = 0x157
- },
- {
- .name = "aux-pdm-clk",
- .group_names = madera_pin_single_group_names,
- .func = 0x280
- },
- {
- .name = "aux-pdm-dat",
- .group_names = madera_pin_single_group_names,
- .func = 0x281
- },
- };
- static u16 madera_pin_make_drv_str(struct madera_pin_private *priv,
- unsigned int milliamps)
- {
- switch (milliamps) {
- case 4:
- return 0;
- case 8:
- return 2 << MADERA_GP1_DRV_STR_SHIFT;
- default:
- break;
- }
- dev_warn(priv->dev, "%u mA not a valid drive strength", milliamps);
- return 0;
- }
- static unsigned int madera_pin_unmake_drv_str(struct madera_pin_private *priv,
- u16 regval)
- {
- regval = (regval & MADERA_GP1_DRV_STR_MASK) >> MADERA_GP1_DRV_STR_SHIFT;
- switch (regval) {
- case 0:
- return 4;
- case 2:
- return 8;
- default:
- return 0;
- }
- }
- static int madera_get_groups_count(struct pinctrl_dev *pctldev)
- {
- struct madera_pin_private *priv = pinctrl_dev_get_drvdata(pctldev);
- /* Number of alt function groups plus number of single-pin groups */
- return priv->chip->n_pin_groups + priv->chip->n_pins;
- }
- static const char *madera_get_group_name(struct pinctrl_dev *pctldev,
- unsigned int selector)
- {
- struct madera_pin_private *priv = pinctrl_dev_get_drvdata(pctldev);
- if (selector < priv->chip->n_pin_groups)
- return priv->chip->pin_groups[selector].name;
- selector -= priv->chip->n_pin_groups;
- return madera_pin_single_group_names[selector];
- }
- static int madera_get_group_pins(struct pinctrl_dev *pctldev,
- unsigned int selector,
- const unsigned int **pins,
- unsigned int *num_pins)
- {
- struct madera_pin_private *priv = pinctrl_dev_get_drvdata(pctldev);
- if (selector < priv->chip->n_pin_groups) {
- *pins = priv->chip->pin_groups[selector].pins;
- *num_pins = priv->chip->pin_groups[selector].n_pins;
- } else {
- /* return the dummy group for a single pin */
- selector -= priv->chip->n_pin_groups;
- *pins = &madera_pin_single_group_pins[selector];
- *num_pins = 1;
- }
- return 0;
- }
- static void madera_pin_dbg_show_fn(struct madera_pin_private *priv,
- struct seq_file *s,
- unsigned int pin, unsigned int fn)
- {
- const struct madera_pin_chip *chip = priv->chip;
- int i, g_pin;
- if (fn != 0) {
- for (i = 0; i < ARRAY_SIZE(madera_mux_funcs); ++i) {
- if (madera_mux_funcs[i].func == fn) {
- seq_printf(s, " FN=%s",
- madera_mux_funcs[i].name);
- return;
- }
- }
- return; /* ignore unknown function values */
- }
- /* alt function */
- for (i = 0; i < chip->n_pin_groups; ++i) {
- for (g_pin = 0; g_pin < chip->pin_groups[i].n_pins; ++g_pin) {
- if (chip->pin_groups[i].pins[g_pin] == pin) {
- seq_printf(s, " FN=%s",
- chip->pin_groups[i].name);
- return;
- }
- }
- }
- }
- static void __maybe_unused madera_pin_dbg_show(struct pinctrl_dev *pctldev,
- struct seq_file *s,
- unsigned int pin)
- {
- struct madera_pin_private *priv = pinctrl_dev_get_drvdata(pctldev);
- unsigned int conf[2];
- unsigned int reg = MADERA_GPIO1_CTRL_1 + (2 * pin);
- unsigned int fn;
- int ret;
- ret = regmap_read(priv->madera->regmap, reg, &conf[0]);
- if (ret)
- return;
- ret = regmap_read(priv->madera->regmap, reg + 1, &conf[1]);
- if (ret)
- return;
- seq_printf(s, "%04x:%04x", conf[0], conf[1]);
- fn = (conf[0] & MADERA_GP1_FN_MASK) >> MADERA_GP1_FN_SHIFT;
- madera_pin_dbg_show_fn(priv, s, pin, fn);
- /* State of direction bit is only relevant if function==1 */
- if (fn == 1) {
- if (conf[1] & MADERA_GP1_DIR_MASK)
- seq_puts(s, " IN");
- else
- seq_puts(s, " OUT");
- }
- if (conf[1] & MADERA_GP1_PU_MASK)
- seq_puts(s, " PU");
- if (conf[1] & MADERA_GP1_PD_MASK)
- seq_puts(s, " PD");
- if (conf[0] & MADERA_GP1_DB_MASK)
- seq_puts(s, " DB");
- if (conf[0] & MADERA_GP1_OP_CFG_MASK)
- seq_puts(s, " OD");
- else
- seq_puts(s, " CMOS");
- seq_printf(s, " DRV=%umA", madera_pin_unmake_drv_str(priv, conf[1]));
- if (conf[0] & MADERA_GP1_IP_CFG_MASK)
- seq_puts(s, " SCHMITT");
- }
- static const struct pinctrl_ops madera_pin_group_ops = {
- .get_groups_count = madera_get_groups_count,
- .get_group_name = madera_get_group_name,
- .get_group_pins = madera_get_group_pins,
- #if IS_ENABLED(CONFIG_OF)
- .dt_node_to_map = pinconf_generic_dt_node_to_map_all,
- .dt_free_map = pinctrl_utils_free_map,
- #endif
- #if IS_ENABLED(CONFIG_DEBUG_FS)
- .pin_dbg_show = madera_pin_dbg_show,
- #endif
- };
- static int madera_mux_get_funcs_count(struct pinctrl_dev *pctldev)
- {
- return ARRAY_SIZE(madera_mux_funcs);
- }
- static const char *madera_mux_get_func_name(struct pinctrl_dev *pctldev,
- unsigned int selector)
- {
- return madera_mux_funcs[selector].name;
- }
- static int madera_mux_get_groups(struct pinctrl_dev *pctldev,
- unsigned int selector,
- const char * const **groups,
- unsigned int * const num_groups)
- {
- struct madera_pin_private *priv = pinctrl_dev_get_drvdata(pctldev);
- *groups = madera_mux_funcs[selector].group_names;
- if (madera_mux_funcs[selector].func == 0) {
- /* alt func always maps to a single group */
- *num_groups = 1;
- } else {
- /* other funcs map to all available gpio pins */
- *num_groups = priv->chip->n_pins;
- }
- return 0;
- }
- static int madera_mux_set_mux(struct pinctrl_dev *pctldev,
- unsigned int selector,
- unsigned int group)
- {
- struct madera_pin_private *priv = pinctrl_dev_get_drvdata(pctldev);
- struct madera *madera = priv->madera;
- const struct madera_pin_groups *pin_group = priv->chip->pin_groups;
- unsigned int n_chip_groups = priv->chip->n_pin_groups;
- const char *func_name = madera_mux_funcs[selector].name;
- unsigned int reg;
- int i, ret = 0;
- dev_dbg(priv->dev, "%s selecting %u (%s) for group %u (%s)\n",
- __func__, selector, func_name, group,
- madera_get_group_name(pctldev, group));
- if (madera_mux_funcs[selector].func == 0) {
- /* alt func pin assignments are codec-specific */
- for (i = 0; i < n_chip_groups; ++i) {
- if (strcmp(func_name, pin_group->name) == 0)
- break;
- ++pin_group;
- }
- if (i == n_chip_groups)
- return -EINVAL;
- for (i = 0; i < pin_group->n_pins; ++i) {
- reg = MADERA_GPIO1_CTRL_1 + (2 * pin_group->pins[i]);
- dev_dbg(priv->dev, "%s setting 0x%x func bits to 0\n",
- __func__, reg);
- ret = regmap_update_bits(madera->regmap, reg,
- MADERA_GP1_FN_MASK, 0);
- if (ret)
- break;
- }
- } else {
- /*
- * for other funcs the group will be the gpio number and will
- * be offset by the number of chip-specific functions at the
- * start of the group list
- */
- group -= n_chip_groups;
- reg = MADERA_GPIO1_CTRL_1 + (2 * group);
- dev_dbg(priv->dev, "%s setting 0x%x func bits to 0x%x\n",
- __func__, reg, madera_mux_funcs[selector].func);
- ret = regmap_update_bits(madera->regmap,
- reg,
- MADERA_GP1_FN_MASK,
- madera_mux_funcs[selector].func);
- }
- if (ret)
- dev_err(priv->dev, "Failed to write to 0x%x (%d)\n", reg, ret);
- return ret;
- }
- static int madera_gpio_set_direction(struct pinctrl_dev *pctldev,
- struct pinctrl_gpio_range *range,
- unsigned int offset,
- bool input)
- {
- struct madera_pin_private *priv = pinctrl_dev_get_drvdata(pctldev);
- struct madera *madera = priv->madera;
- unsigned int reg = MADERA_GPIO1_CTRL_2 + (2 * offset);
- unsigned int val;
- int ret;
- if (input)
- val = MADERA_GP1_DIR;
- else
- val = 0;
- ret = regmap_update_bits(madera->regmap, reg, MADERA_GP1_DIR_MASK, val);
- if (ret)
- dev_err(priv->dev, "Failed to write to 0x%x (%d)\n", reg, ret);
- return ret;
- }
- static int madera_gpio_request_enable(struct pinctrl_dev *pctldev,
- struct pinctrl_gpio_range *range,
- unsigned int offset)
- {
- struct madera_pin_private *priv = pinctrl_dev_get_drvdata(pctldev);
- struct madera *madera = priv->madera;
- unsigned int reg = MADERA_GPIO1_CTRL_1 + (2 * offset);
- int ret;
- /* put the pin into GPIO mode */
- ret = regmap_update_bits(madera->regmap, reg, MADERA_GP1_FN_MASK, 1);
- if (ret)
- dev_err(priv->dev, "Failed to write to 0x%x (%d)\n", reg, ret);
- return ret;
- }
- static void madera_gpio_disable_free(struct pinctrl_dev *pctldev,
- struct pinctrl_gpio_range *range,
- unsigned int offset)
- {
- struct madera_pin_private *priv = pinctrl_dev_get_drvdata(pctldev);
- struct madera *madera = priv->madera;
- unsigned int reg = MADERA_GPIO1_CTRL_1 + (2 * offset);
- int ret;
- /* disable GPIO by setting to GPIO IN */
- madera_gpio_set_direction(pctldev, range, offset, true);
- ret = regmap_update_bits(madera->regmap, reg, MADERA_GP1_FN_MASK, 1);
- if (ret)
- dev_err(priv->dev, "Failed to write to 0x%x (%d)\n", reg, ret);
- }
- static const struct pinmux_ops madera_pin_mux_ops = {
- .get_functions_count = madera_mux_get_funcs_count,
- .get_function_name = madera_mux_get_func_name,
- .get_function_groups = madera_mux_get_groups,
- .set_mux = madera_mux_set_mux,
- .gpio_request_enable = madera_gpio_request_enable,
- .gpio_disable_free = madera_gpio_disable_free,
- .gpio_set_direction = madera_gpio_set_direction,
- .strict = true, /* GPIO and other functions are exclusive */
- };
- static int madera_pin_conf_get(struct pinctrl_dev *pctldev, unsigned int pin,
- unsigned long *config)
- {
- struct madera_pin_private *priv = pinctrl_dev_get_drvdata(pctldev);
- unsigned int param = pinconf_to_config_param(*config);
- unsigned int result = 0;
- unsigned int reg = MADERA_GPIO1_CTRL_1 + (2 * pin);
- unsigned int conf[2];
- int ret;
- ret = regmap_read(priv->madera->regmap, reg, &conf[0]);
- if (!ret)
- ret = regmap_read(priv->madera->regmap, reg + 1, &conf[1]);
- if (ret) {
- dev_err(priv->dev, "Failed to read GP%d conf (%d)\n",
- pin + 1, ret);
- return ret;
- }
- switch (param) {
- case PIN_CONFIG_BIAS_BUS_HOLD:
- conf[1] &= MADERA_GP1_PU_MASK | MADERA_GP1_PD_MASK;
- if (conf[1] == (MADERA_GP1_PU | MADERA_GP1_PD))
- result = 1;
- break;
- case PIN_CONFIG_BIAS_DISABLE:
- conf[1] &= MADERA_GP1_PU_MASK | MADERA_GP1_PD_MASK;
- if (!conf[1])
- result = 1;
- break;
- case PIN_CONFIG_BIAS_PULL_DOWN:
- conf[1] &= MADERA_GP1_PU_MASK | MADERA_GP1_PD_MASK;
- if (conf[1] == MADERA_GP1_PD_MASK)
- result = 1;
- break;
- case PIN_CONFIG_BIAS_PULL_UP:
- conf[1] &= MADERA_GP1_PU_MASK | MADERA_GP1_PD_MASK;
- if (conf[1] == MADERA_GP1_PU_MASK)
- result = 1;
- break;
- case PIN_CONFIG_DRIVE_OPEN_DRAIN:
- if (conf[0] & MADERA_GP1_OP_CFG_MASK)
- result = 1;
- break;
- case PIN_CONFIG_DRIVE_PUSH_PULL:
- if (!(conf[0] & MADERA_GP1_OP_CFG_MASK))
- result = 1;
- break;
- case PIN_CONFIG_DRIVE_STRENGTH:
- result = madera_pin_unmake_drv_str(priv, conf[1]);
- break;
- case PIN_CONFIG_INPUT_DEBOUNCE:
- if (conf[0] & MADERA_GP1_DB_MASK)
- result = 1;
- break;
- case PIN_CONFIG_INPUT_ENABLE:
- if (conf[0] & MADERA_GP1_DIR_MASK)
- result = 1;
- break;
- case PIN_CONFIG_INPUT_SCHMITT:
- case PIN_CONFIG_INPUT_SCHMITT_ENABLE:
- if (conf[0] & MADERA_GP1_IP_CFG_MASK)
- result = 1;
- break;
- case PIN_CONFIG_OUTPUT:
- if ((conf[1] & MADERA_GP1_DIR_MASK) &&
- (conf[0] & MADERA_GP1_LVL_MASK))
- result = 1;
- break;
- default:
- return -ENOTSUPP;
- }
- *config = pinconf_to_config_packed(param, result);
- return 0;
- }
- static int madera_pin_conf_set(struct pinctrl_dev *pctldev, unsigned int pin,
- unsigned long *configs, unsigned int num_configs)
- {
- struct madera_pin_private *priv = pinctrl_dev_get_drvdata(pctldev);
- u16 conf[2] = {0, 0};
- u16 mask[2] = {0, 0};
- unsigned int reg = MADERA_GPIO1_CTRL_1 + (2 * pin);
- unsigned int val;
- int ret;
- while (num_configs) {
- dev_dbg(priv->dev, "%s config 0x%lx\n", __func__, *configs);
- switch (pinconf_to_config_param(*configs)) {
- case PIN_CONFIG_BIAS_BUS_HOLD:
- mask[1] |= MADERA_GP1_PU_MASK | MADERA_GP1_PD_MASK;
- conf[1] |= MADERA_GP1_PU | MADERA_GP1_PD;
- break;
- case PIN_CONFIG_BIAS_DISABLE:
- mask[1] |= MADERA_GP1_PU_MASK | MADERA_GP1_PD_MASK;
- conf[1] &= ~(MADERA_GP1_PU | MADERA_GP1_PD);
- break;
- case PIN_CONFIG_BIAS_PULL_DOWN:
- mask[1] |= MADERA_GP1_PU_MASK | MADERA_GP1_PD_MASK;
- conf[1] |= MADERA_GP1_PD;
- conf[1] &= ~MADERA_GP1_PU;
- break;
- case PIN_CONFIG_BIAS_PULL_UP:
- mask[1] |= MADERA_GP1_PU_MASK | MADERA_GP1_PD_MASK;
- conf[1] |= MADERA_GP1_PU;
- conf[1] &= ~MADERA_GP1_PD;
- break;
- case PIN_CONFIG_DRIVE_OPEN_DRAIN:
- mask[0] |= MADERA_GP1_OP_CFG_MASK;
- conf[0] |= MADERA_GP1_OP_CFG;
- break;
- case PIN_CONFIG_DRIVE_PUSH_PULL:
- mask[0] |= MADERA_GP1_OP_CFG_MASK;
- conf[0] &= ~MADERA_GP1_OP_CFG;
- break;
- case PIN_CONFIG_DRIVE_STRENGTH:
- val = pinconf_to_config_argument(*configs);
- mask[1] |= MADERA_GP1_DRV_STR_MASK;
- conf[1] &= ~MADERA_GP1_DRV_STR_MASK;
- conf[1] |= madera_pin_make_drv_str(priv, val);
- break;
- case PIN_CONFIG_INPUT_DEBOUNCE:
- mask[0] |= MADERA_GP1_DB_MASK;
- /*
- * we can't configure debounce time per-pin so value
- * is just a flag
- */
- val = pinconf_to_config_argument(*configs);
- if (val)
- conf[0] |= MADERA_GP1_DB;
- else
- conf[0] &= ~MADERA_GP1_DB;
- break;
- case PIN_CONFIG_INPUT_ENABLE:
- val = pinconf_to_config_argument(*configs);
- mask[1] |= MADERA_GP1_DIR_MASK;
- if (val)
- conf[1] |= MADERA_GP1_DIR;
- else
- conf[1] &= ~MADERA_GP1_DIR;
- break;
- case PIN_CONFIG_INPUT_SCHMITT:
- val = pinconf_to_config_argument(*configs);
- mask[0] |= MADERA_GP1_IP_CFG;
- if (val)
- conf[0] |= MADERA_GP1_IP_CFG;
- else
- conf[0] &= ~MADERA_GP1_IP_CFG;
- mask[1] |= MADERA_GP1_DIR_MASK;
- conf[1] |= MADERA_GP1_DIR;
- break;
- case PIN_CONFIG_INPUT_SCHMITT_ENABLE:
- mask[0] |= MADERA_GP1_IP_CFG;
- conf[0] |= MADERA_GP1_IP_CFG;
- mask[1] |= MADERA_GP1_DIR_MASK;
- conf[1] |= MADERA_GP1_DIR;
- break;
- case PIN_CONFIG_OUTPUT:
- val = pinconf_to_config_argument(*configs);
- mask[0] |= MADERA_GP1_LVL_MASK;
- if (val)
- conf[0] |= MADERA_GP1_LVL;
- else
- conf[0] &= ~MADERA_GP1_LVL;
- mask[1] |= MADERA_GP1_DIR_MASK;
- conf[1] &= ~MADERA_GP1_DIR;
- break;
- default:
- return -ENOTSUPP;
- }
- ++configs;
- --num_configs;
- }
- dev_dbg(priv->dev,
- "%s gpio%d 0x%x:0x%x 0x%x:0x%x\n",
- __func__, pin + 1, reg, conf[0], reg + 1, conf[1]);
- ret = regmap_update_bits(priv->madera->regmap, reg, mask[0], conf[0]);
- if (ret)
- goto err;
- ++reg;
- ret = regmap_update_bits(priv->madera->regmap, reg, mask[1], conf[1]);
- if (ret)
- goto err;
- return 0;
- err:
- dev_err(priv->dev,
- "Failed to write GPIO%d conf (%d) reg 0x%x\n",
- pin + 1, ret, reg);
- return ret;
- }
- static int madera_pin_conf_group_set(struct pinctrl_dev *pctldev,
- unsigned int selector,
- unsigned long *configs,
- unsigned int num_configs)
- {
- struct madera_pin_private *priv = pinctrl_dev_get_drvdata(pctldev);
- const struct madera_pin_groups *pin_group;
- unsigned int n_groups = priv->chip->n_pin_groups;
- int i, ret;
- dev_dbg(priv->dev, "%s setting group %s\n", __func__,
- madera_get_group_name(pctldev, selector));
- if (selector >= n_groups) {
- /* group is a single pin, convert to pin number and set */
- return madera_pin_conf_set(pctldev,
- selector - n_groups,
- configs,
- num_configs);
- } else {
- pin_group = &priv->chip->pin_groups[selector];
- for (i = 0; i < pin_group->n_pins; ++i) {
- ret = madera_pin_conf_set(pctldev,
- pin_group->pins[i],
- configs,
- num_configs);
- if (ret)
- return ret;
- }
- }
- return 0;
- }
- static const struct pinconf_ops madera_pin_conf_ops = {
- .is_generic = true,
- .pin_config_get = madera_pin_conf_get,
- .pin_config_set = madera_pin_conf_set,
- .pin_config_group_set = madera_pin_conf_group_set,
- };
- static struct pinctrl_desc madera_pin_desc = {
- .name = "madera-pinctrl",
- .pins = madera_pins,
- .pctlops = &madera_pin_group_ops,
- .pmxops = &madera_pin_mux_ops,
- .confops = &madera_pin_conf_ops,
- .owner = THIS_MODULE,
- };
- static int madera_pin_probe(struct platform_device *pdev)
- {
- struct madera *madera = dev_get_drvdata(pdev->dev.parent);
- const struct madera_pdata *pdata = &madera->pdata;
- struct madera_pin_private *priv;
- int ret;
- BUILD_BUG_ON(ARRAY_SIZE(madera_pin_single_group_names) !=
- ARRAY_SIZE(madera_pin_single_group_pins));
- dev_dbg(&pdev->dev, "%s\n", __func__);
- priv = devm_kzalloc(&pdev->dev, sizeof(*priv), GFP_KERNEL);
- if (!priv)
- return -ENOMEM;
- priv->dev = &pdev->dev;
- priv->madera = madera;
- pdev->dev.of_node = madera->dev->of_node;
- switch (madera->type) {
- case CS47L15:
- if (IS_ENABLED(CONFIG_PINCTRL_CS47L15))
- priv->chip = &cs47l15_pin_chip;
- break;
- case CS47L35:
- if (IS_ENABLED(CONFIG_PINCTRL_CS47L35))
- priv->chip = &cs47l35_pin_chip;
- break;
- case CS47L85:
- case WM1840:
- if (IS_ENABLED(CONFIG_PINCTRL_CS47L85))
- priv->chip = &cs47l85_pin_chip;
- break;
- case CS47L90:
- case CS47L91:
- if (IS_ENABLED(CONFIG_PINCTRL_CS47L90))
- priv->chip = &cs47l90_pin_chip;
- break;
- case CS42L92:
- case CS47L92:
- case CS47L93:
- if (IS_ENABLED(CONFIG_PINCTRL_CS47L92))
- priv->chip = &cs47l92_pin_chip;
- break;
- default:
- break;
- }
- if (!priv->chip)
- return -ENODEV;
- madera_pin_desc.npins = priv->chip->n_pins;
- ret = devm_pinctrl_register_and_init(&pdev->dev,
- &madera_pin_desc,
- priv,
- &priv->pctl);
- if (ret) {
- dev_err(priv->dev, "Failed pinctrl register (%d)\n", ret);
- return ret;
- }
- /* if the configuration is provided through pdata, apply it */
- if (pdata->gpio_configs) {
- ret = pinctrl_register_mappings(pdata->gpio_configs,
- pdata->n_gpio_configs);
- if (ret) {
- dev_err(priv->dev,
- "Failed to register pdata mappings (%d)\n",
- ret);
- return ret;
- }
- }
- ret = pinctrl_enable(priv->pctl);
- if (ret) {
- dev_err(priv->dev, "Failed to enable pinctrl (%d)\n", ret);
- return ret;
- }
- platform_set_drvdata(pdev, priv);
- dev_dbg(priv->dev, "pinctrl probed ok\n");
- return 0;
- }
- static int madera_pin_remove(struct platform_device *pdev)
- {
- struct madera_pin_private *priv = platform_get_drvdata(pdev);
- if (priv->madera->pdata.gpio_configs)
- pinctrl_unregister_mappings(priv->madera->pdata.gpio_configs);
- return 0;
- }
- static struct platform_driver madera_pin_driver = {
- .probe = madera_pin_probe,
- .remove = madera_pin_remove,
- .driver = {
- .name = "madera-pinctrl",
- },
- };
- module_platform_driver(madera_pin_driver);
- MODULE_DESCRIPTION("Madera pinctrl driver");
- MODULE_AUTHOR("Richard Fitzgerald <rf@opensource.cirrus.com>");
- MODULE_LICENSE("GPL v2");
|