162306a36Sopenharmony_ci/*
262306a36Sopenharmony_ci * Support for configuration of IO Delay module found on Texas Instruments SoCs
362306a36Sopenharmony_ci * such as DRA7
462306a36Sopenharmony_ci *
562306a36Sopenharmony_ci * Copyright (C) 2015-2017 Texas Instruments Incorporated - https://www.ti.com/
662306a36Sopenharmony_ci *
762306a36Sopenharmony_ci * This file is licensed under the terms of the GNU General Public
862306a36Sopenharmony_ci * License version 2. This program is licensed "as is" without any
962306a36Sopenharmony_ci * warranty of any kind, whether express or implied.
1062306a36Sopenharmony_ci */
1162306a36Sopenharmony_ci
1262306a36Sopenharmony_ci#include <linux/err.h>
1362306a36Sopenharmony_ci#include <linux/init.h>
1462306a36Sopenharmony_ci#include <linux/io.h>
1562306a36Sopenharmony_ci#include <linux/module.h>
1662306a36Sopenharmony_ci#include <linux/of.h>
1762306a36Sopenharmony_ci#include <linux/of_device.h>
1862306a36Sopenharmony_ci#include <linux/regmap.h>
1962306a36Sopenharmony_ci#include <linux/seq_file.h>
2062306a36Sopenharmony_ci#include <linux/slab.h>
2162306a36Sopenharmony_ci
2262306a36Sopenharmony_ci#include <linux/pinctrl/pinconf-generic.h>
2362306a36Sopenharmony_ci#include <linux/pinctrl/pinconf.h>
2462306a36Sopenharmony_ci#include <linux/pinctrl/pinctrl.h>
2562306a36Sopenharmony_ci
2662306a36Sopenharmony_ci#include "../core.h"
2762306a36Sopenharmony_ci#include "../devicetree.h"
2862306a36Sopenharmony_ci
2962306a36Sopenharmony_ci#define DRIVER_NAME	"ti-iodelay"
3062306a36Sopenharmony_ci
3162306a36Sopenharmony_ci/**
3262306a36Sopenharmony_ci * struct ti_iodelay_reg_data - Describes the registers for the iodelay instance
3362306a36Sopenharmony_ci * @signature_mask: CONFIG_REG mask for the signature bits (see TRM)
3462306a36Sopenharmony_ci * @signature_value: CONFIG_REG signature value to be written (see TRM)
3562306a36Sopenharmony_ci * @lock_mask: CONFIG_REG mask for the lock bits (see TRM)
3662306a36Sopenharmony_ci * @lock_val: CONFIG_REG lock value for the lock bits (see TRM)
3762306a36Sopenharmony_ci * @unlock_val:CONFIG_REG unlock value for the lock bits (see TRM)
3862306a36Sopenharmony_ci * @binary_data_coarse_mask: CONFIG_REG coarse mask (see TRM)
3962306a36Sopenharmony_ci * @binary_data_fine_mask: CONFIG_REG fine mask (see TRM)
4062306a36Sopenharmony_ci * @reg_refclk_offset: Refclk register offset
4162306a36Sopenharmony_ci * @refclk_period_mask: Refclk mask
4262306a36Sopenharmony_ci * @reg_coarse_offset: Coarse register configuration offset
4362306a36Sopenharmony_ci * @coarse_delay_count_mask: Coarse delay count mask
4462306a36Sopenharmony_ci * @coarse_ref_count_mask: Coarse ref count mask
4562306a36Sopenharmony_ci * @reg_fine_offset: Fine register configuration offset
4662306a36Sopenharmony_ci * @fine_delay_count_mask: Fine delay count mask
4762306a36Sopenharmony_ci * @fine_ref_count_mask: Fine ref count mask
4862306a36Sopenharmony_ci * @reg_global_lock_offset: Global iodelay module lock register offset
4962306a36Sopenharmony_ci * @global_lock_mask: Lock mask
5062306a36Sopenharmony_ci * @global_unlock_val: Unlock value
5162306a36Sopenharmony_ci * @global_lock_val: Lock value
5262306a36Sopenharmony_ci * @reg_start_offset: Offset to iodelay registers after the CONFIG_REG_0 to 8
5362306a36Sopenharmony_ci * @reg_nr_per_pin: Number of iodelay registers for each pin
5462306a36Sopenharmony_ci * @regmap_config: Regmap configuration for the IODelay region
5562306a36Sopenharmony_ci */
5662306a36Sopenharmony_cistruct ti_iodelay_reg_data {
5762306a36Sopenharmony_ci	u32 signature_mask;
5862306a36Sopenharmony_ci	u32 signature_value;
5962306a36Sopenharmony_ci	u32 lock_mask;
6062306a36Sopenharmony_ci	u32 lock_val;
6162306a36Sopenharmony_ci	u32 unlock_val;
6262306a36Sopenharmony_ci	u32 binary_data_coarse_mask;
6362306a36Sopenharmony_ci	u32 binary_data_fine_mask;
6462306a36Sopenharmony_ci
6562306a36Sopenharmony_ci	u32 reg_refclk_offset;
6662306a36Sopenharmony_ci	u32 refclk_period_mask;
6762306a36Sopenharmony_ci
6862306a36Sopenharmony_ci	u32 reg_coarse_offset;
6962306a36Sopenharmony_ci	u32 coarse_delay_count_mask;
7062306a36Sopenharmony_ci	u32 coarse_ref_count_mask;
7162306a36Sopenharmony_ci
7262306a36Sopenharmony_ci	u32 reg_fine_offset;
7362306a36Sopenharmony_ci	u32 fine_delay_count_mask;
7462306a36Sopenharmony_ci	u32 fine_ref_count_mask;
7562306a36Sopenharmony_ci
7662306a36Sopenharmony_ci	u32 reg_global_lock_offset;
7762306a36Sopenharmony_ci	u32 global_lock_mask;
7862306a36Sopenharmony_ci	u32 global_unlock_val;
7962306a36Sopenharmony_ci	u32 global_lock_val;
8062306a36Sopenharmony_ci
8162306a36Sopenharmony_ci	u32 reg_start_offset;
8262306a36Sopenharmony_ci	u32 reg_nr_per_pin;
8362306a36Sopenharmony_ci
8462306a36Sopenharmony_ci	struct regmap_config *regmap_config;
8562306a36Sopenharmony_ci};
8662306a36Sopenharmony_ci
8762306a36Sopenharmony_ci/**
8862306a36Sopenharmony_ci * struct ti_iodelay_reg_values - Computed io_reg configuration values (see TRM)
8962306a36Sopenharmony_ci * @coarse_ref_count: Coarse reference count
9062306a36Sopenharmony_ci * @coarse_delay_count: Coarse delay count
9162306a36Sopenharmony_ci * @fine_ref_count: Fine reference count
9262306a36Sopenharmony_ci * @fine_delay_count: Fine Delay count
9362306a36Sopenharmony_ci * @ref_clk_period: Reference Clock period
9462306a36Sopenharmony_ci * @cdpe: Coarse delay parameter
9562306a36Sopenharmony_ci * @fdpe: Fine delay parameter
9662306a36Sopenharmony_ci */
9762306a36Sopenharmony_cistruct ti_iodelay_reg_values {
9862306a36Sopenharmony_ci	u16 coarse_ref_count;
9962306a36Sopenharmony_ci	u16 coarse_delay_count;
10062306a36Sopenharmony_ci
10162306a36Sopenharmony_ci	u16 fine_ref_count;
10262306a36Sopenharmony_ci	u16 fine_delay_count;
10362306a36Sopenharmony_ci
10462306a36Sopenharmony_ci	u16 ref_clk_period;
10562306a36Sopenharmony_ci
10662306a36Sopenharmony_ci	u32 cdpe;
10762306a36Sopenharmony_ci	u32 fdpe;
10862306a36Sopenharmony_ci};
10962306a36Sopenharmony_ci
11062306a36Sopenharmony_ci/**
11162306a36Sopenharmony_ci * struct ti_iodelay_cfg - Description of each configuration parameters
11262306a36Sopenharmony_ci * @offset: Configuration register offset
11362306a36Sopenharmony_ci * @a_delay: Agnostic Delay (in ps)
11462306a36Sopenharmony_ci * @g_delay: Gnostic Delay (in ps)
11562306a36Sopenharmony_ci */
11662306a36Sopenharmony_cistruct ti_iodelay_cfg {
11762306a36Sopenharmony_ci	u16 offset;
11862306a36Sopenharmony_ci	u16 a_delay;
11962306a36Sopenharmony_ci	u16 g_delay;
12062306a36Sopenharmony_ci};
12162306a36Sopenharmony_ci
12262306a36Sopenharmony_ci/**
12362306a36Sopenharmony_ci * struct ti_iodelay_pingroup - Structure that describes one group
12462306a36Sopenharmony_ci * @cfg: configuration array for the pin (from dt)
12562306a36Sopenharmony_ci * @ncfg: number of configuration values allocated
12662306a36Sopenharmony_ci * @config: pinconf "Config" - currently a dummy value
12762306a36Sopenharmony_ci */
12862306a36Sopenharmony_cistruct ti_iodelay_pingroup {
12962306a36Sopenharmony_ci	struct ti_iodelay_cfg *cfg;
13062306a36Sopenharmony_ci	int ncfg;
13162306a36Sopenharmony_ci	unsigned long config;
13262306a36Sopenharmony_ci};
13362306a36Sopenharmony_ci
13462306a36Sopenharmony_ci/**
13562306a36Sopenharmony_ci * struct ti_iodelay_device - Represents information for a iodelay instance
13662306a36Sopenharmony_ci * @dev: Device pointer
13762306a36Sopenharmony_ci * @phys_base: Physical address base of the iodelay device
13862306a36Sopenharmony_ci * @reg_base: Virtual address base of the iodelay device
13962306a36Sopenharmony_ci * @regmap: Regmap for this iodelay instance
14062306a36Sopenharmony_ci * @pctl: Pinctrl device
14162306a36Sopenharmony_ci * @desc: pinctrl descriptor for pctl
14262306a36Sopenharmony_ci * @pa: pinctrl pin wise description
14362306a36Sopenharmony_ci * @reg_data: Register definition data for the IODelay instance
14462306a36Sopenharmony_ci * @reg_init_conf_values: Initial configuration values.
14562306a36Sopenharmony_ci */
14662306a36Sopenharmony_cistruct ti_iodelay_device {
14762306a36Sopenharmony_ci	struct device *dev;
14862306a36Sopenharmony_ci	unsigned long phys_base;
14962306a36Sopenharmony_ci	void __iomem *reg_base;
15062306a36Sopenharmony_ci	struct regmap *regmap;
15162306a36Sopenharmony_ci
15262306a36Sopenharmony_ci	struct pinctrl_dev *pctl;
15362306a36Sopenharmony_ci	struct pinctrl_desc desc;
15462306a36Sopenharmony_ci	struct pinctrl_pin_desc *pa;
15562306a36Sopenharmony_ci
15662306a36Sopenharmony_ci	const struct ti_iodelay_reg_data *reg_data;
15762306a36Sopenharmony_ci	struct ti_iodelay_reg_values reg_init_conf_values;
15862306a36Sopenharmony_ci};
15962306a36Sopenharmony_ci
16062306a36Sopenharmony_ci/**
16162306a36Sopenharmony_ci * ti_iodelay_extract() - extract bits for a field
16262306a36Sopenharmony_ci * @val: Register value
16362306a36Sopenharmony_ci * @mask: Mask
16462306a36Sopenharmony_ci *
16562306a36Sopenharmony_ci * Return: extracted value which is appropriately shifted
16662306a36Sopenharmony_ci */
16762306a36Sopenharmony_cistatic inline u32 ti_iodelay_extract(u32 val, u32 mask)
16862306a36Sopenharmony_ci{
16962306a36Sopenharmony_ci	return (val & mask) >> __ffs(mask);
17062306a36Sopenharmony_ci}
17162306a36Sopenharmony_ci
17262306a36Sopenharmony_ci/**
17362306a36Sopenharmony_ci * ti_iodelay_compute_dpe() - Compute equation for delay parameter
17462306a36Sopenharmony_ci * @period: Period to use
17562306a36Sopenharmony_ci * @ref: Reference Count
17662306a36Sopenharmony_ci * @delay: Delay count
17762306a36Sopenharmony_ci * @delay_m: Delay multiplier
17862306a36Sopenharmony_ci *
17962306a36Sopenharmony_ci * Return: Computed delay parameter
18062306a36Sopenharmony_ci */
18162306a36Sopenharmony_cistatic inline u32 ti_iodelay_compute_dpe(u16 period, u16 ref, u16 delay,
18262306a36Sopenharmony_ci					 u16 delay_m)
18362306a36Sopenharmony_ci{
18462306a36Sopenharmony_ci	u64 m, d;
18562306a36Sopenharmony_ci
18662306a36Sopenharmony_ci	/* Handle overflow conditions */
18762306a36Sopenharmony_ci	m = 10 * (u64)period * (u64)ref;
18862306a36Sopenharmony_ci	d = 2 * (u64)delay * (u64)delay_m;
18962306a36Sopenharmony_ci
19062306a36Sopenharmony_ci	/* Truncate result back to 32 bits */
19162306a36Sopenharmony_ci	return div64_u64(m, d);
19262306a36Sopenharmony_ci}
19362306a36Sopenharmony_ci
19462306a36Sopenharmony_ci/**
19562306a36Sopenharmony_ci * ti_iodelay_pinconf_set() - Configure the pin configuration
19662306a36Sopenharmony_ci * @iod: iodelay device
19762306a36Sopenharmony_ci * @cfg: Configuration
19862306a36Sopenharmony_ci *
19962306a36Sopenharmony_ci * Update the configuration register as per TRM and lockup once done.
20062306a36Sopenharmony_ci * *IMPORTANT NOTE* SoC TRM does recommend doing iodelay programmation only
20162306a36Sopenharmony_ci * while in Isolation. But, then, isolation also implies that every pin
20262306a36Sopenharmony_ci * on the SoC (including DDR) will be isolated out. The only benefit being
20362306a36Sopenharmony_ci * a glitchless configuration, However, the intent of this driver is purely
20462306a36Sopenharmony_ci * to support a "glitchy" configuration where applicable.
20562306a36Sopenharmony_ci *
20662306a36Sopenharmony_ci * Return: 0 in case of success, else appropriate error value
20762306a36Sopenharmony_ci */
20862306a36Sopenharmony_cistatic int ti_iodelay_pinconf_set(struct ti_iodelay_device *iod,
20962306a36Sopenharmony_ci				  struct ti_iodelay_cfg *cfg)
21062306a36Sopenharmony_ci{
21162306a36Sopenharmony_ci	const struct ti_iodelay_reg_data *reg = iod->reg_data;
21262306a36Sopenharmony_ci	struct ti_iodelay_reg_values *ival = &iod->reg_init_conf_values;
21362306a36Sopenharmony_ci	struct device *dev = iod->dev;
21462306a36Sopenharmony_ci	u32 g_delay_coarse, g_delay_fine;
21562306a36Sopenharmony_ci	u32 a_delay_coarse, a_delay_fine;
21662306a36Sopenharmony_ci	u32 c_elements, f_elements;
21762306a36Sopenharmony_ci	u32 total_delay;
21862306a36Sopenharmony_ci	u32 reg_mask, reg_val, tmp_val;
21962306a36Sopenharmony_ci	int r;
22062306a36Sopenharmony_ci
22162306a36Sopenharmony_ci	/* NOTE: Truncation is expected in all division below */
22262306a36Sopenharmony_ci	g_delay_coarse = cfg->g_delay / 920;
22362306a36Sopenharmony_ci	g_delay_fine = ((cfg->g_delay % 920) * 10) / 60;
22462306a36Sopenharmony_ci
22562306a36Sopenharmony_ci	a_delay_coarse = cfg->a_delay / ival->cdpe;
22662306a36Sopenharmony_ci	a_delay_fine = ((cfg->a_delay % ival->cdpe) * 10) / ival->fdpe;
22762306a36Sopenharmony_ci
22862306a36Sopenharmony_ci	c_elements = g_delay_coarse + a_delay_coarse;
22962306a36Sopenharmony_ci	f_elements = (g_delay_fine + a_delay_fine) / 10;
23062306a36Sopenharmony_ci
23162306a36Sopenharmony_ci	if (f_elements > 22) {
23262306a36Sopenharmony_ci		total_delay = c_elements * ival->cdpe + f_elements * ival->fdpe;
23362306a36Sopenharmony_ci		c_elements = total_delay / ival->cdpe;
23462306a36Sopenharmony_ci		f_elements = (total_delay % ival->cdpe) / ival->fdpe;
23562306a36Sopenharmony_ci	}
23662306a36Sopenharmony_ci
23762306a36Sopenharmony_ci	reg_mask = reg->signature_mask;
23862306a36Sopenharmony_ci	reg_val = reg->signature_value << __ffs(reg->signature_mask);
23962306a36Sopenharmony_ci
24062306a36Sopenharmony_ci	reg_mask |= reg->binary_data_coarse_mask;
24162306a36Sopenharmony_ci	tmp_val = c_elements << __ffs(reg->binary_data_coarse_mask);
24262306a36Sopenharmony_ci	if (tmp_val & ~reg->binary_data_coarse_mask) {
24362306a36Sopenharmony_ci		dev_err(dev, "Masking overflow of coarse elements %08x\n",
24462306a36Sopenharmony_ci			tmp_val);
24562306a36Sopenharmony_ci		tmp_val &= reg->binary_data_coarse_mask;
24662306a36Sopenharmony_ci	}
24762306a36Sopenharmony_ci	reg_val |= tmp_val;
24862306a36Sopenharmony_ci
24962306a36Sopenharmony_ci	reg_mask |= reg->binary_data_fine_mask;
25062306a36Sopenharmony_ci	tmp_val = f_elements << __ffs(reg->binary_data_fine_mask);
25162306a36Sopenharmony_ci	if (tmp_val & ~reg->binary_data_fine_mask) {
25262306a36Sopenharmony_ci		dev_err(dev, "Masking overflow of fine elements %08x\n",
25362306a36Sopenharmony_ci			tmp_val);
25462306a36Sopenharmony_ci		tmp_val &= reg->binary_data_fine_mask;
25562306a36Sopenharmony_ci	}
25662306a36Sopenharmony_ci	reg_val |= tmp_val;
25762306a36Sopenharmony_ci
25862306a36Sopenharmony_ci	/*
25962306a36Sopenharmony_ci	 * NOTE: we leave the iodelay values unlocked - this is to work around
26062306a36Sopenharmony_ci	 * situations such as those found with mmc mode change.
26162306a36Sopenharmony_ci	 * However, this leaves open any unwarranted changes to padconf register
26262306a36Sopenharmony_ci	 * impacting iodelay configuration. Use with care!
26362306a36Sopenharmony_ci	 */
26462306a36Sopenharmony_ci	reg_mask |= reg->lock_mask;
26562306a36Sopenharmony_ci	reg_val |= reg->unlock_val << __ffs(reg->lock_mask);
26662306a36Sopenharmony_ci	r = regmap_update_bits(iod->regmap, cfg->offset, reg_mask, reg_val);
26762306a36Sopenharmony_ci
26862306a36Sopenharmony_ci	dev_dbg(dev, "Set reg 0x%x Delay(a: %d g: %d), Elements(C=%d F=%d)0x%x\n",
26962306a36Sopenharmony_ci		cfg->offset, cfg->a_delay, cfg->g_delay, c_elements,
27062306a36Sopenharmony_ci		f_elements, reg_val);
27162306a36Sopenharmony_ci
27262306a36Sopenharmony_ci	return r;
27362306a36Sopenharmony_ci}
27462306a36Sopenharmony_ci
27562306a36Sopenharmony_ci/**
27662306a36Sopenharmony_ci * ti_iodelay_pinconf_init_dev() - Initialize IODelay device
27762306a36Sopenharmony_ci * @iod: iodelay device
27862306a36Sopenharmony_ci *
27962306a36Sopenharmony_ci * Unlocks the iodelay region, computes the common parameters
28062306a36Sopenharmony_ci *
28162306a36Sopenharmony_ci * Return: 0 in case of success, else appropriate error value
28262306a36Sopenharmony_ci */
28362306a36Sopenharmony_cistatic int ti_iodelay_pinconf_init_dev(struct ti_iodelay_device *iod)
28462306a36Sopenharmony_ci{
28562306a36Sopenharmony_ci	const struct ti_iodelay_reg_data *reg = iod->reg_data;
28662306a36Sopenharmony_ci	struct device *dev = iod->dev;
28762306a36Sopenharmony_ci	struct ti_iodelay_reg_values *ival = &iod->reg_init_conf_values;
28862306a36Sopenharmony_ci	u32 val;
28962306a36Sopenharmony_ci	int r;
29062306a36Sopenharmony_ci
29162306a36Sopenharmony_ci	/* unlock the iodelay region */
29262306a36Sopenharmony_ci	r = regmap_update_bits(iod->regmap, reg->reg_global_lock_offset,
29362306a36Sopenharmony_ci			       reg->global_lock_mask, reg->global_unlock_val);
29462306a36Sopenharmony_ci	if (r)
29562306a36Sopenharmony_ci		return r;
29662306a36Sopenharmony_ci
29762306a36Sopenharmony_ci	/* Read up Recalibration sequence done by bootloader */
29862306a36Sopenharmony_ci	r = regmap_read(iod->regmap, reg->reg_refclk_offset, &val);
29962306a36Sopenharmony_ci	if (r)
30062306a36Sopenharmony_ci		return r;
30162306a36Sopenharmony_ci	ival->ref_clk_period = ti_iodelay_extract(val, reg->refclk_period_mask);
30262306a36Sopenharmony_ci	dev_dbg(dev, "refclk_period=0x%04x\n", ival->ref_clk_period);
30362306a36Sopenharmony_ci
30462306a36Sopenharmony_ci	r = regmap_read(iod->regmap, reg->reg_coarse_offset, &val);
30562306a36Sopenharmony_ci	if (r)
30662306a36Sopenharmony_ci		return r;
30762306a36Sopenharmony_ci	ival->coarse_ref_count =
30862306a36Sopenharmony_ci	    ti_iodelay_extract(val, reg->coarse_ref_count_mask);
30962306a36Sopenharmony_ci	ival->coarse_delay_count =
31062306a36Sopenharmony_ci	    ti_iodelay_extract(val, reg->coarse_delay_count_mask);
31162306a36Sopenharmony_ci	if (!ival->coarse_delay_count) {
31262306a36Sopenharmony_ci		dev_err(dev, "Invalid Coarse delay count (0) (reg=0x%08x)\n",
31362306a36Sopenharmony_ci			val);
31462306a36Sopenharmony_ci		return -EINVAL;
31562306a36Sopenharmony_ci	}
31662306a36Sopenharmony_ci	ival->cdpe = ti_iodelay_compute_dpe(ival->ref_clk_period,
31762306a36Sopenharmony_ci					    ival->coarse_ref_count,
31862306a36Sopenharmony_ci					    ival->coarse_delay_count, 88);
31962306a36Sopenharmony_ci	if (!ival->cdpe) {
32062306a36Sopenharmony_ci		dev_err(dev, "Invalid cdpe computed params = %d %d %d\n",
32162306a36Sopenharmony_ci			ival->ref_clk_period, ival->coarse_ref_count,
32262306a36Sopenharmony_ci			ival->coarse_delay_count);
32362306a36Sopenharmony_ci		return -EINVAL;
32462306a36Sopenharmony_ci	}
32562306a36Sopenharmony_ci	dev_dbg(iod->dev, "coarse: ref=0x%04x delay=0x%04x cdpe=0x%08x\n",
32662306a36Sopenharmony_ci		ival->coarse_ref_count, ival->coarse_delay_count, ival->cdpe);
32762306a36Sopenharmony_ci
32862306a36Sopenharmony_ci	r = regmap_read(iod->regmap, reg->reg_fine_offset, &val);
32962306a36Sopenharmony_ci	if (r)
33062306a36Sopenharmony_ci		return r;
33162306a36Sopenharmony_ci	ival->fine_ref_count =
33262306a36Sopenharmony_ci	    ti_iodelay_extract(val, reg->fine_ref_count_mask);
33362306a36Sopenharmony_ci	ival->fine_delay_count =
33462306a36Sopenharmony_ci	    ti_iodelay_extract(val, reg->fine_delay_count_mask);
33562306a36Sopenharmony_ci	if (!ival->fine_delay_count) {
33662306a36Sopenharmony_ci		dev_err(dev, "Invalid Fine delay count (0) (reg=0x%08x)\n",
33762306a36Sopenharmony_ci			val);
33862306a36Sopenharmony_ci		return -EINVAL;
33962306a36Sopenharmony_ci	}
34062306a36Sopenharmony_ci	ival->fdpe = ti_iodelay_compute_dpe(ival->ref_clk_period,
34162306a36Sopenharmony_ci					    ival->fine_ref_count,
34262306a36Sopenharmony_ci					    ival->fine_delay_count, 264);
34362306a36Sopenharmony_ci	if (!ival->fdpe) {
34462306a36Sopenharmony_ci		dev_err(dev, "Invalid fdpe(0) computed params = %d %d %d\n",
34562306a36Sopenharmony_ci			ival->ref_clk_period, ival->fine_ref_count,
34662306a36Sopenharmony_ci			ival->fine_delay_count);
34762306a36Sopenharmony_ci		return -EINVAL;
34862306a36Sopenharmony_ci	}
34962306a36Sopenharmony_ci	dev_dbg(iod->dev, "fine: ref=0x%04x delay=0x%04x fdpe=0x%08x\n",
35062306a36Sopenharmony_ci		ival->fine_ref_count, ival->fine_delay_count, ival->fdpe);
35162306a36Sopenharmony_ci
35262306a36Sopenharmony_ci	return 0;
35362306a36Sopenharmony_ci}
35462306a36Sopenharmony_ci
35562306a36Sopenharmony_ci/**
35662306a36Sopenharmony_ci * ti_iodelay_pinconf_deinit_dev() - deinit the iodelay device
35762306a36Sopenharmony_ci * @iod:	IODelay device
35862306a36Sopenharmony_ci *
35962306a36Sopenharmony_ci * Deinitialize the IODelay device (basically just lock the region back up.
36062306a36Sopenharmony_ci */
36162306a36Sopenharmony_cistatic void ti_iodelay_pinconf_deinit_dev(struct ti_iodelay_device *iod)
36262306a36Sopenharmony_ci{
36362306a36Sopenharmony_ci	const struct ti_iodelay_reg_data *reg = iod->reg_data;
36462306a36Sopenharmony_ci
36562306a36Sopenharmony_ci	/* lock the iodelay region back again */
36662306a36Sopenharmony_ci	regmap_update_bits(iod->regmap, reg->reg_global_lock_offset,
36762306a36Sopenharmony_ci			   reg->global_lock_mask, reg->global_lock_val);
36862306a36Sopenharmony_ci}
36962306a36Sopenharmony_ci
37062306a36Sopenharmony_ci/**
37162306a36Sopenharmony_ci * ti_iodelay_get_pingroup() - Find the group mapped by a group selector
37262306a36Sopenharmony_ci * @iod: iodelay device
37362306a36Sopenharmony_ci * @selector: Group Selector
37462306a36Sopenharmony_ci *
37562306a36Sopenharmony_ci * Return: Corresponding group representing group selector
37662306a36Sopenharmony_ci */
37762306a36Sopenharmony_cistatic struct ti_iodelay_pingroup *
37862306a36Sopenharmony_citi_iodelay_get_pingroup(struct ti_iodelay_device *iod, unsigned int selector)
37962306a36Sopenharmony_ci{
38062306a36Sopenharmony_ci	struct group_desc *g;
38162306a36Sopenharmony_ci
38262306a36Sopenharmony_ci	g = pinctrl_generic_get_group(iod->pctl, selector);
38362306a36Sopenharmony_ci	if (!g) {
38462306a36Sopenharmony_ci		dev_err(iod->dev, "%s could not find pingroup %i\n", __func__,
38562306a36Sopenharmony_ci			selector);
38662306a36Sopenharmony_ci
38762306a36Sopenharmony_ci		return NULL;
38862306a36Sopenharmony_ci	}
38962306a36Sopenharmony_ci
39062306a36Sopenharmony_ci	return g->data;
39162306a36Sopenharmony_ci}
39262306a36Sopenharmony_ci
39362306a36Sopenharmony_ci/**
39462306a36Sopenharmony_ci * ti_iodelay_offset_to_pin() - get a pin index based on the register offset
39562306a36Sopenharmony_ci * @iod: iodelay driver instance
39662306a36Sopenharmony_ci * @offset: register offset from the base
39762306a36Sopenharmony_ci */
39862306a36Sopenharmony_cistatic int ti_iodelay_offset_to_pin(struct ti_iodelay_device *iod,
39962306a36Sopenharmony_ci				    unsigned int offset)
40062306a36Sopenharmony_ci{
40162306a36Sopenharmony_ci	const struct ti_iodelay_reg_data *r = iod->reg_data;
40262306a36Sopenharmony_ci	unsigned int index;
40362306a36Sopenharmony_ci
40462306a36Sopenharmony_ci	if (offset > r->regmap_config->max_register) {
40562306a36Sopenharmony_ci		dev_err(iod->dev, "mux offset out of range: 0x%x (0x%x)\n",
40662306a36Sopenharmony_ci			offset, r->regmap_config->max_register);
40762306a36Sopenharmony_ci		return -EINVAL;
40862306a36Sopenharmony_ci	}
40962306a36Sopenharmony_ci
41062306a36Sopenharmony_ci	index = (offset - r->reg_start_offset) / r->regmap_config->reg_stride;
41162306a36Sopenharmony_ci	index /= r->reg_nr_per_pin;
41262306a36Sopenharmony_ci
41362306a36Sopenharmony_ci	return index;
41462306a36Sopenharmony_ci}
41562306a36Sopenharmony_ci
41662306a36Sopenharmony_ci/**
41762306a36Sopenharmony_ci * ti_iodelay_node_iterator() - Iterate iodelay node
41862306a36Sopenharmony_ci * @pctldev: Pin controller driver
41962306a36Sopenharmony_ci * @np: Device node
42062306a36Sopenharmony_ci * @pinctrl_spec: Parsed arguments from device tree
42162306a36Sopenharmony_ci * @pins: Array of pins in the pin group
42262306a36Sopenharmony_ci * @pin_index: Pin index in the pin array
42362306a36Sopenharmony_ci * @data: Pin controller driver specific data
42462306a36Sopenharmony_ci *
42562306a36Sopenharmony_ci */
42662306a36Sopenharmony_cistatic int ti_iodelay_node_iterator(struct pinctrl_dev *pctldev,
42762306a36Sopenharmony_ci				    struct device_node *np,
42862306a36Sopenharmony_ci				    const struct of_phandle_args *pinctrl_spec,
42962306a36Sopenharmony_ci				    int *pins, int pin_index, void *data)
43062306a36Sopenharmony_ci{
43162306a36Sopenharmony_ci	struct ti_iodelay_device *iod;
43262306a36Sopenharmony_ci	struct ti_iodelay_cfg *cfg = data;
43362306a36Sopenharmony_ci	const struct ti_iodelay_reg_data *r;
43462306a36Sopenharmony_ci	struct pinctrl_pin_desc *pd;
43562306a36Sopenharmony_ci	int pin;
43662306a36Sopenharmony_ci
43762306a36Sopenharmony_ci	iod = pinctrl_dev_get_drvdata(pctldev);
43862306a36Sopenharmony_ci	if (!iod)
43962306a36Sopenharmony_ci		return -EINVAL;
44062306a36Sopenharmony_ci
44162306a36Sopenharmony_ci	r = iod->reg_data;
44262306a36Sopenharmony_ci
44362306a36Sopenharmony_ci	if (pinctrl_spec->args_count < r->reg_nr_per_pin) {
44462306a36Sopenharmony_ci		dev_err(iod->dev, "invalid args_count for spec: %i\n",
44562306a36Sopenharmony_ci			pinctrl_spec->args_count);
44662306a36Sopenharmony_ci
44762306a36Sopenharmony_ci		return -EINVAL;
44862306a36Sopenharmony_ci	}
44962306a36Sopenharmony_ci
45062306a36Sopenharmony_ci	/* Index plus two value cells */
45162306a36Sopenharmony_ci	cfg[pin_index].offset = pinctrl_spec->args[0];
45262306a36Sopenharmony_ci	cfg[pin_index].a_delay = pinctrl_spec->args[1] & 0xffff;
45362306a36Sopenharmony_ci	cfg[pin_index].g_delay = pinctrl_spec->args[2] & 0xffff;
45462306a36Sopenharmony_ci
45562306a36Sopenharmony_ci	pin = ti_iodelay_offset_to_pin(iod, cfg[pin_index].offset);
45662306a36Sopenharmony_ci	if (pin < 0) {
45762306a36Sopenharmony_ci		dev_err(iod->dev, "could not add functions for %pOFn %ux\n",
45862306a36Sopenharmony_ci			np, cfg[pin_index].offset);
45962306a36Sopenharmony_ci		return -ENODEV;
46062306a36Sopenharmony_ci	}
46162306a36Sopenharmony_ci	pins[pin_index] = pin;
46262306a36Sopenharmony_ci
46362306a36Sopenharmony_ci	pd = &iod->pa[pin];
46462306a36Sopenharmony_ci	pd->drv_data = &cfg[pin_index];
46562306a36Sopenharmony_ci
46662306a36Sopenharmony_ci	dev_dbg(iod->dev, "%pOFn offset=%x a_delay = %d g_delay = %d\n",
46762306a36Sopenharmony_ci		np, cfg[pin_index].offset, cfg[pin_index].a_delay,
46862306a36Sopenharmony_ci		cfg[pin_index].g_delay);
46962306a36Sopenharmony_ci
47062306a36Sopenharmony_ci	return 0;
47162306a36Sopenharmony_ci}
47262306a36Sopenharmony_ci
47362306a36Sopenharmony_ci/**
47462306a36Sopenharmony_ci * ti_iodelay_dt_node_to_map() - Map a device tree node to appropriate group
47562306a36Sopenharmony_ci * @pctldev: pinctrl device representing IODelay device
47662306a36Sopenharmony_ci * @np: Node Pointer (device tree)
47762306a36Sopenharmony_ci * @map: Pinctrl Map returned back to pinctrl framework
47862306a36Sopenharmony_ci * @num_maps: Number of maps (1)
47962306a36Sopenharmony_ci *
48062306a36Sopenharmony_ci * Maps the device tree description into a group of configuration parameters
48162306a36Sopenharmony_ci * for iodelay block entry.
48262306a36Sopenharmony_ci *
48362306a36Sopenharmony_ci * Return: 0 in case of success, else appropriate error value
48462306a36Sopenharmony_ci */
48562306a36Sopenharmony_cistatic int ti_iodelay_dt_node_to_map(struct pinctrl_dev *pctldev,
48662306a36Sopenharmony_ci				     struct device_node *np,
48762306a36Sopenharmony_ci				     struct pinctrl_map **map,
48862306a36Sopenharmony_ci				     unsigned int *num_maps)
48962306a36Sopenharmony_ci{
49062306a36Sopenharmony_ci	struct ti_iodelay_device *iod;
49162306a36Sopenharmony_ci	struct ti_iodelay_cfg *cfg;
49262306a36Sopenharmony_ci	struct ti_iodelay_pingroup *g;
49362306a36Sopenharmony_ci	const char *name = "pinctrl-pin-array";
49462306a36Sopenharmony_ci	int rows, *pins, error = -EINVAL, i;
49562306a36Sopenharmony_ci
49662306a36Sopenharmony_ci	iod = pinctrl_dev_get_drvdata(pctldev);
49762306a36Sopenharmony_ci	if (!iod)
49862306a36Sopenharmony_ci		return -EINVAL;
49962306a36Sopenharmony_ci
50062306a36Sopenharmony_ci	rows = pinctrl_count_index_with_args(np, name);
50162306a36Sopenharmony_ci	if (rows < 0)
50262306a36Sopenharmony_ci		return rows;
50362306a36Sopenharmony_ci
50462306a36Sopenharmony_ci	*map = devm_kzalloc(iod->dev, sizeof(**map), GFP_KERNEL);
50562306a36Sopenharmony_ci	if (!*map)
50662306a36Sopenharmony_ci		return -ENOMEM;
50762306a36Sopenharmony_ci	*num_maps = 0;
50862306a36Sopenharmony_ci
50962306a36Sopenharmony_ci	g = devm_kzalloc(iod->dev, sizeof(*g), GFP_KERNEL);
51062306a36Sopenharmony_ci	if (!g) {
51162306a36Sopenharmony_ci		error = -ENOMEM;
51262306a36Sopenharmony_ci		goto free_map;
51362306a36Sopenharmony_ci	}
51462306a36Sopenharmony_ci
51562306a36Sopenharmony_ci	pins = devm_kcalloc(iod->dev, rows, sizeof(*pins), GFP_KERNEL);
51662306a36Sopenharmony_ci	if (!pins) {
51762306a36Sopenharmony_ci		error = -ENOMEM;
51862306a36Sopenharmony_ci		goto free_group;
51962306a36Sopenharmony_ci	}
52062306a36Sopenharmony_ci
52162306a36Sopenharmony_ci	cfg = devm_kcalloc(iod->dev, rows, sizeof(*cfg), GFP_KERNEL);
52262306a36Sopenharmony_ci	if (!cfg) {
52362306a36Sopenharmony_ci		error = -ENOMEM;
52462306a36Sopenharmony_ci		goto free_pins;
52562306a36Sopenharmony_ci	}
52662306a36Sopenharmony_ci
52762306a36Sopenharmony_ci	for (i = 0; i < rows; i++) {
52862306a36Sopenharmony_ci		struct of_phandle_args pinctrl_spec;
52962306a36Sopenharmony_ci
53062306a36Sopenharmony_ci		error = pinctrl_parse_index_with_args(np, name, i,
53162306a36Sopenharmony_ci						      &pinctrl_spec);
53262306a36Sopenharmony_ci		if (error)
53362306a36Sopenharmony_ci			goto free_data;
53462306a36Sopenharmony_ci
53562306a36Sopenharmony_ci		error = ti_iodelay_node_iterator(pctldev, np, &pinctrl_spec,
53662306a36Sopenharmony_ci						 pins, i, cfg);
53762306a36Sopenharmony_ci		if (error)
53862306a36Sopenharmony_ci			goto free_data;
53962306a36Sopenharmony_ci	}
54062306a36Sopenharmony_ci
54162306a36Sopenharmony_ci	g->cfg = cfg;
54262306a36Sopenharmony_ci	g->ncfg = i;
54362306a36Sopenharmony_ci	g->config = PIN_CONFIG_END;
54462306a36Sopenharmony_ci
54562306a36Sopenharmony_ci	error = pinctrl_generic_add_group(iod->pctl, np->name, pins, i, g);
54662306a36Sopenharmony_ci	if (error < 0)
54762306a36Sopenharmony_ci		goto free_data;
54862306a36Sopenharmony_ci
54962306a36Sopenharmony_ci	(*map)->type = PIN_MAP_TYPE_CONFIGS_GROUP;
55062306a36Sopenharmony_ci	(*map)->data.configs.group_or_pin = np->name;
55162306a36Sopenharmony_ci	(*map)->data.configs.configs = &g->config;
55262306a36Sopenharmony_ci	(*map)->data.configs.num_configs = 1;
55362306a36Sopenharmony_ci	*num_maps = 1;
55462306a36Sopenharmony_ci
55562306a36Sopenharmony_ci	return 0;
55662306a36Sopenharmony_ci
55762306a36Sopenharmony_cifree_data:
55862306a36Sopenharmony_ci	devm_kfree(iod->dev, cfg);
55962306a36Sopenharmony_cifree_pins:
56062306a36Sopenharmony_ci	devm_kfree(iod->dev, pins);
56162306a36Sopenharmony_cifree_group:
56262306a36Sopenharmony_ci	devm_kfree(iod->dev, g);
56362306a36Sopenharmony_cifree_map:
56462306a36Sopenharmony_ci	devm_kfree(iod->dev, *map);
56562306a36Sopenharmony_ci
56662306a36Sopenharmony_ci	return error;
56762306a36Sopenharmony_ci}
56862306a36Sopenharmony_ci
56962306a36Sopenharmony_ci/**
57062306a36Sopenharmony_ci * ti_iodelay_pinconf_group_get() - Get the group configuration
57162306a36Sopenharmony_ci * @pctldev: pinctrl device representing IODelay device
57262306a36Sopenharmony_ci * @selector: Group selector
57362306a36Sopenharmony_ci * @config: Configuration returned
57462306a36Sopenharmony_ci *
57562306a36Sopenharmony_ci * Return: The configuration if the group is valid, else returns -EINVAL
57662306a36Sopenharmony_ci */
57762306a36Sopenharmony_cistatic int ti_iodelay_pinconf_group_get(struct pinctrl_dev *pctldev,
57862306a36Sopenharmony_ci					unsigned int selector,
57962306a36Sopenharmony_ci					unsigned long *config)
58062306a36Sopenharmony_ci{
58162306a36Sopenharmony_ci	struct ti_iodelay_device *iod;
58262306a36Sopenharmony_ci	struct ti_iodelay_pingroup *group;
58362306a36Sopenharmony_ci
58462306a36Sopenharmony_ci	iod = pinctrl_dev_get_drvdata(pctldev);
58562306a36Sopenharmony_ci	group = ti_iodelay_get_pingroup(iod, selector);
58662306a36Sopenharmony_ci
58762306a36Sopenharmony_ci	if (!group)
58862306a36Sopenharmony_ci		return -EINVAL;
58962306a36Sopenharmony_ci
59062306a36Sopenharmony_ci	*config = group->config;
59162306a36Sopenharmony_ci	return 0;
59262306a36Sopenharmony_ci}
59362306a36Sopenharmony_ci
59462306a36Sopenharmony_ci/**
59562306a36Sopenharmony_ci * ti_iodelay_pinconf_group_set() - Configure the groups of pins
59662306a36Sopenharmony_ci * @pctldev: pinctrl device representing IODelay device
59762306a36Sopenharmony_ci * @selector: Group selector
59862306a36Sopenharmony_ci * @configs: Configurations
59962306a36Sopenharmony_ci * @num_configs: Number of configurations
60062306a36Sopenharmony_ci *
60162306a36Sopenharmony_ci * Return: 0 if all went fine, else appropriate error value.
60262306a36Sopenharmony_ci */
60362306a36Sopenharmony_cistatic int ti_iodelay_pinconf_group_set(struct pinctrl_dev *pctldev,
60462306a36Sopenharmony_ci					unsigned int selector,
60562306a36Sopenharmony_ci					unsigned long *configs,
60662306a36Sopenharmony_ci					unsigned int num_configs)
60762306a36Sopenharmony_ci{
60862306a36Sopenharmony_ci	struct ti_iodelay_device *iod;
60962306a36Sopenharmony_ci	struct device *dev;
61062306a36Sopenharmony_ci	struct ti_iodelay_pingroup *group;
61162306a36Sopenharmony_ci	int i;
61262306a36Sopenharmony_ci
61362306a36Sopenharmony_ci	iod = pinctrl_dev_get_drvdata(pctldev);
61462306a36Sopenharmony_ci	dev = iod->dev;
61562306a36Sopenharmony_ci	group = ti_iodelay_get_pingroup(iod, selector);
61662306a36Sopenharmony_ci
61762306a36Sopenharmony_ci	if (num_configs != 1) {
61862306a36Sopenharmony_ci		dev_err(dev, "Unsupported number of configurations %d\n",
61962306a36Sopenharmony_ci			num_configs);
62062306a36Sopenharmony_ci		return -EINVAL;
62162306a36Sopenharmony_ci	}
62262306a36Sopenharmony_ci
62362306a36Sopenharmony_ci	if (*configs != PIN_CONFIG_END) {
62462306a36Sopenharmony_ci		dev_err(dev, "Unsupported configuration\n");
62562306a36Sopenharmony_ci		return -EINVAL;
62662306a36Sopenharmony_ci	}
62762306a36Sopenharmony_ci
62862306a36Sopenharmony_ci	for (i = 0; i < group->ncfg; i++) {
62962306a36Sopenharmony_ci		if (ti_iodelay_pinconf_set(iod, &group->cfg[i]))
63062306a36Sopenharmony_ci			return -ENOTSUPP;
63162306a36Sopenharmony_ci	}
63262306a36Sopenharmony_ci
63362306a36Sopenharmony_ci	return 0;
63462306a36Sopenharmony_ci}
63562306a36Sopenharmony_ci
63662306a36Sopenharmony_ci#ifdef CONFIG_DEBUG_FS
63762306a36Sopenharmony_ci/**
63862306a36Sopenharmony_ci * ti_iodelay_pin_to_offset() - get pin register offset based on the pin index
63962306a36Sopenharmony_ci * @iod: iodelay driver instance
64062306a36Sopenharmony_ci * @selector: Pin index
64162306a36Sopenharmony_ci */
64262306a36Sopenharmony_cistatic unsigned int ti_iodelay_pin_to_offset(struct ti_iodelay_device *iod,
64362306a36Sopenharmony_ci					     unsigned int selector)
64462306a36Sopenharmony_ci{
64562306a36Sopenharmony_ci	const struct ti_iodelay_reg_data *r = iod->reg_data;
64662306a36Sopenharmony_ci	unsigned int offset;
64762306a36Sopenharmony_ci
64862306a36Sopenharmony_ci	offset = selector * r->regmap_config->reg_stride;
64962306a36Sopenharmony_ci	offset *= r->reg_nr_per_pin;
65062306a36Sopenharmony_ci	offset += r->reg_start_offset;
65162306a36Sopenharmony_ci
65262306a36Sopenharmony_ci	return offset;
65362306a36Sopenharmony_ci}
65462306a36Sopenharmony_ci
65562306a36Sopenharmony_cistatic void ti_iodelay_pin_dbg_show(struct pinctrl_dev *pctldev,
65662306a36Sopenharmony_ci				    struct seq_file *s,
65762306a36Sopenharmony_ci				    unsigned int pin)
65862306a36Sopenharmony_ci{
65962306a36Sopenharmony_ci	struct ti_iodelay_device *iod;
66062306a36Sopenharmony_ci	struct pinctrl_pin_desc *pd;
66162306a36Sopenharmony_ci	struct ti_iodelay_cfg *cfg;
66262306a36Sopenharmony_ci	const struct ti_iodelay_reg_data *r;
66362306a36Sopenharmony_ci	unsigned long offset;
66462306a36Sopenharmony_ci	u32 in, oen, out;
66562306a36Sopenharmony_ci
66662306a36Sopenharmony_ci	iod = pinctrl_dev_get_drvdata(pctldev);
66762306a36Sopenharmony_ci	r = iod->reg_data;
66862306a36Sopenharmony_ci
66962306a36Sopenharmony_ci	offset = ti_iodelay_pin_to_offset(iod, pin);
67062306a36Sopenharmony_ci	pd = &iod->pa[pin];
67162306a36Sopenharmony_ci	cfg = pd->drv_data;
67262306a36Sopenharmony_ci
67362306a36Sopenharmony_ci	regmap_read(iod->regmap, offset, &in);
67462306a36Sopenharmony_ci	regmap_read(iod->regmap, offset + r->regmap_config->reg_stride, &oen);
67562306a36Sopenharmony_ci	regmap_read(iod->regmap, offset + r->regmap_config->reg_stride * 2,
67662306a36Sopenharmony_ci		    &out);
67762306a36Sopenharmony_ci
67862306a36Sopenharmony_ci	seq_printf(s, "%lx a: %i g: %i (%08x %08x %08x) %s ",
67962306a36Sopenharmony_ci		   iod->phys_base + offset,
68062306a36Sopenharmony_ci		   cfg ? cfg->a_delay : -1,
68162306a36Sopenharmony_ci		   cfg ? cfg->g_delay : -1,
68262306a36Sopenharmony_ci		   in, oen, out, DRIVER_NAME);
68362306a36Sopenharmony_ci}
68462306a36Sopenharmony_ci
68562306a36Sopenharmony_ci/**
68662306a36Sopenharmony_ci * ti_iodelay_pinconf_group_dbg_show() - show the group information
68762306a36Sopenharmony_ci * @pctldev: Show the group information
68862306a36Sopenharmony_ci * @s: Sequence file
68962306a36Sopenharmony_ci * @selector: Group selector
69062306a36Sopenharmony_ci *
69162306a36Sopenharmony_ci * Provide the configuration information of the selected group
69262306a36Sopenharmony_ci */
69362306a36Sopenharmony_cistatic void ti_iodelay_pinconf_group_dbg_show(struct pinctrl_dev *pctldev,
69462306a36Sopenharmony_ci					      struct seq_file *s,
69562306a36Sopenharmony_ci					      unsigned int selector)
69662306a36Sopenharmony_ci{
69762306a36Sopenharmony_ci	struct ti_iodelay_device *iod;
69862306a36Sopenharmony_ci	struct ti_iodelay_pingroup *group;
69962306a36Sopenharmony_ci	int i;
70062306a36Sopenharmony_ci
70162306a36Sopenharmony_ci	iod = pinctrl_dev_get_drvdata(pctldev);
70262306a36Sopenharmony_ci	group = ti_iodelay_get_pingroup(iod, selector);
70362306a36Sopenharmony_ci	if (!group)
70462306a36Sopenharmony_ci		return;
70562306a36Sopenharmony_ci
70662306a36Sopenharmony_ci	for (i = 0; i < group->ncfg; i++) {
70762306a36Sopenharmony_ci		struct ti_iodelay_cfg *cfg;
70862306a36Sopenharmony_ci		u32 reg = 0;
70962306a36Sopenharmony_ci
71062306a36Sopenharmony_ci		cfg = &group->cfg[i];
71162306a36Sopenharmony_ci		regmap_read(iod->regmap, cfg->offset, &reg);
71262306a36Sopenharmony_ci		seq_printf(s, "\n\t0x%08x = 0x%08x (%3d, %3d)",
71362306a36Sopenharmony_ci			cfg->offset, reg, cfg->a_delay, cfg->g_delay);
71462306a36Sopenharmony_ci	}
71562306a36Sopenharmony_ci}
71662306a36Sopenharmony_ci#endif
71762306a36Sopenharmony_ci
71862306a36Sopenharmony_cistatic const struct pinctrl_ops ti_iodelay_pinctrl_ops = {
71962306a36Sopenharmony_ci	.get_groups_count = pinctrl_generic_get_group_count,
72062306a36Sopenharmony_ci	.get_group_name = pinctrl_generic_get_group_name,
72162306a36Sopenharmony_ci	.get_group_pins = pinctrl_generic_get_group_pins,
72262306a36Sopenharmony_ci#ifdef CONFIG_DEBUG_FS
72362306a36Sopenharmony_ci	.pin_dbg_show = ti_iodelay_pin_dbg_show,
72462306a36Sopenharmony_ci#endif
72562306a36Sopenharmony_ci	.dt_node_to_map = ti_iodelay_dt_node_to_map,
72662306a36Sopenharmony_ci};
72762306a36Sopenharmony_ci
72862306a36Sopenharmony_cistatic const struct pinconf_ops ti_iodelay_pinctrl_pinconf_ops = {
72962306a36Sopenharmony_ci	.pin_config_group_get = ti_iodelay_pinconf_group_get,
73062306a36Sopenharmony_ci	.pin_config_group_set = ti_iodelay_pinconf_group_set,
73162306a36Sopenharmony_ci#ifdef CONFIG_DEBUG_FS
73262306a36Sopenharmony_ci	.pin_config_group_dbg_show = ti_iodelay_pinconf_group_dbg_show,
73362306a36Sopenharmony_ci#endif
73462306a36Sopenharmony_ci};
73562306a36Sopenharmony_ci
73662306a36Sopenharmony_ci/**
73762306a36Sopenharmony_ci * ti_iodelay_alloc_pins() - Allocate structures needed for pins for iodelay
73862306a36Sopenharmony_ci * @dev: Device pointer
73962306a36Sopenharmony_ci * @iod: iodelay device
74062306a36Sopenharmony_ci * @base_phy: Base Physical Address
74162306a36Sopenharmony_ci *
74262306a36Sopenharmony_ci * Return: 0 if all went fine, else appropriate error value.
74362306a36Sopenharmony_ci */
74462306a36Sopenharmony_cistatic int ti_iodelay_alloc_pins(struct device *dev,
74562306a36Sopenharmony_ci				 struct ti_iodelay_device *iod, u32 base_phy)
74662306a36Sopenharmony_ci{
74762306a36Sopenharmony_ci	const struct ti_iodelay_reg_data *r = iod->reg_data;
74862306a36Sopenharmony_ci	struct pinctrl_pin_desc *pin;
74962306a36Sopenharmony_ci	u32 phy_reg;
75062306a36Sopenharmony_ci	int nr_pins, i;
75162306a36Sopenharmony_ci
75262306a36Sopenharmony_ci	nr_pins = ti_iodelay_offset_to_pin(iod, r->regmap_config->max_register);
75362306a36Sopenharmony_ci	dev_dbg(dev, "Allocating %i pins\n", nr_pins);
75462306a36Sopenharmony_ci
75562306a36Sopenharmony_ci	iod->pa = devm_kcalloc(dev, nr_pins, sizeof(*iod->pa), GFP_KERNEL);
75662306a36Sopenharmony_ci	if (!iod->pa)
75762306a36Sopenharmony_ci		return -ENOMEM;
75862306a36Sopenharmony_ci
75962306a36Sopenharmony_ci	iod->desc.pins = iod->pa;
76062306a36Sopenharmony_ci	iod->desc.npins = nr_pins;
76162306a36Sopenharmony_ci
76262306a36Sopenharmony_ci	phy_reg = r->reg_start_offset + base_phy;
76362306a36Sopenharmony_ci
76462306a36Sopenharmony_ci	for (i = 0; i < nr_pins; i++, phy_reg += 4) {
76562306a36Sopenharmony_ci		pin = &iod->pa[i];
76662306a36Sopenharmony_ci		pin->number = i;
76762306a36Sopenharmony_ci	}
76862306a36Sopenharmony_ci
76962306a36Sopenharmony_ci	return 0;
77062306a36Sopenharmony_ci}
77162306a36Sopenharmony_ci
77262306a36Sopenharmony_cistatic struct regmap_config dra7_iodelay_regmap_config = {
77362306a36Sopenharmony_ci	.reg_bits = 32,
77462306a36Sopenharmony_ci	.reg_stride = 4,
77562306a36Sopenharmony_ci	.val_bits = 32,
77662306a36Sopenharmony_ci	.max_register = 0xd1c,
77762306a36Sopenharmony_ci};
77862306a36Sopenharmony_ci
77962306a36Sopenharmony_cistatic struct ti_iodelay_reg_data dra7_iodelay_data = {
78062306a36Sopenharmony_ci	.signature_mask = 0x0003f000,
78162306a36Sopenharmony_ci	.signature_value = 0x29,
78262306a36Sopenharmony_ci	.lock_mask = 0x00000400,
78362306a36Sopenharmony_ci	.lock_val = 1,
78462306a36Sopenharmony_ci	.unlock_val = 0,
78562306a36Sopenharmony_ci	.binary_data_coarse_mask = 0x000003e0,
78662306a36Sopenharmony_ci	.binary_data_fine_mask = 0x0000001f,
78762306a36Sopenharmony_ci
78862306a36Sopenharmony_ci	.reg_refclk_offset = 0x14,
78962306a36Sopenharmony_ci	.refclk_period_mask = 0xffff,
79062306a36Sopenharmony_ci
79162306a36Sopenharmony_ci	.reg_coarse_offset = 0x18,
79262306a36Sopenharmony_ci	.coarse_delay_count_mask = 0xffff0000,
79362306a36Sopenharmony_ci	.coarse_ref_count_mask = 0x0000ffff,
79462306a36Sopenharmony_ci
79562306a36Sopenharmony_ci	.reg_fine_offset = 0x1C,
79662306a36Sopenharmony_ci	.fine_delay_count_mask = 0xffff0000,
79762306a36Sopenharmony_ci	.fine_ref_count_mask = 0x0000ffff,
79862306a36Sopenharmony_ci
79962306a36Sopenharmony_ci	.reg_global_lock_offset = 0x2c,
80062306a36Sopenharmony_ci	.global_lock_mask = 0x0000ffff,
80162306a36Sopenharmony_ci	.global_unlock_val = 0x0000aaaa,
80262306a36Sopenharmony_ci	.global_lock_val = 0x0000aaab,
80362306a36Sopenharmony_ci
80462306a36Sopenharmony_ci	.reg_start_offset = 0x30,
80562306a36Sopenharmony_ci	.reg_nr_per_pin = 3,
80662306a36Sopenharmony_ci	.regmap_config = &dra7_iodelay_regmap_config,
80762306a36Sopenharmony_ci};
80862306a36Sopenharmony_ci
80962306a36Sopenharmony_cistatic const struct of_device_id ti_iodelay_of_match[] = {
81062306a36Sopenharmony_ci	{.compatible = "ti,dra7-iodelay", .data = &dra7_iodelay_data},
81162306a36Sopenharmony_ci	{ /* Hopefully no more.. */ },
81262306a36Sopenharmony_ci};
81362306a36Sopenharmony_ciMODULE_DEVICE_TABLE(of, ti_iodelay_of_match);
81462306a36Sopenharmony_ci
81562306a36Sopenharmony_ci/**
81662306a36Sopenharmony_ci * ti_iodelay_probe() - Standard probe
81762306a36Sopenharmony_ci * @pdev: platform device
81862306a36Sopenharmony_ci *
81962306a36Sopenharmony_ci * Return: 0 if all went fine, else appropriate error value.
82062306a36Sopenharmony_ci */
82162306a36Sopenharmony_cistatic int ti_iodelay_probe(struct platform_device *pdev)
82262306a36Sopenharmony_ci{
82362306a36Sopenharmony_ci	struct device *dev = &pdev->dev;
82462306a36Sopenharmony_ci	struct device_node *np = of_node_get(dev->of_node);
82562306a36Sopenharmony_ci	const struct of_device_id *match;
82662306a36Sopenharmony_ci	struct resource *res;
82762306a36Sopenharmony_ci	struct ti_iodelay_device *iod;
82862306a36Sopenharmony_ci	int ret = 0;
82962306a36Sopenharmony_ci
83062306a36Sopenharmony_ci	if (!np) {
83162306a36Sopenharmony_ci		ret = -EINVAL;
83262306a36Sopenharmony_ci		dev_err(dev, "No OF node\n");
83362306a36Sopenharmony_ci		goto exit_out;
83462306a36Sopenharmony_ci	}
83562306a36Sopenharmony_ci
83662306a36Sopenharmony_ci	match = of_match_device(ti_iodelay_of_match, dev);
83762306a36Sopenharmony_ci	if (!match) {
83862306a36Sopenharmony_ci		ret = -EINVAL;
83962306a36Sopenharmony_ci		dev_err(dev, "No DATA match\n");
84062306a36Sopenharmony_ci		goto exit_out;
84162306a36Sopenharmony_ci	}
84262306a36Sopenharmony_ci
84362306a36Sopenharmony_ci	iod = devm_kzalloc(dev, sizeof(*iod), GFP_KERNEL);
84462306a36Sopenharmony_ci	if (!iod) {
84562306a36Sopenharmony_ci		ret = -ENOMEM;
84662306a36Sopenharmony_ci		goto exit_out;
84762306a36Sopenharmony_ci	}
84862306a36Sopenharmony_ci	iod->dev = dev;
84962306a36Sopenharmony_ci	iod->reg_data = match->data;
85062306a36Sopenharmony_ci
85162306a36Sopenharmony_ci	/* So far We can assume there is only 1 bank of registers */
85262306a36Sopenharmony_ci	iod->reg_base = devm_platform_get_and_ioremap_resource(pdev, 0, &res);
85362306a36Sopenharmony_ci	if (IS_ERR(iod->reg_base)) {
85462306a36Sopenharmony_ci		ret = PTR_ERR(iod->reg_base);
85562306a36Sopenharmony_ci		goto exit_out;
85662306a36Sopenharmony_ci	}
85762306a36Sopenharmony_ci	iod->phys_base = res->start;
85862306a36Sopenharmony_ci
85962306a36Sopenharmony_ci	iod->regmap = devm_regmap_init_mmio(dev, iod->reg_base,
86062306a36Sopenharmony_ci					    iod->reg_data->regmap_config);
86162306a36Sopenharmony_ci	if (IS_ERR(iod->regmap)) {
86262306a36Sopenharmony_ci		dev_err(dev, "Regmap MMIO init failed.\n");
86362306a36Sopenharmony_ci		ret = PTR_ERR(iod->regmap);
86462306a36Sopenharmony_ci		goto exit_out;
86562306a36Sopenharmony_ci	}
86662306a36Sopenharmony_ci
86762306a36Sopenharmony_ci	ret = ti_iodelay_pinconf_init_dev(iod);
86862306a36Sopenharmony_ci	if (ret)
86962306a36Sopenharmony_ci		goto exit_out;
87062306a36Sopenharmony_ci
87162306a36Sopenharmony_ci	ret = ti_iodelay_alloc_pins(dev, iod, res->start);
87262306a36Sopenharmony_ci	if (ret)
87362306a36Sopenharmony_ci		goto exit_out;
87462306a36Sopenharmony_ci
87562306a36Sopenharmony_ci	iod->desc.pctlops = &ti_iodelay_pinctrl_ops;
87662306a36Sopenharmony_ci	/* no pinmux ops - we are pinconf */
87762306a36Sopenharmony_ci	iod->desc.confops = &ti_iodelay_pinctrl_pinconf_ops;
87862306a36Sopenharmony_ci	iod->desc.name = dev_name(dev);
87962306a36Sopenharmony_ci	iod->desc.owner = THIS_MODULE;
88062306a36Sopenharmony_ci
88162306a36Sopenharmony_ci	ret = pinctrl_register_and_init(&iod->desc, dev, iod, &iod->pctl);
88262306a36Sopenharmony_ci	if (ret) {
88362306a36Sopenharmony_ci		dev_err(dev, "Failed to register pinctrl\n");
88462306a36Sopenharmony_ci		goto exit_out;
88562306a36Sopenharmony_ci	}
88662306a36Sopenharmony_ci
88762306a36Sopenharmony_ci	platform_set_drvdata(pdev, iod);
88862306a36Sopenharmony_ci
88962306a36Sopenharmony_ci	return pinctrl_enable(iod->pctl);
89062306a36Sopenharmony_ci
89162306a36Sopenharmony_ciexit_out:
89262306a36Sopenharmony_ci	of_node_put(np);
89362306a36Sopenharmony_ci	return ret;
89462306a36Sopenharmony_ci}
89562306a36Sopenharmony_ci
89662306a36Sopenharmony_ci/**
89762306a36Sopenharmony_ci * ti_iodelay_remove() - standard remove
89862306a36Sopenharmony_ci * @pdev: platform device
89962306a36Sopenharmony_ci *
90062306a36Sopenharmony_ci * Return: 0 if all went fine, else appropriate error value.
90162306a36Sopenharmony_ci */
90262306a36Sopenharmony_cistatic int ti_iodelay_remove(struct platform_device *pdev)
90362306a36Sopenharmony_ci{
90462306a36Sopenharmony_ci	struct ti_iodelay_device *iod = platform_get_drvdata(pdev);
90562306a36Sopenharmony_ci
90662306a36Sopenharmony_ci	if (!iod)
90762306a36Sopenharmony_ci		return 0;
90862306a36Sopenharmony_ci
90962306a36Sopenharmony_ci	if (iod->pctl)
91062306a36Sopenharmony_ci		pinctrl_unregister(iod->pctl);
91162306a36Sopenharmony_ci
91262306a36Sopenharmony_ci	ti_iodelay_pinconf_deinit_dev(iod);
91362306a36Sopenharmony_ci
91462306a36Sopenharmony_ci	/* Expect other allocations to be freed by devm */
91562306a36Sopenharmony_ci
91662306a36Sopenharmony_ci	return 0;
91762306a36Sopenharmony_ci}
91862306a36Sopenharmony_ci
91962306a36Sopenharmony_cistatic struct platform_driver ti_iodelay_driver = {
92062306a36Sopenharmony_ci	.probe = ti_iodelay_probe,
92162306a36Sopenharmony_ci	.remove = ti_iodelay_remove,
92262306a36Sopenharmony_ci	.driver = {
92362306a36Sopenharmony_ci		   .name = DRIVER_NAME,
92462306a36Sopenharmony_ci		   .of_match_table = ti_iodelay_of_match,
92562306a36Sopenharmony_ci	},
92662306a36Sopenharmony_ci};
92762306a36Sopenharmony_cimodule_platform_driver(ti_iodelay_driver);
92862306a36Sopenharmony_ci
92962306a36Sopenharmony_ciMODULE_AUTHOR("Texas Instruments, Inc.");
93062306a36Sopenharmony_ciMODULE_DESCRIPTION("Pinconf driver for TI's IO Delay module");
93162306a36Sopenharmony_ciMODULE_LICENSE("GPL v2");
932