1*4882a593Smuzhiyun /*
2*4882a593Smuzhiyun * Support for configuration of IO Delay module found on Texas Instruments SoCs
3*4882a593Smuzhiyun * such as DRA7
4*4882a593Smuzhiyun *
5*4882a593Smuzhiyun * Copyright (C) 2015-2017 Texas Instruments Incorporated - https://www.ti.com/
6*4882a593Smuzhiyun *
7*4882a593Smuzhiyun * This file is licensed under the terms of the GNU General Public
8*4882a593Smuzhiyun * License version 2. This program is licensed "as is" without any
9*4882a593Smuzhiyun * warranty of any kind, whether express or implied.
10*4882a593Smuzhiyun */
11*4882a593Smuzhiyun
12*4882a593Smuzhiyun #include <linux/err.h>
13*4882a593Smuzhiyun #include <linux/init.h>
14*4882a593Smuzhiyun #include <linux/io.h>
15*4882a593Smuzhiyun #include <linux/module.h>
16*4882a593Smuzhiyun #include <linux/of.h>
17*4882a593Smuzhiyun #include <linux/of_device.h>
18*4882a593Smuzhiyun #include <linux/pinctrl/pinconf.h>
19*4882a593Smuzhiyun #include <linux/pinctrl/pinconf-generic.h>
20*4882a593Smuzhiyun #include <linux/pinctrl/pinctrl.h>
21*4882a593Smuzhiyun #include <linux/regmap.h>
22*4882a593Smuzhiyun #include <linux/slab.h>
23*4882a593Smuzhiyun
24*4882a593Smuzhiyun #include "../core.h"
25*4882a593Smuzhiyun #include "../devicetree.h"
26*4882a593Smuzhiyun
27*4882a593Smuzhiyun #define DRIVER_NAME "ti-iodelay"
28*4882a593Smuzhiyun
29*4882a593Smuzhiyun /**
30*4882a593Smuzhiyun * struct ti_iodelay_reg_data - Describes the registers for the iodelay instance
31*4882a593Smuzhiyun * @signature_mask: CONFIG_REG mask for the signature bits (see TRM)
32*4882a593Smuzhiyun * @signature_value: CONFIG_REG signature value to be written (see TRM)
33*4882a593Smuzhiyun * @lock_mask: CONFIG_REG mask for the lock bits (see TRM)
34*4882a593Smuzhiyun * @lock_val: CONFIG_REG lock value for the lock bits (see TRM)
35*4882a593Smuzhiyun * @unlock_val:CONFIG_REG unlock value for the lock bits (see TRM)
36*4882a593Smuzhiyun * @binary_data_coarse_mask: CONFIG_REG coarse mask (see TRM)
37*4882a593Smuzhiyun * @binary_data_fine_mask: CONFIG_REG fine mask (see TRM)
38*4882a593Smuzhiyun * @reg_refclk_offset: Refclk register offset
39*4882a593Smuzhiyun * @refclk_period_mask: Refclk mask
40*4882a593Smuzhiyun * @reg_coarse_offset: Coarse register configuration offset
41*4882a593Smuzhiyun * @coarse_delay_count_mask: Coarse delay count mask
42*4882a593Smuzhiyun * @coarse_ref_count_mask: Coarse ref count mask
43*4882a593Smuzhiyun * @reg_fine_offset: Fine register configuration offset
44*4882a593Smuzhiyun * @fine_delay_count_mask: Fine delay count mask
45*4882a593Smuzhiyun * @fine_ref_count_mask: Fine ref count mask
46*4882a593Smuzhiyun * @reg_global_lock_offset: Global iodelay module lock register offset
47*4882a593Smuzhiyun * @global_lock_mask: Lock mask
48*4882a593Smuzhiyun * @global_unlock_val: Unlock value
49*4882a593Smuzhiyun * @global_lock_val: Lock value
50*4882a593Smuzhiyun * @reg_start_offset: Offset to iodelay registers after the CONFIG_REG_0 to 8
51*4882a593Smuzhiyun * @reg_nr_per_pin: Number of iodelay registers for each pin
52*4882a593Smuzhiyun * @regmap_config: Regmap configuration for the IODelay region
53*4882a593Smuzhiyun */
54*4882a593Smuzhiyun struct ti_iodelay_reg_data {
55*4882a593Smuzhiyun u32 signature_mask;
56*4882a593Smuzhiyun u32 signature_value;
57*4882a593Smuzhiyun u32 lock_mask;
58*4882a593Smuzhiyun u32 lock_val;
59*4882a593Smuzhiyun u32 unlock_val;
60*4882a593Smuzhiyun u32 binary_data_coarse_mask;
61*4882a593Smuzhiyun u32 binary_data_fine_mask;
62*4882a593Smuzhiyun
63*4882a593Smuzhiyun u32 reg_refclk_offset;
64*4882a593Smuzhiyun u32 refclk_period_mask;
65*4882a593Smuzhiyun
66*4882a593Smuzhiyun u32 reg_coarse_offset;
67*4882a593Smuzhiyun u32 coarse_delay_count_mask;
68*4882a593Smuzhiyun u32 coarse_ref_count_mask;
69*4882a593Smuzhiyun
70*4882a593Smuzhiyun u32 reg_fine_offset;
71*4882a593Smuzhiyun u32 fine_delay_count_mask;
72*4882a593Smuzhiyun u32 fine_ref_count_mask;
73*4882a593Smuzhiyun
74*4882a593Smuzhiyun u32 reg_global_lock_offset;
75*4882a593Smuzhiyun u32 global_lock_mask;
76*4882a593Smuzhiyun u32 global_unlock_val;
77*4882a593Smuzhiyun u32 global_lock_val;
78*4882a593Smuzhiyun
79*4882a593Smuzhiyun u32 reg_start_offset;
80*4882a593Smuzhiyun u32 reg_nr_per_pin;
81*4882a593Smuzhiyun
82*4882a593Smuzhiyun struct regmap_config *regmap_config;
83*4882a593Smuzhiyun };
84*4882a593Smuzhiyun
85*4882a593Smuzhiyun /**
86*4882a593Smuzhiyun * struct ti_iodelay_reg_values - Computed io_reg configuration values (see TRM)
87*4882a593Smuzhiyun * @coarse_ref_count: Coarse reference count
88*4882a593Smuzhiyun * @coarse_delay_count: Coarse delay count
89*4882a593Smuzhiyun * @fine_ref_count: Fine reference count
90*4882a593Smuzhiyun * @fine_delay_count: Fine Delay count
91*4882a593Smuzhiyun * @ref_clk_period: Reference Clock period
92*4882a593Smuzhiyun * @cdpe: Coarse delay parameter
93*4882a593Smuzhiyun * @fdpe: Fine delay parameter
94*4882a593Smuzhiyun */
95*4882a593Smuzhiyun struct ti_iodelay_reg_values {
96*4882a593Smuzhiyun u16 coarse_ref_count;
97*4882a593Smuzhiyun u16 coarse_delay_count;
98*4882a593Smuzhiyun
99*4882a593Smuzhiyun u16 fine_ref_count;
100*4882a593Smuzhiyun u16 fine_delay_count;
101*4882a593Smuzhiyun
102*4882a593Smuzhiyun u16 ref_clk_period;
103*4882a593Smuzhiyun
104*4882a593Smuzhiyun u32 cdpe;
105*4882a593Smuzhiyun u32 fdpe;
106*4882a593Smuzhiyun };
107*4882a593Smuzhiyun
108*4882a593Smuzhiyun /**
109*4882a593Smuzhiyun * struct ti_iodelay_cfg - Description of each configuration parameters
110*4882a593Smuzhiyun * @offset: Configuration register offset
111*4882a593Smuzhiyun * @a_delay: Agnostic Delay (in ps)
112*4882a593Smuzhiyun * @g_delay: Gnostic Delay (in ps)
113*4882a593Smuzhiyun */
114*4882a593Smuzhiyun struct ti_iodelay_cfg {
115*4882a593Smuzhiyun u16 offset;
116*4882a593Smuzhiyun u16 a_delay;
117*4882a593Smuzhiyun u16 g_delay;
118*4882a593Smuzhiyun };
119*4882a593Smuzhiyun
120*4882a593Smuzhiyun /**
121*4882a593Smuzhiyun * struct ti_iodelay_pingroup - Structure that describes one group
122*4882a593Smuzhiyun * @cfg: configuration array for the pin (from dt)
123*4882a593Smuzhiyun * @ncfg: number of configuration values allocated
124*4882a593Smuzhiyun * @config: pinconf "Config" - currently a dummy value
125*4882a593Smuzhiyun */
126*4882a593Smuzhiyun struct ti_iodelay_pingroup {
127*4882a593Smuzhiyun struct ti_iodelay_cfg *cfg;
128*4882a593Smuzhiyun int ncfg;
129*4882a593Smuzhiyun unsigned long config;
130*4882a593Smuzhiyun };
131*4882a593Smuzhiyun
132*4882a593Smuzhiyun /**
133*4882a593Smuzhiyun * struct ti_iodelay_device - Represents information for a iodelay instance
134*4882a593Smuzhiyun * @dev: Device pointer
135*4882a593Smuzhiyun * @phys_base: Physical address base of the iodelay device
136*4882a593Smuzhiyun * @reg_base: Virtual address base of the iodelay device
137*4882a593Smuzhiyun * @regmap: Regmap for this iodelay instance
138*4882a593Smuzhiyun * @pctl: Pinctrl device
139*4882a593Smuzhiyun * @desc: pinctrl descriptor for pctl
140*4882a593Smuzhiyun * @pa: pinctrl pin wise description
141*4882a593Smuzhiyun * @reg_data: Register definition data for the IODelay instance
142*4882a593Smuzhiyun * @reg_init_conf_values: Initial configuration values.
143*4882a593Smuzhiyun */
144*4882a593Smuzhiyun struct ti_iodelay_device {
145*4882a593Smuzhiyun struct device *dev;
146*4882a593Smuzhiyun unsigned long phys_base;
147*4882a593Smuzhiyun void __iomem *reg_base;
148*4882a593Smuzhiyun struct regmap *regmap;
149*4882a593Smuzhiyun
150*4882a593Smuzhiyun struct pinctrl_dev *pctl;
151*4882a593Smuzhiyun struct pinctrl_desc desc;
152*4882a593Smuzhiyun struct pinctrl_pin_desc *pa;
153*4882a593Smuzhiyun
154*4882a593Smuzhiyun const struct ti_iodelay_reg_data *reg_data;
155*4882a593Smuzhiyun struct ti_iodelay_reg_values reg_init_conf_values;
156*4882a593Smuzhiyun };
157*4882a593Smuzhiyun
158*4882a593Smuzhiyun /**
159*4882a593Smuzhiyun * ti_iodelay_extract() - extract bits for a field
160*4882a593Smuzhiyun * @val: Register value
161*4882a593Smuzhiyun * @mask: Mask
162*4882a593Smuzhiyun *
163*4882a593Smuzhiyun * Return: extracted value which is appropriately shifted
164*4882a593Smuzhiyun */
ti_iodelay_extract(u32 val,u32 mask)165*4882a593Smuzhiyun static inline u32 ti_iodelay_extract(u32 val, u32 mask)
166*4882a593Smuzhiyun {
167*4882a593Smuzhiyun return (val & mask) >> __ffs(mask);
168*4882a593Smuzhiyun }
169*4882a593Smuzhiyun
170*4882a593Smuzhiyun /**
171*4882a593Smuzhiyun * ti_iodelay_compute_dpe() - Compute equation for delay parameter
172*4882a593Smuzhiyun * @period: Period to use
173*4882a593Smuzhiyun * @ref: Reference Count
174*4882a593Smuzhiyun * @delay: Delay count
175*4882a593Smuzhiyun * @delay_m: Delay multiplier
176*4882a593Smuzhiyun *
177*4882a593Smuzhiyun * Return: Computed delay parameter
178*4882a593Smuzhiyun */
ti_iodelay_compute_dpe(u16 period,u16 ref,u16 delay,u16 delay_m)179*4882a593Smuzhiyun static inline u32 ti_iodelay_compute_dpe(u16 period, u16 ref, u16 delay,
180*4882a593Smuzhiyun u16 delay_m)
181*4882a593Smuzhiyun {
182*4882a593Smuzhiyun u64 m, d;
183*4882a593Smuzhiyun
184*4882a593Smuzhiyun /* Handle overflow conditions */
185*4882a593Smuzhiyun m = 10 * (u64)period * (u64)ref;
186*4882a593Smuzhiyun d = 2 * (u64)delay * (u64)delay_m;
187*4882a593Smuzhiyun
188*4882a593Smuzhiyun /* Truncate result back to 32 bits */
189*4882a593Smuzhiyun return div64_u64(m, d);
190*4882a593Smuzhiyun }
191*4882a593Smuzhiyun
192*4882a593Smuzhiyun /**
193*4882a593Smuzhiyun * ti_iodelay_pinconf_set() - Configure the pin configuration
194*4882a593Smuzhiyun * @iod: iodelay device
195*4882a593Smuzhiyun * @cfg: Configuration
196*4882a593Smuzhiyun *
197*4882a593Smuzhiyun * Update the configuration register as per TRM and lockup once done.
198*4882a593Smuzhiyun * *IMPORTANT NOTE* SoC TRM does recommend doing iodelay programmation only
199*4882a593Smuzhiyun * while in Isolation. But, then, isolation also implies that every pin
200*4882a593Smuzhiyun * on the SoC (including DDR) will be isolated out. The only benefit being
201*4882a593Smuzhiyun * a glitchless configuration, However, the intent of this driver is purely
202*4882a593Smuzhiyun * to support a "glitchy" configuration where applicable.
203*4882a593Smuzhiyun *
204*4882a593Smuzhiyun * Return: 0 in case of success, else appropriate error value
205*4882a593Smuzhiyun */
ti_iodelay_pinconf_set(struct ti_iodelay_device * iod,struct ti_iodelay_cfg * cfg)206*4882a593Smuzhiyun static int ti_iodelay_pinconf_set(struct ti_iodelay_device *iod,
207*4882a593Smuzhiyun struct ti_iodelay_cfg *cfg)
208*4882a593Smuzhiyun {
209*4882a593Smuzhiyun const struct ti_iodelay_reg_data *reg = iod->reg_data;
210*4882a593Smuzhiyun struct ti_iodelay_reg_values *ival = &iod->reg_init_conf_values;
211*4882a593Smuzhiyun struct device *dev = iod->dev;
212*4882a593Smuzhiyun u32 g_delay_coarse, g_delay_fine;
213*4882a593Smuzhiyun u32 a_delay_coarse, a_delay_fine;
214*4882a593Smuzhiyun u32 c_elements, f_elements;
215*4882a593Smuzhiyun u32 total_delay;
216*4882a593Smuzhiyun u32 reg_mask, reg_val, tmp_val;
217*4882a593Smuzhiyun int r;
218*4882a593Smuzhiyun
219*4882a593Smuzhiyun /* NOTE: Truncation is expected in all division below */
220*4882a593Smuzhiyun g_delay_coarse = cfg->g_delay / 920;
221*4882a593Smuzhiyun g_delay_fine = ((cfg->g_delay % 920) * 10) / 60;
222*4882a593Smuzhiyun
223*4882a593Smuzhiyun a_delay_coarse = cfg->a_delay / ival->cdpe;
224*4882a593Smuzhiyun a_delay_fine = ((cfg->a_delay % ival->cdpe) * 10) / ival->fdpe;
225*4882a593Smuzhiyun
226*4882a593Smuzhiyun c_elements = g_delay_coarse + a_delay_coarse;
227*4882a593Smuzhiyun f_elements = (g_delay_fine + a_delay_fine) / 10;
228*4882a593Smuzhiyun
229*4882a593Smuzhiyun if (f_elements > 22) {
230*4882a593Smuzhiyun total_delay = c_elements * ival->cdpe + f_elements * ival->fdpe;
231*4882a593Smuzhiyun c_elements = total_delay / ival->cdpe;
232*4882a593Smuzhiyun f_elements = (total_delay % ival->cdpe) / ival->fdpe;
233*4882a593Smuzhiyun }
234*4882a593Smuzhiyun
235*4882a593Smuzhiyun reg_mask = reg->signature_mask;
236*4882a593Smuzhiyun reg_val = reg->signature_value << __ffs(reg->signature_mask);
237*4882a593Smuzhiyun
238*4882a593Smuzhiyun reg_mask |= reg->binary_data_coarse_mask;
239*4882a593Smuzhiyun tmp_val = c_elements << __ffs(reg->binary_data_coarse_mask);
240*4882a593Smuzhiyun if (tmp_val & ~reg->binary_data_coarse_mask) {
241*4882a593Smuzhiyun dev_err(dev, "Masking overflow of coarse elements %08x\n",
242*4882a593Smuzhiyun tmp_val);
243*4882a593Smuzhiyun tmp_val &= reg->binary_data_coarse_mask;
244*4882a593Smuzhiyun }
245*4882a593Smuzhiyun reg_val |= tmp_val;
246*4882a593Smuzhiyun
247*4882a593Smuzhiyun reg_mask |= reg->binary_data_fine_mask;
248*4882a593Smuzhiyun tmp_val = f_elements << __ffs(reg->binary_data_fine_mask);
249*4882a593Smuzhiyun if (tmp_val & ~reg->binary_data_fine_mask) {
250*4882a593Smuzhiyun dev_err(dev, "Masking overflow of fine elements %08x\n",
251*4882a593Smuzhiyun tmp_val);
252*4882a593Smuzhiyun tmp_val &= reg->binary_data_fine_mask;
253*4882a593Smuzhiyun }
254*4882a593Smuzhiyun reg_val |= tmp_val;
255*4882a593Smuzhiyun
256*4882a593Smuzhiyun /*
257*4882a593Smuzhiyun * NOTE: we leave the iodelay values unlocked - this is to work around
258*4882a593Smuzhiyun * situations such as those found with mmc mode change.
259*4882a593Smuzhiyun * However, this leaves open any unwarranted changes to padconf register
260*4882a593Smuzhiyun * impacting iodelay configuration. Use with care!
261*4882a593Smuzhiyun */
262*4882a593Smuzhiyun reg_mask |= reg->lock_mask;
263*4882a593Smuzhiyun reg_val |= reg->unlock_val << __ffs(reg->lock_mask);
264*4882a593Smuzhiyun r = regmap_update_bits(iod->regmap, cfg->offset, reg_mask, reg_val);
265*4882a593Smuzhiyun
266*4882a593Smuzhiyun dev_dbg(dev, "Set reg 0x%x Delay(a: %d g: %d), Elements(C=%d F=%d)0x%x\n",
267*4882a593Smuzhiyun cfg->offset, cfg->a_delay, cfg->g_delay, c_elements,
268*4882a593Smuzhiyun f_elements, reg_val);
269*4882a593Smuzhiyun
270*4882a593Smuzhiyun return r;
271*4882a593Smuzhiyun }
272*4882a593Smuzhiyun
273*4882a593Smuzhiyun /**
274*4882a593Smuzhiyun * ti_iodelay_pinconf_init_dev() - Initialize IODelay device
275*4882a593Smuzhiyun * @iod: iodelay device
276*4882a593Smuzhiyun *
277*4882a593Smuzhiyun * Unlocks the iodelay region, computes the common parameters
278*4882a593Smuzhiyun *
279*4882a593Smuzhiyun * Return: 0 in case of success, else appropriate error value
280*4882a593Smuzhiyun */
ti_iodelay_pinconf_init_dev(struct ti_iodelay_device * iod)281*4882a593Smuzhiyun static int ti_iodelay_pinconf_init_dev(struct ti_iodelay_device *iod)
282*4882a593Smuzhiyun {
283*4882a593Smuzhiyun const struct ti_iodelay_reg_data *reg = iod->reg_data;
284*4882a593Smuzhiyun struct device *dev = iod->dev;
285*4882a593Smuzhiyun struct ti_iodelay_reg_values *ival = &iod->reg_init_conf_values;
286*4882a593Smuzhiyun u32 val;
287*4882a593Smuzhiyun int r;
288*4882a593Smuzhiyun
289*4882a593Smuzhiyun /* unlock the iodelay region */
290*4882a593Smuzhiyun r = regmap_update_bits(iod->regmap, reg->reg_global_lock_offset,
291*4882a593Smuzhiyun reg->global_lock_mask, reg->global_unlock_val);
292*4882a593Smuzhiyun if (r)
293*4882a593Smuzhiyun return r;
294*4882a593Smuzhiyun
295*4882a593Smuzhiyun /* Read up Recalibration sequence done by bootloader */
296*4882a593Smuzhiyun r = regmap_read(iod->regmap, reg->reg_refclk_offset, &val);
297*4882a593Smuzhiyun if (r)
298*4882a593Smuzhiyun return r;
299*4882a593Smuzhiyun ival->ref_clk_period = ti_iodelay_extract(val, reg->refclk_period_mask);
300*4882a593Smuzhiyun dev_dbg(dev, "refclk_period=0x%04x\n", ival->ref_clk_period);
301*4882a593Smuzhiyun
302*4882a593Smuzhiyun r = regmap_read(iod->regmap, reg->reg_coarse_offset, &val);
303*4882a593Smuzhiyun if (r)
304*4882a593Smuzhiyun return r;
305*4882a593Smuzhiyun ival->coarse_ref_count =
306*4882a593Smuzhiyun ti_iodelay_extract(val, reg->coarse_ref_count_mask);
307*4882a593Smuzhiyun ival->coarse_delay_count =
308*4882a593Smuzhiyun ti_iodelay_extract(val, reg->coarse_delay_count_mask);
309*4882a593Smuzhiyun if (!ival->coarse_delay_count) {
310*4882a593Smuzhiyun dev_err(dev, "Invalid Coarse delay count (0) (reg=0x%08x)\n",
311*4882a593Smuzhiyun val);
312*4882a593Smuzhiyun return -EINVAL;
313*4882a593Smuzhiyun }
314*4882a593Smuzhiyun ival->cdpe = ti_iodelay_compute_dpe(ival->ref_clk_period,
315*4882a593Smuzhiyun ival->coarse_ref_count,
316*4882a593Smuzhiyun ival->coarse_delay_count, 88);
317*4882a593Smuzhiyun if (!ival->cdpe) {
318*4882a593Smuzhiyun dev_err(dev, "Invalid cdpe computed params = %d %d %d\n",
319*4882a593Smuzhiyun ival->ref_clk_period, ival->coarse_ref_count,
320*4882a593Smuzhiyun ival->coarse_delay_count);
321*4882a593Smuzhiyun return -EINVAL;
322*4882a593Smuzhiyun }
323*4882a593Smuzhiyun dev_dbg(iod->dev, "coarse: ref=0x%04x delay=0x%04x cdpe=0x%08x\n",
324*4882a593Smuzhiyun ival->coarse_ref_count, ival->coarse_delay_count, ival->cdpe);
325*4882a593Smuzhiyun
326*4882a593Smuzhiyun r = regmap_read(iod->regmap, reg->reg_fine_offset, &val);
327*4882a593Smuzhiyun if (r)
328*4882a593Smuzhiyun return r;
329*4882a593Smuzhiyun ival->fine_ref_count =
330*4882a593Smuzhiyun ti_iodelay_extract(val, reg->fine_ref_count_mask);
331*4882a593Smuzhiyun ival->fine_delay_count =
332*4882a593Smuzhiyun ti_iodelay_extract(val, reg->fine_delay_count_mask);
333*4882a593Smuzhiyun if (!ival->fine_delay_count) {
334*4882a593Smuzhiyun dev_err(dev, "Invalid Fine delay count (0) (reg=0x%08x)\n",
335*4882a593Smuzhiyun val);
336*4882a593Smuzhiyun return -EINVAL;
337*4882a593Smuzhiyun }
338*4882a593Smuzhiyun ival->fdpe = ti_iodelay_compute_dpe(ival->ref_clk_period,
339*4882a593Smuzhiyun ival->fine_ref_count,
340*4882a593Smuzhiyun ival->fine_delay_count, 264);
341*4882a593Smuzhiyun if (!ival->fdpe) {
342*4882a593Smuzhiyun dev_err(dev, "Invalid fdpe(0) computed params = %d %d %d\n",
343*4882a593Smuzhiyun ival->ref_clk_period, ival->fine_ref_count,
344*4882a593Smuzhiyun ival->fine_delay_count);
345*4882a593Smuzhiyun return -EINVAL;
346*4882a593Smuzhiyun }
347*4882a593Smuzhiyun dev_dbg(iod->dev, "fine: ref=0x%04x delay=0x%04x fdpe=0x%08x\n",
348*4882a593Smuzhiyun ival->fine_ref_count, ival->fine_delay_count, ival->fdpe);
349*4882a593Smuzhiyun
350*4882a593Smuzhiyun return 0;
351*4882a593Smuzhiyun }
352*4882a593Smuzhiyun
353*4882a593Smuzhiyun /**
354*4882a593Smuzhiyun * ti_iodelay_pinconf_deinit_dev() - deinit the iodelay device
355*4882a593Smuzhiyun * @iod: IODelay device
356*4882a593Smuzhiyun *
357*4882a593Smuzhiyun * Deinitialize the IODelay device (basically just lock the region back up.
358*4882a593Smuzhiyun */
ti_iodelay_pinconf_deinit_dev(struct ti_iodelay_device * iod)359*4882a593Smuzhiyun static void ti_iodelay_pinconf_deinit_dev(struct ti_iodelay_device *iod)
360*4882a593Smuzhiyun {
361*4882a593Smuzhiyun const struct ti_iodelay_reg_data *reg = iod->reg_data;
362*4882a593Smuzhiyun
363*4882a593Smuzhiyun /* lock the iodelay region back again */
364*4882a593Smuzhiyun regmap_update_bits(iod->regmap, reg->reg_global_lock_offset,
365*4882a593Smuzhiyun reg->global_lock_mask, reg->global_lock_val);
366*4882a593Smuzhiyun }
367*4882a593Smuzhiyun
368*4882a593Smuzhiyun /**
369*4882a593Smuzhiyun * ti_iodelay_get_pingroup() - Find the group mapped by a group selector
370*4882a593Smuzhiyun * @iod: iodelay device
371*4882a593Smuzhiyun * @selector: Group Selector
372*4882a593Smuzhiyun *
373*4882a593Smuzhiyun * Return: Corresponding group representing group selector
374*4882a593Smuzhiyun */
375*4882a593Smuzhiyun static struct ti_iodelay_pingroup *
ti_iodelay_get_pingroup(struct ti_iodelay_device * iod,unsigned int selector)376*4882a593Smuzhiyun ti_iodelay_get_pingroup(struct ti_iodelay_device *iod, unsigned int selector)
377*4882a593Smuzhiyun {
378*4882a593Smuzhiyun struct group_desc *g;
379*4882a593Smuzhiyun
380*4882a593Smuzhiyun g = pinctrl_generic_get_group(iod->pctl, selector);
381*4882a593Smuzhiyun if (!g) {
382*4882a593Smuzhiyun dev_err(iod->dev, "%s could not find pingroup %i\n", __func__,
383*4882a593Smuzhiyun selector);
384*4882a593Smuzhiyun
385*4882a593Smuzhiyun return NULL;
386*4882a593Smuzhiyun }
387*4882a593Smuzhiyun
388*4882a593Smuzhiyun return g->data;
389*4882a593Smuzhiyun }
390*4882a593Smuzhiyun
391*4882a593Smuzhiyun /**
392*4882a593Smuzhiyun * ti_iodelay_offset_to_pin() - get a pin index based on the register offset
393*4882a593Smuzhiyun * @iod: iodelay driver instance
394*4882a593Smuzhiyun * @offset: register offset from the base
395*4882a593Smuzhiyun */
ti_iodelay_offset_to_pin(struct ti_iodelay_device * iod,unsigned int offset)396*4882a593Smuzhiyun static int ti_iodelay_offset_to_pin(struct ti_iodelay_device *iod,
397*4882a593Smuzhiyun unsigned int offset)
398*4882a593Smuzhiyun {
399*4882a593Smuzhiyun const struct ti_iodelay_reg_data *r = iod->reg_data;
400*4882a593Smuzhiyun unsigned int index;
401*4882a593Smuzhiyun
402*4882a593Smuzhiyun if (offset > r->regmap_config->max_register) {
403*4882a593Smuzhiyun dev_err(iod->dev, "mux offset out of range: 0x%x (0x%x)\n",
404*4882a593Smuzhiyun offset, r->regmap_config->max_register);
405*4882a593Smuzhiyun return -EINVAL;
406*4882a593Smuzhiyun }
407*4882a593Smuzhiyun
408*4882a593Smuzhiyun index = (offset - r->reg_start_offset) / r->regmap_config->reg_stride;
409*4882a593Smuzhiyun index /= r->reg_nr_per_pin;
410*4882a593Smuzhiyun
411*4882a593Smuzhiyun return index;
412*4882a593Smuzhiyun }
413*4882a593Smuzhiyun
414*4882a593Smuzhiyun /**
415*4882a593Smuzhiyun * ti_iodelay_node_iterator() - Iterate iodelay node
416*4882a593Smuzhiyun * @pctldev: Pin controller driver
417*4882a593Smuzhiyun * @np: Device node
418*4882a593Smuzhiyun * @pinctrl_spec: Parsed arguments from device tree
419*4882a593Smuzhiyun * @pins: Array of pins in the pin group
420*4882a593Smuzhiyun * @pin_index: Pin index in the pin array
421*4882a593Smuzhiyun * @data: Pin controller driver specific data
422*4882a593Smuzhiyun *
423*4882a593Smuzhiyun */
ti_iodelay_node_iterator(struct pinctrl_dev * pctldev,struct device_node * np,const struct of_phandle_args * pinctrl_spec,int * pins,int pin_index,void * data)424*4882a593Smuzhiyun static int ti_iodelay_node_iterator(struct pinctrl_dev *pctldev,
425*4882a593Smuzhiyun struct device_node *np,
426*4882a593Smuzhiyun const struct of_phandle_args *pinctrl_spec,
427*4882a593Smuzhiyun int *pins, int pin_index, void *data)
428*4882a593Smuzhiyun {
429*4882a593Smuzhiyun struct ti_iodelay_device *iod;
430*4882a593Smuzhiyun struct ti_iodelay_cfg *cfg = data;
431*4882a593Smuzhiyun const struct ti_iodelay_reg_data *r;
432*4882a593Smuzhiyun struct pinctrl_pin_desc *pd;
433*4882a593Smuzhiyun int pin;
434*4882a593Smuzhiyun
435*4882a593Smuzhiyun iod = pinctrl_dev_get_drvdata(pctldev);
436*4882a593Smuzhiyun if (!iod)
437*4882a593Smuzhiyun return -EINVAL;
438*4882a593Smuzhiyun
439*4882a593Smuzhiyun r = iod->reg_data;
440*4882a593Smuzhiyun
441*4882a593Smuzhiyun if (pinctrl_spec->args_count < r->reg_nr_per_pin) {
442*4882a593Smuzhiyun dev_err(iod->dev, "invalid args_count for spec: %i\n",
443*4882a593Smuzhiyun pinctrl_spec->args_count);
444*4882a593Smuzhiyun
445*4882a593Smuzhiyun return -EINVAL;
446*4882a593Smuzhiyun }
447*4882a593Smuzhiyun
448*4882a593Smuzhiyun /* Index plus two value cells */
449*4882a593Smuzhiyun cfg[pin_index].offset = pinctrl_spec->args[0];
450*4882a593Smuzhiyun cfg[pin_index].a_delay = pinctrl_spec->args[1] & 0xffff;
451*4882a593Smuzhiyun cfg[pin_index].g_delay = pinctrl_spec->args[2] & 0xffff;
452*4882a593Smuzhiyun
453*4882a593Smuzhiyun pin = ti_iodelay_offset_to_pin(iod, cfg[pin_index].offset);
454*4882a593Smuzhiyun if (pin < 0) {
455*4882a593Smuzhiyun dev_err(iod->dev, "could not add functions for %pOFn %ux\n",
456*4882a593Smuzhiyun np, cfg[pin_index].offset);
457*4882a593Smuzhiyun return -ENODEV;
458*4882a593Smuzhiyun }
459*4882a593Smuzhiyun pins[pin_index] = pin;
460*4882a593Smuzhiyun
461*4882a593Smuzhiyun pd = &iod->pa[pin];
462*4882a593Smuzhiyun pd->drv_data = &cfg[pin_index];
463*4882a593Smuzhiyun
464*4882a593Smuzhiyun dev_dbg(iod->dev, "%pOFn offset=%x a_delay = %d g_delay = %d\n",
465*4882a593Smuzhiyun np, cfg[pin_index].offset, cfg[pin_index].a_delay,
466*4882a593Smuzhiyun cfg[pin_index].g_delay);
467*4882a593Smuzhiyun
468*4882a593Smuzhiyun return 0;
469*4882a593Smuzhiyun }
470*4882a593Smuzhiyun
471*4882a593Smuzhiyun /**
472*4882a593Smuzhiyun * ti_iodelay_dt_node_to_map() - Map a device tree node to appropriate group
473*4882a593Smuzhiyun * @pctldev: pinctrl device representing IODelay device
474*4882a593Smuzhiyun * @np: Node Pointer (device tree)
475*4882a593Smuzhiyun * @map: Pinctrl Map returned back to pinctrl framework
476*4882a593Smuzhiyun * @num_maps: Number of maps (1)
477*4882a593Smuzhiyun *
478*4882a593Smuzhiyun * Maps the device tree description into a group of configuration parameters
479*4882a593Smuzhiyun * for iodelay block entry.
480*4882a593Smuzhiyun *
481*4882a593Smuzhiyun * Return: 0 in case of success, else appropriate error value
482*4882a593Smuzhiyun */
ti_iodelay_dt_node_to_map(struct pinctrl_dev * pctldev,struct device_node * np,struct pinctrl_map ** map,unsigned int * num_maps)483*4882a593Smuzhiyun static int ti_iodelay_dt_node_to_map(struct pinctrl_dev *pctldev,
484*4882a593Smuzhiyun struct device_node *np,
485*4882a593Smuzhiyun struct pinctrl_map **map,
486*4882a593Smuzhiyun unsigned int *num_maps)
487*4882a593Smuzhiyun {
488*4882a593Smuzhiyun struct ti_iodelay_device *iod;
489*4882a593Smuzhiyun struct ti_iodelay_cfg *cfg;
490*4882a593Smuzhiyun struct ti_iodelay_pingroup *g;
491*4882a593Smuzhiyun const char *name = "pinctrl-pin-array";
492*4882a593Smuzhiyun int rows, *pins, error = -EINVAL, i;
493*4882a593Smuzhiyun
494*4882a593Smuzhiyun iod = pinctrl_dev_get_drvdata(pctldev);
495*4882a593Smuzhiyun if (!iod)
496*4882a593Smuzhiyun return -EINVAL;
497*4882a593Smuzhiyun
498*4882a593Smuzhiyun rows = pinctrl_count_index_with_args(np, name);
499*4882a593Smuzhiyun if (rows < 0)
500*4882a593Smuzhiyun return rows;
501*4882a593Smuzhiyun
502*4882a593Smuzhiyun *map = devm_kzalloc(iod->dev, sizeof(**map), GFP_KERNEL);
503*4882a593Smuzhiyun if (!*map)
504*4882a593Smuzhiyun return -ENOMEM;
505*4882a593Smuzhiyun *num_maps = 0;
506*4882a593Smuzhiyun
507*4882a593Smuzhiyun g = devm_kzalloc(iod->dev, sizeof(*g), GFP_KERNEL);
508*4882a593Smuzhiyun if (!g) {
509*4882a593Smuzhiyun error = -ENOMEM;
510*4882a593Smuzhiyun goto free_map;
511*4882a593Smuzhiyun }
512*4882a593Smuzhiyun
513*4882a593Smuzhiyun pins = devm_kcalloc(iod->dev, rows, sizeof(*pins), GFP_KERNEL);
514*4882a593Smuzhiyun if (!pins)
515*4882a593Smuzhiyun goto free_group;
516*4882a593Smuzhiyun
517*4882a593Smuzhiyun cfg = devm_kcalloc(iod->dev, rows, sizeof(*cfg), GFP_KERNEL);
518*4882a593Smuzhiyun if (!cfg) {
519*4882a593Smuzhiyun error = -ENOMEM;
520*4882a593Smuzhiyun goto free_pins;
521*4882a593Smuzhiyun }
522*4882a593Smuzhiyun
523*4882a593Smuzhiyun for (i = 0; i < rows; i++) {
524*4882a593Smuzhiyun struct of_phandle_args pinctrl_spec;
525*4882a593Smuzhiyun
526*4882a593Smuzhiyun error = pinctrl_parse_index_with_args(np, name, i,
527*4882a593Smuzhiyun &pinctrl_spec);
528*4882a593Smuzhiyun if (error)
529*4882a593Smuzhiyun goto free_data;
530*4882a593Smuzhiyun
531*4882a593Smuzhiyun error = ti_iodelay_node_iterator(pctldev, np, &pinctrl_spec,
532*4882a593Smuzhiyun pins, i, cfg);
533*4882a593Smuzhiyun if (error)
534*4882a593Smuzhiyun goto free_data;
535*4882a593Smuzhiyun }
536*4882a593Smuzhiyun
537*4882a593Smuzhiyun g->cfg = cfg;
538*4882a593Smuzhiyun g->ncfg = i;
539*4882a593Smuzhiyun g->config = PIN_CONFIG_END;
540*4882a593Smuzhiyun
541*4882a593Smuzhiyun error = pinctrl_generic_add_group(iod->pctl, np->name, pins, i, g);
542*4882a593Smuzhiyun if (error < 0)
543*4882a593Smuzhiyun goto free_data;
544*4882a593Smuzhiyun
545*4882a593Smuzhiyun (*map)->type = PIN_MAP_TYPE_CONFIGS_GROUP;
546*4882a593Smuzhiyun (*map)->data.configs.group_or_pin = np->name;
547*4882a593Smuzhiyun (*map)->data.configs.configs = &g->config;
548*4882a593Smuzhiyun (*map)->data.configs.num_configs = 1;
549*4882a593Smuzhiyun *num_maps = 1;
550*4882a593Smuzhiyun
551*4882a593Smuzhiyun return 0;
552*4882a593Smuzhiyun
553*4882a593Smuzhiyun free_data:
554*4882a593Smuzhiyun devm_kfree(iod->dev, cfg);
555*4882a593Smuzhiyun free_pins:
556*4882a593Smuzhiyun devm_kfree(iod->dev, pins);
557*4882a593Smuzhiyun free_group:
558*4882a593Smuzhiyun devm_kfree(iod->dev, g);
559*4882a593Smuzhiyun free_map:
560*4882a593Smuzhiyun devm_kfree(iod->dev, *map);
561*4882a593Smuzhiyun
562*4882a593Smuzhiyun return error;
563*4882a593Smuzhiyun }
564*4882a593Smuzhiyun
565*4882a593Smuzhiyun /**
566*4882a593Smuzhiyun * ti_iodelay_pinconf_group_get() - Get the group configuration
567*4882a593Smuzhiyun * @pctldev: pinctrl device representing IODelay device
568*4882a593Smuzhiyun * @selector: Group selector
569*4882a593Smuzhiyun * @config: Configuration returned
570*4882a593Smuzhiyun *
571*4882a593Smuzhiyun * Return: The configuration if the group is valid, else returns -EINVAL
572*4882a593Smuzhiyun */
ti_iodelay_pinconf_group_get(struct pinctrl_dev * pctldev,unsigned int selector,unsigned long * config)573*4882a593Smuzhiyun static int ti_iodelay_pinconf_group_get(struct pinctrl_dev *pctldev,
574*4882a593Smuzhiyun unsigned int selector,
575*4882a593Smuzhiyun unsigned long *config)
576*4882a593Smuzhiyun {
577*4882a593Smuzhiyun struct ti_iodelay_device *iod;
578*4882a593Smuzhiyun struct ti_iodelay_pingroup *group;
579*4882a593Smuzhiyun
580*4882a593Smuzhiyun iod = pinctrl_dev_get_drvdata(pctldev);
581*4882a593Smuzhiyun group = ti_iodelay_get_pingroup(iod, selector);
582*4882a593Smuzhiyun
583*4882a593Smuzhiyun if (!group)
584*4882a593Smuzhiyun return -EINVAL;
585*4882a593Smuzhiyun
586*4882a593Smuzhiyun *config = group->config;
587*4882a593Smuzhiyun return 0;
588*4882a593Smuzhiyun }
589*4882a593Smuzhiyun
590*4882a593Smuzhiyun /**
591*4882a593Smuzhiyun * ti_iodelay_pinconf_group_set() - Configure the groups of pins
592*4882a593Smuzhiyun * @pctldev: pinctrl device representing IODelay device
593*4882a593Smuzhiyun * @selector: Group selector
594*4882a593Smuzhiyun * @configs: Configurations
595*4882a593Smuzhiyun * @num_configs: Number of configurations
596*4882a593Smuzhiyun *
597*4882a593Smuzhiyun * Return: 0 if all went fine, else appropriate error value.
598*4882a593Smuzhiyun */
ti_iodelay_pinconf_group_set(struct pinctrl_dev * pctldev,unsigned int selector,unsigned long * configs,unsigned int num_configs)599*4882a593Smuzhiyun static int ti_iodelay_pinconf_group_set(struct pinctrl_dev *pctldev,
600*4882a593Smuzhiyun unsigned int selector,
601*4882a593Smuzhiyun unsigned long *configs,
602*4882a593Smuzhiyun unsigned int num_configs)
603*4882a593Smuzhiyun {
604*4882a593Smuzhiyun struct ti_iodelay_device *iod;
605*4882a593Smuzhiyun struct device *dev;
606*4882a593Smuzhiyun struct ti_iodelay_pingroup *group;
607*4882a593Smuzhiyun int i;
608*4882a593Smuzhiyun
609*4882a593Smuzhiyun iod = pinctrl_dev_get_drvdata(pctldev);
610*4882a593Smuzhiyun dev = iod->dev;
611*4882a593Smuzhiyun group = ti_iodelay_get_pingroup(iod, selector);
612*4882a593Smuzhiyun
613*4882a593Smuzhiyun if (num_configs != 1) {
614*4882a593Smuzhiyun dev_err(dev, "Unsupported number of configurations %d\n",
615*4882a593Smuzhiyun num_configs);
616*4882a593Smuzhiyun return -EINVAL;
617*4882a593Smuzhiyun }
618*4882a593Smuzhiyun
619*4882a593Smuzhiyun if (*configs != PIN_CONFIG_END) {
620*4882a593Smuzhiyun dev_err(dev, "Unsupported configuration\n");
621*4882a593Smuzhiyun return -EINVAL;
622*4882a593Smuzhiyun }
623*4882a593Smuzhiyun
624*4882a593Smuzhiyun for (i = 0; i < group->ncfg; i++) {
625*4882a593Smuzhiyun if (ti_iodelay_pinconf_set(iod, &group->cfg[i]))
626*4882a593Smuzhiyun return -ENOTSUPP;
627*4882a593Smuzhiyun }
628*4882a593Smuzhiyun
629*4882a593Smuzhiyun return 0;
630*4882a593Smuzhiyun }
631*4882a593Smuzhiyun
632*4882a593Smuzhiyun #ifdef CONFIG_DEBUG_FS
633*4882a593Smuzhiyun /**
634*4882a593Smuzhiyun * ti_iodelay_pin_to_offset() - get pin register offset based on the pin index
635*4882a593Smuzhiyun * @iod: iodelay driver instance
636*4882a593Smuzhiyun * @selector: Pin index
637*4882a593Smuzhiyun */
ti_iodelay_pin_to_offset(struct ti_iodelay_device * iod,unsigned int selector)638*4882a593Smuzhiyun static unsigned int ti_iodelay_pin_to_offset(struct ti_iodelay_device *iod,
639*4882a593Smuzhiyun unsigned int selector)
640*4882a593Smuzhiyun {
641*4882a593Smuzhiyun const struct ti_iodelay_reg_data *r = iod->reg_data;
642*4882a593Smuzhiyun unsigned int offset;
643*4882a593Smuzhiyun
644*4882a593Smuzhiyun offset = selector * r->regmap_config->reg_stride;
645*4882a593Smuzhiyun offset *= r->reg_nr_per_pin;
646*4882a593Smuzhiyun offset += r->reg_start_offset;
647*4882a593Smuzhiyun
648*4882a593Smuzhiyun return offset;
649*4882a593Smuzhiyun }
650*4882a593Smuzhiyun
ti_iodelay_pin_dbg_show(struct pinctrl_dev * pctldev,struct seq_file * s,unsigned int pin)651*4882a593Smuzhiyun static void ti_iodelay_pin_dbg_show(struct pinctrl_dev *pctldev,
652*4882a593Smuzhiyun struct seq_file *s,
653*4882a593Smuzhiyun unsigned int pin)
654*4882a593Smuzhiyun {
655*4882a593Smuzhiyun struct ti_iodelay_device *iod;
656*4882a593Smuzhiyun struct pinctrl_pin_desc *pd;
657*4882a593Smuzhiyun struct ti_iodelay_cfg *cfg;
658*4882a593Smuzhiyun const struct ti_iodelay_reg_data *r;
659*4882a593Smuzhiyun unsigned long offset;
660*4882a593Smuzhiyun u32 in, oen, out;
661*4882a593Smuzhiyun
662*4882a593Smuzhiyun iod = pinctrl_dev_get_drvdata(pctldev);
663*4882a593Smuzhiyun r = iod->reg_data;
664*4882a593Smuzhiyun
665*4882a593Smuzhiyun offset = ti_iodelay_pin_to_offset(iod, pin);
666*4882a593Smuzhiyun pd = &iod->pa[pin];
667*4882a593Smuzhiyun cfg = pd->drv_data;
668*4882a593Smuzhiyun
669*4882a593Smuzhiyun regmap_read(iod->regmap, offset, &in);
670*4882a593Smuzhiyun regmap_read(iod->regmap, offset + r->regmap_config->reg_stride, &oen);
671*4882a593Smuzhiyun regmap_read(iod->regmap, offset + r->regmap_config->reg_stride * 2,
672*4882a593Smuzhiyun &out);
673*4882a593Smuzhiyun
674*4882a593Smuzhiyun seq_printf(s, "%lx a: %i g: %i (%08x %08x %08x) %s ",
675*4882a593Smuzhiyun iod->phys_base + offset,
676*4882a593Smuzhiyun cfg ? cfg->a_delay : -1,
677*4882a593Smuzhiyun cfg ? cfg->g_delay : -1,
678*4882a593Smuzhiyun in, oen, out, DRIVER_NAME);
679*4882a593Smuzhiyun }
680*4882a593Smuzhiyun
681*4882a593Smuzhiyun /**
682*4882a593Smuzhiyun * ti_iodelay_pinconf_group_dbg_show() - show the group information
683*4882a593Smuzhiyun * @pctldev: Show the group information
684*4882a593Smuzhiyun * @s: Sequence file
685*4882a593Smuzhiyun * @selector: Group selector
686*4882a593Smuzhiyun *
687*4882a593Smuzhiyun * Provide the configuration information of the selected group
688*4882a593Smuzhiyun */
ti_iodelay_pinconf_group_dbg_show(struct pinctrl_dev * pctldev,struct seq_file * s,unsigned int selector)689*4882a593Smuzhiyun static void ti_iodelay_pinconf_group_dbg_show(struct pinctrl_dev *pctldev,
690*4882a593Smuzhiyun struct seq_file *s,
691*4882a593Smuzhiyun unsigned int selector)
692*4882a593Smuzhiyun {
693*4882a593Smuzhiyun struct ti_iodelay_device *iod;
694*4882a593Smuzhiyun struct ti_iodelay_pingroup *group;
695*4882a593Smuzhiyun int i;
696*4882a593Smuzhiyun
697*4882a593Smuzhiyun iod = pinctrl_dev_get_drvdata(pctldev);
698*4882a593Smuzhiyun group = ti_iodelay_get_pingroup(iod, selector);
699*4882a593Smuzhiyun if (!group)
700*4882a593Smuzhiyun return;
701*4882a593Smuzhiyun
702*4882a593Smuzhiyun for (i = 0; i < group->ncfg; i++) {
703*4882a593Smuzhiyun struct ti_iodelay_cfg *cfg;
704*4882a593Smuzhiyun u32 reg = 0;
705*4882a593Smuzhiyun
706*4882a593Smuzhiyun cfg = &group->cfg[i];
707*4882a593Smuzhiyun regmap_read(iod->regmap, cfg->offset, ®),
708*4882a593Smuzhiyun seq_printf(s, "\n\t0x%08x = 0x%08x (%3d, %3d)",
709*4882a593Smuzhiyun cfg->offset, reg, cfg->a_delay,
710*4882a593Smuzhiyun cfg->g_delay);
711*4882a593Smuzhiyun }
712*4882a593Smuzhiyun }
713*4882a593Smuzhiyun #endif
714*4882a593Smuzhiyun
715*4882a593Smuzhiyun static const struct pinctrl_ops ti_iodelay_pinctrl_ops = {
716*4882a593Smuzhiyun .get_groups_count = pinctrl_generic_get_group_count,
717*4882a593Smuzhiyun .get_group_name = pinctrl_generic_get_group_name,
718*4882a593Smuzhiyun .get_group_pins = pinctrl_generic_get_group_pins,
719*4882a593Smuzhiyun #ifdef CONFIG_DEBUG_FS
720*4882a593Smuzhiyun .pin_dbg_show = ti_iodelay_pin_dbg_show,
721*4882a593Smuzhiyun #endif
722*4882a593Smuzhiyun .dt_node_to_map = ti_iodelay_dt_node_to_map,
723*4882a593Smuzhiyun };
724*4882a593Smuzhiyun
725*4882a593Smuzhiyun static const struct pinconf_ops ti_iodelay_pinctrl_pinconf_ops = {
726*4882a593Smuzhiyun .pin_config_group_get = ti_iodelay_pinconf_group_get,
727*4882a593Smuzhiyun .pin_config_group_set = ti_iodelay_pinconf_group_set,
728*4882a593Smuzhiyun #ifdef CONFIG_DEBUG_FS
729*4882a593Smuzhiyun .pin_config_group_dbg_show = ti_iodelay_pinconf_group_dbg_show,
730*4882a593Smuzhiyun #endif
731*4882a593Smuzhiyun };
732*4882a593Smuzhiyun
733*4882a593Smuzhiyun /**
734*4882a593Smuzhiyun * ti_iodelay_alloc_pins() - Allocate structures needed for pins for iodelay
735*4882a593Smuzhiyun * @dev: Device pointer
736*4882a593Smuzhiyun * @iod: iodelay device
737*4882a593Smuzhiyun * @base_phy: Base Physical Address
738*4882a593Smuzhiyun *
739*4882a593Smuzhiyun * Return: 0 if all went fine, else appropriate error value.
740*4882a593Smuzhiyun */
ti_iodelay_alloc_pins(struct device * dev,struct ti_iodelay_device * iod,u32 base_phy)741*4882a593Smuzhiyun static int ti_iodelay_alloc_pins(struct device *dev,
742*4882a593Smuzhiyun struct ti_iodelay_device *iod, u32 base_phy)
743*4882a593Smuzhiyun {
744*4882a593Smuzhiyun const struct ti_iodelay_reg_data *r = iod->reg_data;
745*4882a593Smuzhiyun struct pinctrl_pin_desc *pin;
746*4882a593Smuzhiyun u32 phy_reg;
747*4882a593Smuzhiyun int nr_pins, i;
748*4882a593Smuzhiyun
749*4882a593Smuzhiyun nr_pins = ti_iodelay_offset_to_pin(iod, r->regmap_config->max_register);
750*4882a593Smuzhiyun dev_dbg(dev, "Allocating %i pins\n", nr_pins);
751*4882a593Smuzhiyun
752*4882a593Smuzhiyun iod->pa = devm_kcalloc(dev, nr_pins, sizeof(*iod->pa), GFP_KERNEL);
753*4882a593Smuzhiyun if (!iod->pa)
754*4882a593Smuzhiyun return -ENOMEM;
755*4882a593Smuzhiyun
756*4882a593Smuzhiyun iod->desc.pins = iod->pa;
757*4882a593Smuzhiyun iod->desc.npins = nr_pins;
758*4882a593Smuzhiyun
759*4882a593Smuzhiyun phy_reg = r->reg_start_offset + base_phy;
760*4882a593Smuzhiyun
761*4882a593Smuzhiyun for (i = 0; i < nr_pins; i++, phy_reg += 4) {
762*4882a593Smuzhiyun pin = &iod->pa[i];
763*4882a593Smuzhiyun pin->number = i;
764*4882a593Smuzhiyun }
765*4882a593Smuzhiyun
766*4882a593Smuzhiyun return 0;
767*4882a593Smuzhiyun }
768*4882a593Smuzhiyun
769*4882a593Smuzhiyun static struct regmap_config dra7_iodelay_regmap_config = {
770*4882a593Smuzhiyun .reg_bits = 32,
771*4882a593Smuzhiyun .reg_stride = 4,
772*4882a593Smuzhiyun .val_bits = 32,
773*4882a593Smuzhiyun .max_register = 0xd1c,
774*4882a593Smuzhiyun };
775*4882a593Smuzhiyun
776*4882a593Smuzhiyun static struct ti_iodelay_reg_data dra7_iodelay_data = {
777*4882a593Smuzhiyun .signature_mask = 0x0003f000,
778*4882a593Smuzhiyun .signature_value = 0x29,
779*4882a593Smuzhiyun .lock_mask = 0x00000400,
780*4882a593Smuzhiyun .lock_val = 1,
781*4882a593Smuzhiyun .unlock_val = 0,
782*4882a593Smuzhiyun .binary_data_coarse_mask = 0x000003e0,
783*4882a593Smuzhiyun .binary_data_fine_mask = 0x0000001f,
784*4882a593Smuzhiyun
785*4882a593Smuzhiyun .reg_refclk_offset = 0x14,
786*4882a593Smuzhiyun .refclk_period_mask = 0xffff,
787*4882a593Smuzhiyun
788*4882a593Smuzhiyun .reg_coarse_offset = 0x18,
789*4882a593Smuzhiyun .coarse_delay_count_mask = 0xffff0000,
790*4882a593Smuzhiyun .coarse_ref_count_mask = 0x0000ffff,
791*4882a593Smuzhiyun
792*4882a593Smuzhiyun .reg_fine_offset = 0x1C,
793*4882a593Smuzhiyun .fine_delay_count_mask = 0xffff0000,
794*4882a593Smuzhiyun .fine_ref_count_mask = 0x0000ffff,
795*4882a593Smuzhiyun
796*4882a593Smuzhiyun .reg_global_lock_offset = 0x2c,
797*4882a593Smuzhiyun .global_lock_mask = 0x0000ffff,
798*4882a593Smuzhiyun .global_unlock_val = 0x0000aaaa,
799*4882a593Smuzhiyun .global_lock_val = 0x0000aaab,
800*4882a593Smuzhiyun
801*4882a593Smuzhiyun .reg_start_offset = 0x30,
802*4882a593Smuzhiyun .reg_nr_per_pin = 3,
803*4882a593Smuzhiyun .regmap_config = &dra7_iodelay_regmap_config,
804*4882a593Smuzhiyun };
805*4882a593Smuzhiyun
806*4882a593Smuzhiyun static const struct of_device_id ti_iodelay_of_match[] = {
807*4882a593Smuzhiyun {.compatible = "ti,dra7-iodelay", .data = &dra7_iodelay_data},
808*4882a593Smuzhiyun { /* Hopefully no more.. */ },
809*4882a593Smuzhiyun };
810*4882a593Smuzhiyun MODULE_DEVICE_TABLE(of, ti_iodelay_of_match);
811*4882a593Smuzhiyun
812*4882a593Smuzhiyun /**
813*4882a593Smuzhiyun * ti_iodelay_probe() - Standard probe
814*4882a593Smuzhiyun * @pdev: platform device
815*4882a593Smuzhiyun *
816*4882a593Smuzhiyun * Return: 0 if all went fine, else appropriate error value.
817*4882a593Smuzhiyun */
ti_iodelay_probe(struct platform_device * pdev)818*4882a593Smuzhiyun static int ti_iodelay_probe(struct platform_device *pdev)
819*4882a593Smuzhiyun {
820*4882a593Smuzhiyun struct device *dev = &pdev->dev;
821*4882a593Smuzhiyun struct device_node *np = of_node_get(dev->of_node);
822*4882a593Smuzhiyun const struct of_device_id *match;
823*4882a593Smuzhiyun struct resource *res;
824*4882a593Smuzhiyun struct ti_iodelay_device *iod;
825*4882a593Smuzhiyun int ret = 0;
826*4882a593Smuzhiyun
827*4882a593Smuzhiyun if (!np) {
828*4882a593Smuzhiyun ret = -EINVAL;
829*4882a593Smuzhiyun dev_err(dev, "No OF node\n");
830*4882a593Smuzhiyun goto exit_out;
831*4882a593Smuzhiyun }
832*4882a593Smuzhiyun
833*4882a593Smuzhiyun match = of_match_device(ti_iodelay_of_match, dev);
834*4882a593Smuzhiyun if (!match) {
835*4882a593Smuzhiyun ret = -EINVAL;
836*4882a593Smuzhiyun dev_err(dev, "No DATA match\n");
837*4882a593Smuzhiyun goto exit_out;
838*4882a593Smuzhiyun }
839*4882a593Smuzhiyun
840*4882a593Smuzhiyun iod = devm_kzalloc(dev, sizeof(*iod), GFP_KERNEL);
841*4882a593Smuzhiyun if (!iod) {
842*4882a593Smuzhiyun ret = -ENOMEM;
843*4882a593Smuzhiyun goto exit_out;
844*4882a593Smuzhiyun }
845*4882a593Smuzhiyun iod->dev = dev;
846*4882a593Smuzhiyun iod->reg_data = match->data;
847*4882a593Smuzhiyun
848*4882a593Smuzhiyun /* So far We can assume there is only 1 bank of registers */
849*4882a593Smuzhiyun res = platform_get_resource(pdev, IORESOURCE_MEM, 0);
850*4882a593Smuzhiyun if (!res) {
851*4882a593Smuzhiyun dev_err(dev, "Missing MEM resource\n");
852*4882a593Smuzhiyun ret = -ENODEV;
853*4882a593Smuzhiyun goto exit_out;
854*4882a593Smuzhiyun }
855*4882a593Smuzhiyun
856*4882a593Smuzhiyun iod->phys_base = res->start;
857*4882a593Smuzhiyun iod->reg_base = devm_ioremap_resource(dev, res);
858*4882a593Smuzhiyun if (IS_ERR(iod->reg_base)) {
859*4882a593Smuzhiyun ret = PTR_ERR(iod->reg_base);
860*4882a593Smuzhiyun goto exit_out;
861*4882a593Smuzhiyun }
862*4882a593Smuzhiyun
863*4882a593Smuzhiyun iod->regmap = devm_regmap_init_mmio(dev, iod->reg_base,
864*4882a593Smuzhiyun iod->reg_data->regmap_config);
865*4882a593Smuzhiyun if (IS_ERR(iod->regmap)) {
866*4882a593Smuzhiyun dev_err(dev, "Regmap MMIO init failed.\n");
867*4882a593Smuzhiyun ret = PTR_ERR(iod->regmap);
868*4882a593Smuzhiyun goto exit_out;
869*4882a593Smuzhiyun }
870*4882a593Smuzhiyun
871*4882a593Smuzhiyun if (ti_iodelay_pinconf_init_dev(iod))
872*4882a593Smuzhiyun goto exit_out;
873*4882a593Smuzhiyun
874*4882a593Smuzhiyun ret = ti_iodelay_alloc_pins(dev, iod, res->start);
875*4882a593Smuzhiyun if (ret)
876*4882a593Smuzhiyun goto exit_out;
877*4882a593Smuzhiyun
878*4882a593Smuzhiyun iod->desc.pctlops = &ti_iodelay_pinctrl_ops;
879*4882a593Smuzhiyun /* no pinmux ops - we are pinconf */
880*4882a593Smuzhiyun iod->desc.confops = &ti_iodelay_pinctrl_pinconf_ops;
881*4882a593Smuzhiyun iod->desc.name = dev_name(dev);
882*4882a593Smuzhiyun iod->desc.owner = THIS_MODULE;
883*4882a593Smuzhiyun
884*4882a593Smuzhiyun ret = pinctrl_register_and_init(&iod->desc, dev, iod, &iod->pctl);
885*4882a593Smuzhiyun if (ret) {
886*4882a593Smuzhiyun dev_err(dev, "Failed to register pinctrl\n");
887*4882a593Smuzhiyun goto exit_out;
888*4882a593Smuzhiyun }
889*4882a593Smuzhiyun
890*4882a593Smuzhiyun platform_set_drvdata(pdev, iod);
891*4882a593Smuzhiyun
892*4882a593Smuzhiyun return pinctrl_enable(iod->pctl);
893*4882a593Smuzhiyun
894*4882a593Smuzhiyun exit_out:
895*4882a593Smuzhiyun of_node_put(np);
896*4882a593Smuzhiyun return ret;
897*4882a593Smuzhiyun }
898*4882a593Smuzhiyun
899*4882a593Smuzhiyun /**
900*4882a593Smuzhiyun * ti_iodelay_remove() - standard remove
901*4882a593Smuzhiyun * @pdev: platform device
902*4882a593Smuzhiyun *
903*4882a593Smuzhiyun * Return: 0 if all went fine, else appropriate error value.
904*4882a593Smuzhiyun */
ti_iodelay_remove(struct platform_device * pdev)905*4882a593Smuzhiyun static int ti_iodelay_remove(struct platform_device *pdev)
906*4882a593Smuzhiyun {
907*4882a593Smuzhiyun struct ti_iodelay_device *iod = platform_get_drvdata(pdev);
908*4882a593Smuzhiyun
909*4882a593Smuzhiyun if (!iod)
910*4882a593Smuzhiyun return 0;
911*4882a593Smuzhiyun
912*4882a593Smuzhiyun if (iod->pctl)
913*4882a593Smuzhiyun pinctrl_unregister(iod->pctl);
914*4882a593Smuzhiyun
915*4882a593Smuzhiyun ti_iodelay_pinconf_deinit_dev(iod);
916*4882a593Smuzhiyun
917*4882a593Smuzhiyun /* Expect other allocations to be freed by devm */
918*4882a593Smuzhiyun
919*4882a593Smuzhiyun return 0;
920*4882a593Smuzhiyun }
921*4882a593Smuzhiyun
922*4882a593Smuzhiyun static struct platform_driver ti_iodelay_driver = {
923*4882a593Smuzhiyun .probe = ti_iodelay_probe,
924*4882a593Smuzhiyun .remove = ti_iodelay_remove,
925*4882a593Smuzhiyun .driver = {
926*4882a593Smuzhiyun .name = DRIVER_NAME,
927*4882a593Smuzhiyun .of_match_table = ti_iodelay_of_match,
928*4882a593Smuzhiyun },
929*4882a593Smuzhiyun };
930*4882a593Smuzhiyun module_platform_driver(ti_iodelay_driver);
931*4882a593Smuzhiyun
932*4882a593Smuzhiyun MODULE_AUTHOR("Texas Instruments, Inc.");
933*4882a593Smuzhiyun MODULE_DESCRIPTION("Pinconf driver for TI's IO Delay module");
934*4882a593Smuzhiyun MODULE_LICENSE("GPL v2");
935