blob: e661f3b36eaa0cdf992cde8f88d92644ff585c5e [file] [log] [blame]
Lee Jones6e877fe2014-07-09 12:41:12 +01001/*
2 * Copyright (C) 2014 STMicroelectronics – All Rights Reserved
3 *
4 * STMicroelectronics PHY driver MiPHY365 (for SoC STiH416).
5 *
6 * Authors: Alexandre Torgue <alexandre.torgue@st.com>
7 * Lee Jones <lee.jones@linaro.org>
8 *
9 * This program is free software; you can redistribute it and/or modify
10 * it under the terms of the GNU General Public License version 2, as
11 * published by the Free Software Foundation.
12 *
13 */
14
15#include <linux/platform_device.h>
16#include <linux/io.h>
17#include <linux/kernel.h>
18#include <linux/module.h>
19#include <linux/of.h>
20#include <linux/of_platform.h>
Lee Jones7ebdb522014-07-09 12:41:13 +010021#include <linux/of_address.h>
Lee Jones6e877fe2014-07-09 12:41:12 +010022#include <linux/clk.h>
23#include <linux/phy/phy.h>
24#include <linux/delay.h>
25#include <linux/mfd/syscon.h>
26#include <linux/regmap.h>
27
Peter Griffinfbea2302015-03-30 16:17:07 +010028#include <dt-bindings/phy/phy.h>
Lee Jones6e877fe2014-07-09 12:41:12 +010029
30#define HFC_TIMEOUT 100
31
Lee Jones7ebdb522014-07-09 12:41:13 +010032#define SYSCFG_SELECT_SATA_MASK BIT(1)
33#define SYSCFG_SELECT_SATA_POS 1
Lee Jones6e877fe2014-07-09 12:41:12 +010034
35/* MiPHY365x register definitions */
36#define RESET_REG 0x00
37#define RST_PLL BIT(1)
38#define RST_PLL_CAL BIT(2)
39#define RST_RX BIT(4)
40#define RST_MACRO BIT(7)
41
42#define STATUS_REG 0x01
43#define IDLL_RDY BIT(0)
44#define PLL_RDY BIT(1)
45#define DES_BIT_LOCK BIT(2)
46#define DES_SYMBOL_LOCK BIT(3)
47
48#define CTRL_REG 0x02
49#define TERM_EN BIT(0)
50#define PCI_EN BIT(2)
51#define DES_BIT_LOCK_EN BIT(3)
52#define TX_POL BIT(5)
53
54#define INT_CTRL_REG 0x03
55
56#define BOUNDARY1_REG 0x10
57#define SPDSEL_SEL BIT(0)
58
59#define BOUNDARY3_REG 0x12
60#define TX_SPDSEL_GEN1_VAL 0
61#define TX_SPDSEL_GEN2_VAL 0x01
62#define TX_SPDSEL_GEN3_VAL 0x02
63#define RX_SPDSEL_GEN1_VAL 0
64#define RX_SPDSEL_GEN2_VAL (0x01 << 3)
65#define RX_SPDSEL_GEN3_VAL (0x02 << 3)
66
67#define PCIE_REG 0x16
68
69#define BUF_SEL_REG 0x20
70#define CONF_GEN_SEL_GEN3 0x02
71#define CONF_GEN_SEL_GEN2 0x01
72#define PD_VDDTFILTER BIT(4)
73
74#define TXBUF1_REG 0x21
75#define SWING_VAL 0x04
76#define SWING_VAL_GEN1 0x03
77#define PREEMPH_VAL (0x3 << 5)
78
79#define TXBUF2_REG 0x22
80#define TXSLEW_VAL 0x2
81#define TXSLEW_VAL_GEN1 0x4
82
83#define RXBUF_OFFSET_CTRL_REG 0x23
84
85#define RXBUF_REG 0x25
86#define SDTHRES_VAL 0x01
87#define EQ_ON3 (0x03 << 4)
88#define EQ_ON1 (0x01 << 4)
89
90#define COMP_CTRL1_REG 0x40
91#define START_COMSR BIT(0)
92#define START_COMZC BIT(1)
93#define COMSR_DONE BIT(2)
94#define COMZC_DONE BIT(3)
95#define COMP_AUTO_LOAD BIT(4)
96
97#define COMP_CTRL2_REG 0x41
98#define COMP_2MHZ_RAT_GEN1 0x1e
99#define COMP_2MHZ_RAT 0xf
100
101#define COMP_CTRL3_REG 0x42
102#define COMSR_COMP_REF 0x33
103
104#define COMP_IDLL_REG 0x47
105#define COMZC_IDLL 0x2a
106
107#define PLL_CTRL1_REG 0x50
108#define PLL_START_CAL BIT(0)
109#define BUF_EN BIT(2)
110#define SYNCHRO_TX BIT(3)
111#define SSC_EN BIT(6)
112#define CONFIG_PLL BIT(7)
113
114#define PLL_CTRL2_REG 0x51
115#define BYPASS_PLL_CAL BIT(1)
116
117#define PLL_RAT_REG 0x52
118
119#define PLL_SSC_STEP_MSB_REG 0x56
120#define PLL_SSC_STEP_MSB_VAL 0x03
121
122#define PLL_SSC_STEP_LSB_REG 0x57
123#define PLL_SSC_STEP_LSB_VAL 0x63
124
125#define PLL_SSC_PER_MSB_REG 0x58
126#define PLL_SSC_PER_MSB_VAL 0
127
128#define PLL_SSC_PER_LSB_REG 0x59
129#define PLL_SSC_PER_LSB_VAL 0xf1
130
131#define IDLL_TEST_REG 0x72
132#define START_CLK_HF BIT(6)
133
134#define DES_BITLOCK_REG 0x86
135#define BIT_LOCK_LEVEL 0x01
136#define BIT_LOCK_CNT_512 (0x03 << 5)
137
Lee Jones6e877fe2014-07-09 12:41:12 +0100138struct miphy365x_phy {
139 struct phy *phy;
140 void __iomem *base;
Lee Jones7ebdb522014-07-09 12:41:13 +0100141 bool pcie_tx_pol_inv;
142 bool sata_tx_pol_inv;
143 u32 sata_gen;
Peter Griffin63139882015-01-07 15:04:07 +0000144 u32 ctrlreg;
Lee Jones6e877fe2014-07-09 12:41:12 +0100145 u8 type;
Lee Jones6e877fe2014-07-09 12:41:12 +0100146};
147
148struct miphy365x_dev {
149 struct device *dev;
150 struct regmap *regmap;
151 struct mutex miphy_mutex;
Lee Jones7ebdb522014-07-09 12:41:13 +0100152 struct miphy365x_phy **phys;
Axel Lin5bd568f2015-02-24 19:53:45 +0800153 int nphys;
Lee Jones6e877fe2014-07-09 12:41:12 +0100154};
155
156/*
157 * These values are represented in Device tree. They are considered to be ABI
158 * and although they can be extended any existing values must not change.
159 */
160enum miphy_sata_gen {
161 SATA_GEN1 = 1,
162 SATA_GEN2,
163 SATA_GEN3
164};
165
166static u8 rx_tx_spd[] = {
Lee Jonesa6cc1b92014-08-28 14:59:50 +0100167 0, /* GEN0 doesn't exist. */
Lee Jones6e877fe2014-07-09 12:41:12 +0100168 TX_SPDSEL_GEN1_VAL | RX_SPDSEL_GEN1_VAL,
169 TX_SPDSEL_GEN2_VAL | RX_SPDSEL_GEN2_VAL,
170 TX_SPDSEL_GEN3_VAL | RX_SPDSEL_GEN3_VAL
171};
172
173/*
174 * This function selects the system configuration,
175 * either two SATA, one SATA and one PCIe, or two PCIe lanes.
176 */
177static int miphy365x_set_path(struct miphy365x_phy *miphy_phy,
178 struct miphy365x_dev *miphy_dev)
179{
Peter Griffinfbea2302015-03-30 16:17:07 +0100180 bool sata = (miphy_phy->type == PHY_TYPE_SATA);
Lee Jones6e877fe2014-07-09 12:41:12 +0100181
Lee Jones7ebdb522014-07-09 12:41:13 +0100182 return regmap_update_bits(miphy_dev->regmap,
Peter Griffin63139882015-01-07 15:04:07 +0000183 miphy_phy->ctrlreg,
Lee Jones7ebdb522014-07-09 12:41:13 +0100184 SYSCFG_SELECT_SATA_MASK,
185 sata << SYSCFG_SELECT_SATA_POS);
Lee Jones6e877fe2014-07-09 12:41:12 +0100186}
187
188static int miphy365x_init_pcie_port(struct miphy365x_phy *miphy_phy,
189 struct miphy365x_dev *miphy_dev)
190{
191 u8 val;
192
193 if (miphy_phy->pcie_tx_pol_inv) {
194 /* Invert Tx polarity and clear pci_txdetect_pol bit */
195 val = TERM_EN | PCI_EN | DES_BIT_LOCK_EN | TX_POL;
196 writeb_relaxed(val, miphy_phy->base + CTRL_REG);
197 writeb_relaxed(0x00, miphy_phy->base + PCIE_REG);
198 }
199
200 return 0;
201}
202
203static inline int miphy365x_hfc_not_rdy(struct miphy365x_phy *miphy_phy,
204 struct miphy365x_dev *miphy_dev)
205{
206 unsigned long timeout = jiffies + msecs_to_jiffies(HFC_TIMEOUT);
207 u8 mask = IDLL_RDY | PLL_RDY;
208 u8 regval;
209
210 do {
211 regval = readb_relaxed(miphy_phy->base + STATUS_REG);
212 if (!(regval & mask))
213 return 0;
214
215 usleep_range(2000, 2500);
216 } while (time_before(jiffies, timeout));
217
218 dev_err(miphy_dev->dev, "HFC ready timeout!\n");
219 return -EBUSY;
220}
221
222static inline int miphy365x_rdy(struct miphy365x_phy *miphy_phy,
223 struct miphy365x_dev *miphy_dev)
224{
225 unsigned long timeout = jiffies + msecs_to_jiffies(HFC_TIMEOUT);
226 u8 mask = IDLL_RDY | PLL_RDY;
227 u8 regval;
228
229 do {
230 regval = readb_relaxed(miphy_phy->base + STATUS_REG);
231 if ((regval & mask) == mask)
232 return 0;
233
234 usleep_range(2000, 2500);
235 } while (time_before(jiffies, timeout));
236
237 dev_err(miphy_dev->dev, "PHY not ready timeout!\n");
238 return -EBUSY;
239}
240
241static inline void miphy365x_set_comp(struct miphy365x_phy *miphy_phy,
242 struct miphy365x_dev *miphy_dev)
243{
244 u8 val, mask;
245
Lee Jones7ebdb522014-07-09 12:41:13 +0100246 if (miphy_phy->sata_gen == SATA_GEN1)
Lee Jones6e877fe2014-07-09 12:41:12 +0100247 writeb_relaxed(COMP_2MHZ_RAT_GEN1,
248 miphy_phy->base + COMP_CTRL2_REG);
249 else
250 writeb_relaxed(COMP_2MHZ_RAT,
251 miphy_phy->base + COMP_CTRL2_REG);
252
Lee Jones7ebdb522014-07-09 12:41:13 +0100253 if (miphy_phy->sata_gen != SATA_GEN3) {
Lee Jones6e877fe2014-07-09 12:41:12 +0100254 writeb_relaxed(COMSR_COMP_REF,
255 miphy_phy->base + COMP_CTRL3_REG);
256 /*
257 * Force VCO current to value defined by address 0x5A
258 * and disable PCIe100Mref bit
259 * Enable auto load compensation for pll_i_bias
260 */
261 writeb_relaxed(BYPASS_PLL_CAL, miphy_phy->base + PLL_CTRL2_REG);
262 writeb_relaxed(COMZC_IDLL, miphy_phy->base + COMP_IDLL_REG);
263 }
264
265 /*
266 * Force restart compensation and enable auto load
267 * for Comzc_Tx, Comzc_Rx and Comsr on macro
268 */
269 val = START_COMSR | START_COMZC | COMP_AUTO_LOAD;
270 writeb_relaxed(val, miphy_phy->base + COMP_CTRL1_REG);
271
272 mask = COMSR_DONE | COMZC_DONE;
273 while ((readb_relaxed(miphy_phy->base + COMP_CTRL1_REG) & mask) != mask)
274 cpu_relax();
275}
276
277static inline void miphy365x_set_ssc(struct miphy365x_phy *miphy_phy,
278 struct miphy365x_dev *miphy_dev)
279{
280 u8 val;
281
282 /*
283 * SSC Settings. SSC will be enabled through Link
284 * SSC Ampl. = 0.4%
285 * SSC Freq = 31KHz
286 */
287 writeb_relaxed(PLL_SSC_STEP_MSB_VAL,
288 miphy_phy->base + PLL_SSC_STEP_MSB_REG);
289 writeb_relaxed(PLL_SSC_STEP_LSB_VAL,
290 miphy_phy->base + PLL_SSC_STEP_LSB_REG);
291 writeb_relaxed(PLL_SSC_PER_MSB_VAL,
292 miphy_phy->base + PLL_SSC_PER_MSB_REG);
293 writeb_relaxed(PLL_SSC_PER_LSB_VAL,
294 miphy_phy->base + PLL_SSC_PER_LSB_REG);
295
296 /* SSC Settings complete */
Lee Jones7ebdb522014-07-09 12:41:13 +0100297 if (miphy_phy->sata_gen == SATA_GEN1) {
Lee Jones6e877fe2014-07-09 12:41:12 +0100298 val = PLL_START_CAL | BUF_EN | SYNCHRO_TX | CONFIG_PLL;
299 writeb_relaxed(val, miphy_phy->base + PLL_CTRL1_REG);
300 } else {
301 val = SSC_EN | PLL_START_CAL | BUF_EN | SYNCHRO_TX | CONFIG_PLL;
302 writeb_relaxed(val, miphy_phy->base + PLL_CTRL1_REG);
303 }
304}
305
306static int miphy365x_init_sata_port(struct miphy365x_phy *miphy_phy,
307 struct miphy365x_dev *miphy_dev)
308{
309 int ret;
310 u8 val;
311
312 /*
313 * Force PHY macro reset, PLL calibration reset, PLL reset
314 * and assert Deserializer Reset
315 */
316 val = RST_PLL | RST_PLL_CAL | RST_RX | RST_MACRO;
317 writeb_relaxed(val, miphy_phy->base + RESET_REG);
318
Lee Jones7ebdb522014-07-09 12:41:13 +0100319 if (miphy_phy->sata_tx_pol_inv)
Lee Jones6e877fe2014-07-09 12:41:12 +0100320 writeb_relaxed(TX_POL, miphy_phy->base + CTRL_REG);
321
322 /*
323 * Force macro1 to use rx_lspd, tx_lspd
324 * Force Rx_Clock on first I-DLL phase
325 * Force Des in HP mode on macro, rx_lspd, tx_lspd for Gen2/3
326 */
327 writeb_relaxed(SPDSEL_SEL, miphy_phy->base + BOUNDARY1_REG);
328 writeb_relaxed(START_CLK_HF, miphy_phy->base + IDLL_TEST_REG);
Lee Jones7ebdb522014-07-09 12:41:13 +0100329 val = rx_tx_spd[miphy_phy->sata_gen];
Lee Jones6e877fe2014-07-09 12:41:12 +0100330 writeb_relaxed(val, miphy_phy->base + BOUNDARY3_REG);
331
332 /* Wait for HFC_READY = 0 */
333 ret = miphy365x_hfc_not_rdy(miphy_phy, miphy_dev);
334 if (ret)
335 return ret;
336
337 /* Compensation Recalibration */
338 miphy365x_set_comp(miphy_phy, miphy_dev);
339
Lee Jones7ebdb522014-07-09 12:41:13 +0100340 switch (miphy_phy->sata_gen) {
Lee Jones6e877fe2014-07-09 12:41:12 +0100341 case SATA_GEN3:
342 /*
343 * TX Swing target 550-600mv peak to peak diff
344 * Tx Slew target 90-110ps rising/falling time
345 * Rx Eq ON3, Sigdet threshold SDTH1
346 */
347 val = PD_VDDTFILTER | CONF_GEN_SEL_GEN3;
348 writeb_relaxed(val, miphy_phy->base + BUF_SEL_REG);
349 val = SWING_VAL | PREEMPH_VAL;
350 writeb_relaxed(val, miphy_phy->base + TXBUF1_REG);
351 writeb_relaxed(TXSLEW_VAL, miphy_phy->base + TXBUF2_REG);
352 writeb_relaxed(0x00, miphy_phy->base + RXBUF_OFFSET_CTRL_REG);
353 val = SDTHRES_VAL | EQ_ON3;
354 writeb_relaxed(val, miphy_phy->base + RXBUF_REG);
355 break;
356 case SATA_GEN2:
357 /*
358 * conf gen sel=0x1 to program Gen2 banked registers
359 * VDDT filter ON
360 * Tx Swing target 550-600mV peak-to-peak diff
361 * Tx Slew target 90-110 ps rising/falling time
362 * RX Equalization ON1, Sigdet threshold SDTH1
363 */
364 writeb_relaxed(CONF_GEN_SEL_GEN2,
365 miphy_phy->base + BUF_SEL_REG);
366 writeb_relaxed(SWING_VAL, miphy_phy->base + TXBUF1_REG);
367 writeb_relaxed(TXSLEW_VAL, miphy_phy->base + TXBUF2_REG);
368 val = SDTHRES_VAL | EQ_ON1;
369 writeb_relaxed(val, miphy_phy->base + RXBUF_REG);
370 break;
371 case SATA_GEN1:
372 /*
373 * conf gen sel = 00b to program Gen1 banked registers
374 * VDDT filter ON
375 * Tx Swing target 500-550mV peak-to-peak diff
376 * Tx Slew target120-140 ps rising/falling time
377 */
378 writeb_relaxed(PD_VDDTFILTER, miphy_phy->base + BUF_SEL_REG);
379 writeb_relaxed(SWING_VAL_GEN1, miphy_phy->base + TXBUF1_REG);
380 writeb_relaxed(TXSLEW_VAL_GEN1, miphy_phy->base + TXBUF2_REG);
381 break;
382 default:
383 break;
384 }
385
386 /* Force Macro1 in partial mode & release pll cal reset */
387 writeb_relaxed(RST_RX, miphy_phy->base + RESET_REG);
388 usleep_range(100, 150);
389
390 miphy365x_set_ssc(miphy_phy, miphy_dev);
391
392 /* Wait for phy_ready */
393 ret = miphy365x_rdy(miphy_phy, miphy_dev);
394 if (ret)
395 return ret;
396
397 /*
398 * Enable macro1 to use rx_lspd & tx_lspd
399 * Release Rx_Clock on first I-DLL phase on macro1
400 * Assert deserializer reset
401 * des_bit_lock_en is set
402 * bit lock detection strength
403 * Deassert deserializer reset
404 */
405 writeb_relaxed(0x00, miphy_phy->base + BOUNDARY1_REG);
406 writeb_relaxed(0x00, miphy_phy->base + IDLL_TEST_REG);
407 writeb_relaxed(RST_RX, miphy_phy->base + RESET_REG);
Lee Jones7ebdb522014-07-09 12:41:13 +0100408 val = miphy_phy->sata_tx_pol_inv ?
Lee Jones6e877fe2014-07-09 12:41:12 +0100409 (TX_POL | DES_BIT_LOCK_EN) : DES_BIT_LOCK_EN;
410 writeb_relaxed(val, miphy_phy->base + CTRL_REG);
411
412 val = BIT_LOCK_CNT_512 | BIT_LOCK_LEVEL;
413 writeb_relaxed(val, miphy_phy->base + DES_BITLOCK_REG);
414 writeb_relaxed(0x00, miphy_phy->base + RESET_REG);
415
416 return 0;
417}
418
419static int miphy365x_init(struct phy *phy)
420{
421 struct miphy365x_phy *miphy_phy = phy_get_drvdata(phy);
422 struct miphy365x_dev *miphy_dev = dev_get_drvdata(phy->dev.parent);
423 int ret = 0;
424
425 mutex_lock(&miphy_dev->miphy_mutex);
426
427 ret = miphy365x_set_path(miphy_phy, miphy_dev);
428 if (ret) {
429 mutex_unlock(&miphy_dev->miphy_mutex);
430 return ret;
431 }
432
433 /* Initialise Miphy for PCIe or SATA */
Peter Griffinfbea2302015-03-30 16:17:07 +0100434 if (miphy_phy->type == PHY_TYPE_PCIE)
Lee Jones6e877fe2014-07-09 12:41:12 +0100435 ret = miphy365x_init_pcie_port(miphy_phy, miphy_dev);
436 else
437 ret = miphy365x_init_sata_port(miphy_phy, miphy_dev);
438
439 mutex_unlock(&miphy_dev->miphy_mutex);
440
441 return ret;
442}
443
Felipe Balbi5bea4962015-05-08 11:30:49 -0500444static int miphy365x_get_addr(struct device *dev,
445 struct miphy365x_phy *miphy_phy, int index)
Lee Jones7ebdb522014-07-09 12:41:13 +0100446{
447 struct device_node *phynode = miphy_phy->phy->dev.of_node;
448 const char *name;
Lee Jones7ebdb522014-07-09 12:41:13 +0100449 int type = miphy_phy->type;
450 int ret;
451
452 ret = of_property_read_string_index(phynode, "reg-names", index, &name);
453 if (ret) {
454 dev_err(dev, "no reg-names property not found\n");
455 return ret;
456 }
457
Peter Griffinfbea2302015-03-30 16:17:07 +0100458 if (!((!strncmp(name, "sata", 4) && type == PHY_TYPE_SATA) ||
459 (!strncmp(name, "pcie", 4) && type == PHY_TYPE_PCIE)))
Lee Jones7ebdb522014-07-09 12:41:13 +0100460 return 0;
461
462 miphy_phy->base = of_iomap(phynode, index);
463 if (!miphy_phy->base) {
464 dev_err(dev, "Failed to map %s\n", phynode->full_name);
465 return -EINVAL;
466 }
467
468 return 0;
469}
470
Lee Jones6e877fe2014-07-09 12:41:12 +0100471static struct phy *miphy365x_xlate(struct device *dev,
472 struct of_phandle_args *args)
473{
Lee Jones7ebdb522014-07-09 12:41:13 +0100474 struct miphy365x_dev *miphy_dev = dev_get_drvdata(dev);
475 struct miphy365x_phy *miphy_phy = NULL;
476 struct device_node *phynode = args->np;
477 int ret, index;
Lee Jones6e877fe2014-07-09 12:41:12 +0100478
Lee Jones7ebdb522014-07-09 12:41:13 +0100479 if (args->args_count != 1) {
Lee Jones6e877fe2014-07-09 12:41:12 +0100480 dev_err(dev, "Invalid number of cells in 'phy' property\n");
481 return ERR_PTR(-EINVAL);
482 }
483
Axel Lin5bd568f2015-02-24 19:53:45 +0800484 for (index = 0; index < miphy_dev->nphys; index++)
Lee Jones7ebdb522014-07-09 12:41:13 +0100485 if (phynode == miphy_dev->phys[index]->phy->dev.of_node) {
486 miphy_phy = miphy_dev->phys[index];
487 break;
488 }
489
490 if (!miphy_phy) {
491 dev_err(dev, "Failed to find appropriate phy\n");
Lee Jones6e877fe2014-07-09 12:41:12 +0100492 return ERR_PTR(-EINVAL);
493 }
494
Lee Jones7ebdb522014-07-09 12:41:13 +0100495 miphy_phy->type = args->args[0];
Lee Jones6e877fe2014-07-09 12:41:12 +0100496
Peter Griffinfbea2302015-03-30 16:17:07 +0100497 if (!(miphy_phy->type == PHY_TYPE_SATA ||
498 miphy_phy->type == PHY_TYPE_PCIE)) {
Lee Jones7ebdb522014-07-09 12:41:13 +0100499 dev_err(dev, "Unsupported device type: %d\n", miphy_phy->type);
Lee Jones6e877fe2014-07-09 12:41:12 +0100500 return ERR_PTR(-EINVAL);
501 }
502
Lee Jones7ebdb522014-07-09 12:41:13 +0100503 /* Each port handles SATA and PCIE - third entry is always sysconf. */
504 for (index = 0; index < 3; index++) {
505 ret = miphy365x_get_addr(dev, miphy_phy, index);
506 if (ret < 0)
507 return ERR_PTR(ret);
508 }
Lee Jones6e877fe2014-07-09 12:41:12 +0100509
Lee Jones7ebdb522014-07-09 12:41:13 +0100510 return miphy_phy->phy;
Lee Jones6e877fe2014-07-09 12:41:12 +0100511}
512
Axel Lin4a9e5ca2015-07-15 15:33:51 +0800513static const struct phy_ops miphy365x_ops = {
Lee Jones6e877fe2014-07-09 12:41:12 +0100514 .init = miphy365x_init,
515 .owner = THIS_MODULE,
516};
517
Lee Jones7ebdb522014-07-09 12:41:13 +0100518static int miphy365x_of_probe(struct device_node *phynode,
519 struct miphy365x_phy *miphy_phy)
Lee Jones6e877fe2014-07-09 12:41:12 +0100520{
Lee Jones7ebdb522014-07-09 12:41:13 +0100521 of_property_read_u32(phynode, "st,sata-gen", &miphy_phy->sata_gen);
522 if (!miphy_phy->sata_gen)
523 miphy_phy->sata_gen = SATA_GEN1;
Lee Jones6e877fe2014-07-09 12:41:12 +0100524
Lee Jones7ebdb522014-07-09 12:41:13 +0100525 miphy_phy->pcie_tx_pol_inv =
526 of_property_read_bool(phynode, "st,pcie-tx-pol-inv");
Lee Jones6e877fe2014-07-09 12:41:12 +0100527
Lee Jones7ebdb522014-07-09 12:41:13 +0100528 miphy_phy->sata_tx_pol_inv =
529 of_property_read_bool(phynode, "st,sata-tx-pol-inv");
Lee Jones6e877fe2014-07-09 12:41:12 +0100530
531 return 0;
532}
533
534static int miphy365x_probe(struct platform_device *pdev)
535{
Lee Jones7ebdb522014-07-09 12:41:13 +0100536 struct device_node *child, *np = pdev->dev.of_node;
537 struct miphy365x_dev *miphy_dev;
Lee Jones6e877fe2014-07-09 12:41:12 +0100538 struct phy_provider *provider;
Lee Jones7ebdb522014-07-09 12:41:13 +0100539 struct phy *phy;
Axel Lin5bd568f2015-02-24 19:53:45 +0800540 int ret, port = 0;
Lee Jones6e877fe2014-07-09 12:41:12 +0100541
Lee Jones7ebdb522014-07-09 12:41:13 +0100542 miphy_dev = devm_kzalloc(&pdev->dev, sizeof(*miphy_dev), GFP_KERNEL);
543 if (!miphy_dev)
Lee Jones6e877fe2014-07-09 12:41:12 +0100544 return -ENOMEM;
545
Axel Lin5bd568f2015-02-24 19:53:45 +0800546 miphy_dev->nphys = of_get_child_count(np);
Axel Lind8d52942015-03-05 09:52:59 +0800547 miphy_dev->phys = devm_kcalloc(&pdev->dev, miphy_dev->nphys,
548 sizeof(*miphy_dev->phys), GFP_KERNEL);
Lee Jones7ebdb522014-07-09 12:41:13 +0100549 if (!miphy_dev->phys)
550 return -ENOMEM;
Lee Jones6e877fe2014-07-09 12:41:12 +0100551
Lee Jones7ebdb522014-07-09 12:41:13 +0100552 miphy_dev->regmap = syscon_regmap_lookup_by_phandle(np, "st,syscfg");
553 if (IS_ERR(miphy_dev->regmap)) {
554 dev_err(miphy_dev->dev, "No syscfg phandle specified\n");
555 return PTR_ERR(miphy_dev->regmap);
556 }
Lee Jones6e877fe2014-07-09 12:41:12 +0100557
Lee Jones7ebdb522014-07-09 12:41:13 +0100558 miphy_dev->dev = &pdev->dev;
Lee Jones6e877fe2014-07-09 12:41:12 +0100559
Lee Jones7ebdb522014-07-09 12:41:13 +0100560 dev_set_drvdata(&pdev->dev, miphy_dev);
Lee Jones6e877fe2014-07-09 12:41:12 +0100561
Lee Jones7ebdb522014-07-09 12:41:13 +0100562 mutex_init(&miphy_dev->miphy_mutex);
Lee Jones6e877fe2014-07-09 12:41:12 +0100563
Lee Jones7ebdb522014-07-09 12:41:13 +0100564 for_each_child_of_node(np, child) {
565 struct miphy365x_phy *miphy_phy;
566
567 miphy_phy = devm_kzalloc(&pdev->dev, sizeof(*miphy_phy),
568 GFP_KERNEL);
Julia Lawall39c2b962015-11-16 12:33:19 +0100569 if (!miphy_phy) {
570 ret = -ENOMEM;
571 goto put_child;
572 }
Lee Jones7ebdb522014-07-09 12:41:13 +0100573
574 miphy_dev->phys[port] = miphy_phy;
575
Heikki Krogerusdbc98632014-11-19 17:28:21 +0200576 phy = devm_phy_create(&pdev->dev, child, &miphy365x_ops);
Lee Jones6e877fe2014-07-09 12:41:12 +0100577 if (IS_ERR(phy)) {
Lee Jones7ebdb522014-07-09 12:41:13 +0100578 dev_err(&pdev->dev, "failed to create PHY\n");
Julia Lawall39c2b962015-11-16 12:33:19 +0100579 ret = PTR_ERR(phy);
580 goto put_child;
Lee Jones6e877fe2014-07-09 12:41:12 +0100581 }
582
Lee Jones7ebdb522014-07-09 12:41:13 +0100583 miphy_dev->phys[port]->phy = phy;
Lee Jones6e877fe2014-07-09 12:41:12 +0100584
Lee Jones7ebdb522014-07-09 12:41:13 +0100585 ret = miphy365x_of_probe(child, miphy_phy);
Lee Jones6e877fe2014-07-09 12:41:12 +0100586 if (ret)
Julia Lawall39c2b962015-11-16 12:33:19 +0100587 goto put_child;
Lee Jones6e877fe2014-07-09 12:41:12 +0100588
Lee Jones7ebdb522014-07-09 12:41:13 +0100589 phy_set_drvdata(phy, miphy_dev->phys[port]);
Peter Griffin63139882015-01-07 15:04:07 +0000590
Lee Jones7ebdb522014-07-09 12:41:13 +0100591 port++;
Peter Griffin63139882015-01-07 15:04:07 +0000592 /* sysconfig offsets are indexed from 1 */
593 ret = of_property_read_u32_index(np, "st,syscfg", port,
594 &miphy_phy->ctrlreg);
595 if (ret) {
596 dev_err(&pdev->dev, "No sysconfig offset found\n");
Julia Lawall39c2b962015-11-16 12:33:19 +0100597 goto put_child;
Peter Griffin63139882015-01-07 15:04:07 +0000598 }
Lee Jones6e877fe2014-07-09 12:41:12 +0100599 }
600
Lee Jones7ebdb522014-07-09 12:41:13 +0100601 provider = devm_of_phy_provider_register(&pdev->dev, miphy365x_xlate);
Gregory CLEMENTc1fc0052014-11-13 12:47:43 +0100602 return PTR_ERR_OR_ZERO(provider);
Julia Lawall39c2b962015-11-16 12:33:19 +0100603put_child:
604 of_node_put(child);
605 return ret;
Lee Jones6e877fe2014-07-09 12:41:12 +0100606}
607
608static const struct of_device_id miphy365x_of_match[] = {
609 { .compatible = "st,miphy365x-phy", },
610 { },
611};
612MODULE_DEVICE_TABLE(of, miphy365x_of_match);
613
614static struct platform_driver miphy365x_driver = {
615 .probe = miphy365x_probe,
616 .driver = {
617 .name = "miphy365x-phy",
Lee Jones6e877fe2014-07-09 12:41:12 +0100618 .of_match_table = miphy365x_of_match,
619 }
620};
621module_platform_driver(miphy365x_driver);
622
623MODULE_AUTHOR("Alexandre Torgue <alexandre.torgue@st.com>");
624MODULE_DESCRIPTION("STMicroelectronics miphy365x driver");
625MODULE_LICENSE("GPL v2");