1 // SPDX-License-Identifier: GPL-2.0
3 * Wrapper driver for SERDES used in J721E
5 * Copyright (C) 2019 Texas Instruments Incorporated - http://www.ti.com/
6 * Author: Kishon Vijay Abraham I <kishon@ti.com>
9 #include <dt-bindings/phy/phy.h>
10 #include <dt-bindings/phy/phy-ti.h>
11 #include <linux/slab.h>
12 #include <linux/clk.h>
13 #include <linux/clk-provider.h>
14 #include <linux/gpio.h>
15 #include <linux/gpio/consumer.h>
17 #include <linux/module.h>
18 #include <linux/mux/consumer.h>
19 #include <linux/of_address.h>
20 #include <linux/of_platform.h>
21 #include <linux/platform_device.h>
22 #include <linux/pm_runtime.h>
23 #include <linux/regmap.h>
24 #include <linux/reset-controller.h>
26 #define WIZ_SERDES_CTRL 0x404
27 #define WIZ_SERDES_TOP_CTRL 0x408
28 #define WIZ_SERDES_RST 0x40c
29 #define WIZ_SERDES_TYPEC 0x410
30 #define WIZ_LANECTL(n) (0x480 + (0x40 * (n)))
31 #define WIZ_LANEDIV(n) (0x484 + (0x40 * (n)))
33 #define WIZ_MAX_INPUT_CLOCKS 4
34 /* To include mux clocks, divider clocks and gate clocks */
35 #define WIZ_MAX_OUTPUT_CLOCKS 32
37 #define WIZ_MAX_LANES 4
38 #define WIZ_MUX_NUM_CLOCKS 3
39 #define WIZ_DIV_NUM_CLOCKS_16G 2
40 #define WIZ_DIV_NUM_CLOCKS_10G 1
42 #define WIZ_SERDES_TYPEC_LN10_SWAP BIT(30)
44 enum wiz_lane_standard_mode {
51 enum wiz_refclk_mux_sel {
57 enum wiz_refclk_div_sel {
62 enum wiz_clock_input {
69 static const struct reg_field por_en = REG_FIELD(WIZ_SERDES_CTRL, 31, 31);
70 static const struct reg_field phy_reset_n = REG_FIELD(WIZ_SERDES_RST, 31, 31);
71 static const struct reg_field phy_en_refclk = REG_FIELD(WIZ_SERDES_RST, 30, 30);
72 static const struct reg_field pll1_refclk_mux_sel =
73 REG_FIELD(WIZ_SERDES_RST, 29, 29);
74 static const struct reg_field pll0_refclk_mux_sel =
75 REG_FIELD(WIZ_SERDES_RST, 28, 28);
76 static const struct reg_field refclk_dig_sel_16g =
77 REG_FIELD(WIZ_SERDES_RST, 24, 25);
78 static const struct reg_field refclk_dig_sel_10g =
79 REG_FIELD(WIZ_SERDES_RST, 24, 24);
80 static const struct reg_field pma_cmn_refclk_int_mode =
81 REG_FIELD(WIZ_SERDES_TOP_CTRL, 28, 29);
82 static const struct reg_field pma_cmn_refclk_mode =
83 REG_FIELD(WIZ_SERDES_TOP_CTRL, 30, 31);
84 static const struct reg_field pma_cmn_refclk_dig_div =
85 REG_FIELD(WIZ_SERDES_TOP_CTRL, 26, 27);
86 static const struct reg_field pma_cmn_refclk1_dig_div =
87 REG_FIELD(WIZ_SERDES_TOP_CTRL, 24, 25);
88 static const char * const output_clk_names[] = {
89 [TI_WIZ_PLL0_REFCLK] = "pll0-refclk",
90 [TI_WIZ_PLL1_REFCLK] = "pll1-refclk",
91 [TI_WIZ_REFCLK_DIG] = "refclk-dig",
92 [TI_WIZ_PHY_EN_REFCLK] = "phy-en-refclk",
95 static const struct reg_field p_enable[WIZ_MAX_LANES] = {
96 REG_FIELD(WIZ_LANECTL(0), 30, 31),
97 REG_FIELD(WIZ_LANECTL(1), 30, 31),
98 REG_FIELD(WIZ_LANECTL(2), 30, 31),
99 REG_FIELD(WIZ_LANECTL(3), 30, 31),
102 enum p_enable { P_ENABLE = 2, P_ENABLE_FORCE = 1, P_ENABLE_DISABLE = 0 };
104 static const struct reg_field p_align[WIZ_MAX_LANES] = {
105 REG_FIELD(WIZ_LANECTL(0), 29, 29),
106 REG_FIELD(WIZ_LANECTL(1), 29, 29),
107 REG_FIELD(WIZ_LANECTL(2), 29, 29),
108 REG_FIELD(WIZ_LANECTL(3), 29, 29),
111 static const struct reg_field p_raw_auto_start[WIZ_MAX_LANES] = {
112 REG_FIELD(WIZ_LANECTL(0), 28, 28),
113 REG_FIELD(WIZ_LANECTL(1), 28, 28),
114 REG_FIELD(WIZ_LANECTL(2), 28, 28),
115 REG_FIELD(WIZ_LANECTL(3), 28, 28),
118 static const struct reg_field p_standard_mode[WIZ_MAX_LANES] = {
119 REG_FIELD(WIZ_LANECTL(0), 24, 25),
120 REG_FIELD(WIZ_LANECTL(1), 24, 25),
121 REG_FIELD(WIZ_LANECTL(2), 24, 25),
122 REG_FIELD(WIZ_LANECTL(3), 24, 25),
125 static const struct reg_field p0_fullrt_div[WIZ_MAX_LANES] = {
126 REG_FIELD(WIZ_LANECTL(0), 22, 23),
127 REG_FIELD(WIZ_LANECTL(1), 22, 23),
128 REG_FIELD(WIZ_LANECTL(2), 22, 23),
129 REG_FIELD(WIZ_LANECTL(3), 22, 23),
132 static const struct reg_field p_mac_div_sel0[WIZ_MAX_LANES] = {
133 REG_FIELD(WIZ_LANEDIV(0), 16, 22),
134 REG_FIELD(WIZ_LANEDIV(1), 16, 22),
135 REG_FIELD(WIZ_LANEDIV(2), 16, 22),
136 REG_FIELD(WIZ_LANEDIV(3), 16, 22),
139 static const struct reg_field p_mac_div_sel1[WIZ_MAX_LANES] = {
140 REG_FIELD(WIZ_LANEDIV(0), 0, 8),
141 REG_FIELD(WIZ_LANEDIV(1), 0, 8),
142 REG_FIELD(WIZ_LANEDIV(2), 0, 8),
143 REG_FIELD(WIZ_LANEDIV(3), 0, 8),
146 static const struct reg_field typec_ln10_swap =
147 REG_FIELD(WIZ_SERDES_TYPEC, 30, 30);
151 struct regmap_field *field;
153 struct clk_init_data clk_data;
156 #define to_wiz_clk_mux(_hw) container_of(_hw, struct wiz_clk_mux, hw)
158 struct wiz_clk_divider {
160 struct regmap_field *field;
161 const struct clk_div_table *table;
162 struct clk_init_data clk_data;
165 #define to_wiz_clk_div(_hw) container_of(_hw, struct wiz_clk_divider, hw)
167 struct wiz_clk_mux_sel {
168 u32 table[WIZ_MAX_INPUT_CLOCKS];
169 const char *node_name;
171 u32 parents[WIZ_MAX_INPUT_CLOCKS];
174 struct wiz_clk_div_sel {
175 const struct clk_div_table *table;
176 const char *node_name;
179 struct wiz_phy_en_refclk {
181 struct regmap_field *phy_en_refclk;
182 struct clk_init_data clk_data;
185 #define to_wiz_phy_en_refclk(_hw) container_of(_hw, struct wiz_phy_en_refclk, hw)
187 static const struct wiz_clk_mux_sel clk_mux_sel_16g[] = {
190 * Mux value to be configured for each of the input clocks
191 * in the order populated in device tree
194 .node_name = "pll0-refclk",
198 .node_name = "pll1-refclk",
201 .table = { 1, 3, 0, 2 },
202 .node_name = "refclk-dig",
206 static const struct wiz_clk_mux_sel clk_mux_sel_10g[] = {
209 * Mux value to be configured for each of the input clocks
210 * in the order populated in device tree
213 .parents = { WIZ_CORE_REFCLK, WIZ_EXT_REFCLK },
215 .node_name = "pll0-refclk",
219 .parents = { WIZ_CORE_REFCLK, WIZ_EXT_REFCLK },
221 .node_name = "pll1-refclk",
225 .parents = { WIZ_CORE_REFCLK, WIZ_EXT_REFCLK },
227 .node_name = "refclk-dig",
231 static const struct clk_div_table clk_div_table[] = {
232 { .val = 0, .div = 1, },
233 { .val = 1, .div = 2, },
234 { .val = 2, .div = 4, },
235 { .val = 3, .div = 8, },
238 static const struct wiz_clk_div_sel clk_div_sel[] = {
240 .table = clk_div_table,
241 .node_name = "cmn-refclk-dig-div",
244 .table = clk_div_table,
245 .node_name = "cmn-refclk1-dig-div",
255 #define WIZ_TYPEC_DIR_DEBOUNCE_MIN 100 /* ms */
256 #define WIZ_TYPEC_DIR_DEBOUNCE_MAX 1000
259 struct regmap *regmap;
261 const struct wiz_clk_mux_sel *clk_mux_sel;
262 const struct wiz_clk_div_sel *clk_div_sel;
263 unsigned int clk_div_sel_num;
264 struct regmap_field *por_en;
265 struct regmap_field *phy_reset_n;
266 struct regmap_field *phy_en_refclk;
267 struct regmap_field *p_enable[WIZ_MAX_LANES];
268 struct regmap_field *p_align[WIZ_MAX_LANES];
269 struct regmap_field *p_raw_auto_start[WIZ_MAX_LANES];
270 struct regmap_field *p_standard_mode[WIZ_MAX_LANES];
271 struct regmap_field *p_mac_div_sel0[WIZ_MAX_LANES];
272 struct regmap_field *p_mac_div_sel1[WIZ_MAX_LANES];
273 struct regmap_field *p0_fullrt_div[WIZ_MAX_LANES];
274 struct regmap_field *pma_cmn_refclk_int_mode;
275 struct regmap_field *pma_cmn_refclk_mode;
276 struct regmap_field *pma_cmn_refclk_dig_div;
277 struct regmap_field *pma_cmn_refclk1_dig_div;
278 struct regmap_field *mux_sel_field[WIZ_MUX_NUM_CLOCKS];
279 struct regmap_field *div_sel_field[WIZ_DIV_NUM_CLOCKS_16G];
280 struct regmap_field *typec_ln10_swap;
284 struct platform_device *serdes_pdev;
285 struct reset_controller_dev wiz_phy_reset_dev;
286 struct gpio_desc *gpio_typec_dir;
288 u32 lane_phy_type[WIZ_MAX_LANES];
289 struct clk *input_clks[WIZ_MAX_INPUT_CLOCKS];
290 struct clk *output_clks[WIZ_MAX_OUTPUT_CLOCKS];
291 struct clk_onecell_data clk_data;
294 static int wiz_reset(struct wiz *wiz)
298 ret = regmap_field_write(wiz->por_en, 0x1);
304 ret = regmap_field_write(wiz->por_en, 0x0);
311 static int wiz_p_mac_div_sel(struct wiz *wiz)
313 u32 num_lanes = wiz->num_lanes;
317 for (i = 0; i < num_lanes; i++) {
318 if (wiz->lane_phy_type[i] == PHY_TYPE_QSGMII) {
319 ret = regmap_field_write(wiz->p_mac_div_sel0[i], 1);
323 ret = regmap_field_write(wiz->p_mac_div_sel1[i], 2);
332 static int wiz_mode_select(struct wiz *wiz)
334 u32 num_lanes = wiz->num_lanes;
335 enum wiz_lane_standard_mode mode;
339 for (i = 0; i < num_lanes; i++) {
340 if (wiz->lane_phy_type[i] == PHY_TYPE_DP)
341 mode = LANE_MODE_GEN1;
342 else if (wiz->lane_phy_type[i] == PHY_TYPE_QSGMII)
343 mode = LANE_MODE_GEN2;
347 ret = regmap_field_write(wiz->p_standard_mode[i], mode);
355 static int wiz_init_raw_interface(struct wiz *wiz, bool enable)
357 u32 num_lanes = wiz->num_lanes;
361 for (i = 0; i < num_lanes; i++) {
362 ret = regmap_field_write(wiz->p_align[i], enable);
366 ret = regmap_field_write(wiz->p_raw_auto_start[i], enable);
374 static int wiz_init(struct wiz *wiz)
376 struct device *dev = wiz->dev;
379 ret = wiz_reset(wiz);
381 dev_err(dev, "WIZ reset failed\n");
385 ret = wiz_mode_select(wiz);
387 dev_err(dev, "WIZ mode select failed\n");
391 ret = wiz_p_mac_div_sel(wiz);
393 dev_err(dev, "Configuring P0 MAC DIV SEL failed\n");
397 ret = wiz_init_raw_interface(wiz, true);
399 dev_err(dev, "WIZ interface initialization failed\n");
406 static int wiz_regfield_init(struct wiz *wiz)
408 struct regmap *regmap = wiz->regmap;
409 int num_lanes = wiz->num_lanes;
410 struct device *dev = wiz->dev;
413 wiz->por_en = devm_regmap_field_alloc(dev, regmap, por_en);
414 if (IS_ERR(wiz->por_en)) {
415 dev_err(dev, "POR_EN reg field init failed\n");
416 return PTR_ERR(wiz->por_en);
419 wiz->phy_reset_n = devm_regmap_field_alloc(dev, regmap,
421 if (IS_ERR(wiz->phy_reset_n)) {
422 dev_err(dev, "PHY_RESET_N reg field init failed\n");
423 return PTR_ERR(wiz->phy_reset_n);
426 wiz->pma_cmn_refclk_int_mode =
427 devm_regmap_field_alloc(dev, regmap, pma_cmn_refclk_int_mode);
428 if (IS_ERR(wiz->pma_cmn_refclk_int_mode)) {
429 dev_err(dev, "PMA_CMN_REFCLK_INT_MODE reg field init failed\n");
430 return PTR_ERR(wiz->pma_cmn_refclk_int_mode);
433 wiz->pma_cmn_refclk_mode =
434 devm_regmap_field_alloc(dev, regmap, pma_cmn_refclk_mode);
435 if (IS_ERR(wiz->pma_cmn_refclk_mode)) {
436 dev_err(dev, "PMA_CMN_REFCLK_MODE reg field init failed\n");
437 return PTR_ERR(wiz->pma_cmn_refclk_mode);
440 wiz->div_sel_field[CMN_REFCLK_DIG_DIV] =
441 devm_regmap_field_alloc(dev, regmap, pma_cmn_refclk_dig_div);
442 if (IS_ERR(wiz->div_sel_field[CMN_REFCLK_DIG_DIV])) {
443 dev_err(dev, "PMA_CMN_REFCLK_DIG_DIV reg field init failed\n");
444 return PTR_ERR(wiz->div_sel_field[CMN_REFCLK_DIG_DIV]);
447 if (wiz->type == J721E_WIZ_16G) {
448 wiz->div_sel_field[CMN_REFCLK1_DIG_DIV] =
449 devm_regmap_field_alloc(dev, regmap,
450 pma_cmn_refclk1_dig_div);
451 if (IS_ERR(wiz->div_sel_field[CMN_REFCLK1_DIG_DIV])) {
452 dev_err(dev, "PMA_CMN_REFCLK1_DIG_DIV reg field init failed\n");
453 return PTR_ERR(wiz->div_sel_field[CMN_REFCLK1_DIG_DIV]);
457 wiz->mux_sel_field[PLL0_REFCLK] =
458 devm_regmap_field_alloc(dev, regmap, pll0_refclk_mux_sel);
459 if (IS_ERR(wiz->mux_sel_field[PLL0_REFCLK])) {
460 dev_err(dev, "PLL0_REFCLK_SEL reg field init failed\n");
461 return PTR_ERR(wiz->mux_sel_field[PLL0_REFCLK]);
464 wiz->mux_sel_field[PLL1_REFCLK] =
465 devm_regmap_field_alloc(dev, regmap, pll1_refclk_mux_sel);
466 if (IS_ERR(wiz->mux_sel_field[PLL1_REFCLK])) {
467 dev_err(dev, "PLL1_REFCLK_SEL reg field init failed\n");
468 return PTR_ERR(wiz->mux_sel_field[PLL1_REFCLK]);
471 if (wiz->type == J721E_WIZ_10G || wiz->type == AM64_WIZ_10G)
472 wiz->mux_sel_field[REFCLK_DIG] =
473 devm_regmap_field_alloc(dev, regmap,
476 wiz->mux_sel_field[REFCLK_DIG] =
477 devm_regmap_field_alloc(dev, regmap,
480 if (IS_ERR(wiz->mux_sel_field[REFCLK_DIG])) {
481 dev_err(dev, "REFCLK_DIG_SEL reg field init failed\n");
482 return PTR_ERR(wiz->mux_sel_field[REFCLK_DIG]);
485 for (i = 0; i < num_lanes; i++) {
486 wiz->p_enable[i] = devm_regmap_field_alloc(dev, regmap,
488 if (IS_ERR(wiz->p_enable[i])) {
489 dev_err(dev, "P%d_ENABLE reg field init failed\n", i);
490 return PTR_ERR(wiz->p_enable[i]);
493 wiz->p_align[i] = devm_regmap_field_alloc(dev, regmap,
495 if (IS_ERR(wiz->p_align[i])) {
496 dev_err(dev, "P%d_ALIGN reg field init failed\n", i);
497 return PTR_ERR(wiz->p_align[i]);
500 wiz->p_raw_auto_start[i] =
501 devm_regmap_field_alloc(dev, regmap, p_raw_auto_start[i]);
502 if (IS_ERR(wiz->p_raw_auto_start[i])) {
503 dev_err(dev, "P%d_RAW_AUTO_START reg field init fail\n",
505 return PTR_ERR(wiz->p_raw_auto_start[i]);
508 wiz->p_standard_mode[i] =
509 devm_regmap_field_alloc(dev, regmap, p_standard_mode[i]);
510 if (IS_ERR(wiz->p_standard_mode[i])) {
511 dev_err(dev, "P%d_STANDARD_MODE reg field init fail\n",
513 return PTR_ERR(wiz->p_standard_mode[i]);
516 wiz->p0_fullrt_div[i] = devm_regmap_field_alloc(dev, regmap, p0_fullrt_div[i]);
517 if (IS_ERR(wiz->p0_fullrt_div[i])) {
518 dev_err(dev, "P%d_FULLRT_DIV reg field init failed\n", i);
519 return PTR_ERR(wiz->p0_fullrt_div[i]);
522 wiz->p_mac_div_sel0[i] =
523 devm_regmap_field_alloc(dev, regmap, p_mac_div_sel0[i]);
524 if (IS_ERR(wiz->p_mac_div_sel0[i])) {
525 dev_err(dev, "P%d_MAC_DIV_SEL0 reg field init fail\n",
527 return PTR_ERR(wiz->p_mac_div_sel0[i]);
530 wiz->p_mac_div_sel1[i] =
531 devm_regmap_field_alloc(dev, regmap, p_mac_div_sel1[i]);
532 if (IS_ERR(wiz->p_mac_div_sel1[i])) {
533 dev_err(dev, "P%d_MAC_DIV_SEL1 reg field init fail\n",
535 return PTR_ERR(wiz->p_mac_div_sel1[i]);
539 wiz->typec_ln10_swap = devm_regmap_field_alloc(dev, regmap,
541 if (IS_ERR(wiz->typec_ln10_swap)) {
542 dev_err(dev, "LN10_SWAP reg field init failed\n");
543 return PTR_ERR(wiz->typec_ln10_swap);
546 wiz->phy_en_refclk = devm_regmap_field_alloc(dev, regmap, phy_en_refclk);
547 if (IS_ERR(wiz->phy_en_refclk)) {
548 dev_err(dev, "PHY_EN_REFCLK reg field init failed\n");
549 return PTR_ERR(wiz->phy_en_refclk);
555 static int wiz_phy_en_refclk_enable(struct clk_hw *hw)
557 struct wiz_phy_en_refclk *wiz_phy_en_refclk = to_wiz_phy_en_refclk(hw);
558 struct regmap_field *phy_en_refclk = wiz_phy_en_refclk->phy_en_refclk;
560 regmap_field_write(phy_en_refclk, 1);
565 static void wiz_phy_en_refclk_disable(struct clk_hw *hw)
567 struct wiz_phy_en_refclk *wiz_phy_en_refclk = to_wiz_phy_en_refclk(hw);
568 struct regmap_field *phy_en_refclk = wiz_phy_en_refclk->phy_en_refclk;
570 regmap_field_write(phy_en_refclk, 0);
573 static int wiz_phy_en_refclk_is_enabled(struct clk_hw *hw)
575 struct wiz_phy_en_refclk *wiz_phy_en_refclk = to_wiz_phy_en_refclk(hw);
576 struct regmap_field *phy_en_refclk = wiz_phy_en_refclk->phy_en_refclk;
579 regmap_field_read(phy_en_refclk, &val);
584 static const struct clk_ops wiz_phy_en_refclk_ops = {
585 .enable = wiz_phy_en_refclk_enable,
586 .disable = wiz_phy_en_refclk_disable,
587 .is_enabled = wiz_phy_en_refclk_is_enabled,
590 static int wiz_phy_en_refclk_register(struct wiz *wiz)
592 struct wiz_phy_en_refclk *wiz_phy_en_refclk;
593 struct device *dev = wiz->dev;
594 struct clk_init_data *init;
597 wiz_phy_en_refclk = devm_kzalloc(dev, sizeof(*wiz_phy_en_refclk), GFP_KERNEL);
598 if (!wiz_phy_en_refclk)
601 init = &wiz_phy_en_refclk->clk_data;
603 init->ops = &wiz_phy_en_refclk_ops;
605 init->name = output_clk_names[TI_WIZ_PHY_EN_REFCLK];
607 wiz_phy_en_refclk->phy_en_refclk = wiz->phy_en_refclk;
608 wiz_phy_en_refclk->hw.init = init;
610 clk = devm_clk_register(dev, &wiz_phy_en_refclk->hw);
614 wiz->output_clks[TI_WIZ_PHY_EN_REFCLK] = clk;
619 static u8 wiz_clk_mux_get_parent(struct clk_hw *hw)
621 struct wiz_clk_mux *mux = to_wiz_clk_mux(hw);
622 struct regmap_field *field = mux->field;
625 regmap_field_read(field, &val);
626 return clk_mux_val_to_index(hw, (u32 *)mux->table, 0, val);
629 static int wiz_clk_mux_set_parent(struct clk_hw *hw, u8 index)
631 struct wiz_clk_mux *mux = to_wiz_clk_mux(hw);
632 struct regmap_field *field = mux->field;
635 val = mux->table[index];
636 return regmap_field_write(field, val);
639 static const struct clk_ops wiz_clk_mux_ops = {
640 .set_parent = wiz_clk_mux_set_parent,
641 .get_parent = wiz_clk_mux_get_parent,
644 static int wiz_mux_clk_register(struct wiz *wiz, struct regmap_field *field,
645 const struct wiz_clk_mux_sel *mux_sel, int clk_index)
647 struct device *dev = wiz->dev;
648 struct clk_init_data *init;
649 const char **parent_names;
650 unsigned int num_parents;
651 struct wiz_clk_mux *mux;
656 mux = devm_kzalloc(dev, sizeof(*mux), GFP_KERNEL);
660 num_parents = mux_sel->num_parents;
662 parent_names = kzalloc((sizeof(char *) * num_parents), GFP_KERNEL);
666 for (i = 0; i < num_parents; i++) {
667 clk = wiz->input_clks[mux_sel->parents[i]];
668 if (IS_ERR_OR_NULL(clk)) {
669 dev_err(dev, "Failed to get parent clk for %s\n",
670 output_clk_names[clk_index]);
674 parent_names[i] = __clk_get_name(clk);
677 snprintf(clk_name, sizeof(clk_name), "%s_%s", dev_name(dev), output_clk_names[clk_index]);
679 init = &mux->clk_data;
681 init->ops = &wiz_clk_mux_ops;
682 init->flags = CLK_SET_RATE_NO_REPARENT;
683 init->parent_names = parent_names;
684 init->num_parents = num_parents;
685 init->name = clk_name;
688 mux->table = mux_sel->table;
691 clk = devm_clk_register(dev, &mux->hw);
697 wiz->output_clks[clk_index] = clk;
705 static int wiz_mux_of_clk_register(struct wiz *wiz, struct device_node *node,
706 struct regmap_field *field, const u32 *table)
708 struct device *dev = wiz->dev;
709 struct clk_init_data *init;
710 const char **parent_names;
711 unsigned int num_parents;
712 struct wiz_clk_mux *mux;
717 mux = devm_kzalloc(dev, sizeof(*mux), GFP_KERNEL);
721 num_parents = of_clk_get_parent_count(node);
722 if (num_parents < 2) {
723 dev_err(dev, "SERDES clock must have parents\n");
727 parent_names = devm_kzalloc(dev, (sizeof(char *) * num_parents),
732 of_clk_parent_fill(node, parent_names, num_parents);
734 snprintf(clk_name, sizeof(clk_name), "%s_%s", dev_name(dev),
737 init = &mux->clk_data;
739 init->ops = &wiz_clk_mux_ops;
740 init->flags = CLK_SET_RATE_NO_REPARENT;
741 init->parent_names = parent_names;
742 init->num_parents = num_parents;
743 init->name = clk_name;
749 clk = devm_clk_register(dev, &mux->hw);
753 ret = of_clk_add_provider(node, of_clk_src_simple_get, clk);
755 dev_err(dev, "Failed to add clock provider: %s\n", clk_name);
760 static unsigned long wiz_clk_div_recalc_rate(struct clk_hw *hw,
761 unsigned long parent_rate)
763 struct wiz_clk_divider *div = to_wiz_clk_div(hw);
764 struct regmap_field *field = div->field;
767 regmap_field_read(field, &val);
769 return divider_recalc_rate(hw, parent_rate, val, div->table, 0x0, 2);
772 static long wiz_clk_div_round_rate(struct clk_hw *hw, unsigned long rate,
773 unsigned long *prate)
775 struct wiz_clk_divider *div = to_wiz_clk_div(hw);
777 return divider_round_rate(hw, rate, prate, div->table, 2, 0x0);
780 static int wiz_clk_div_set_rate(struct clk_hw *hw, unsigned long rate,
781 unsigned long parent_rate)
783 struct wiz_clk_divider *div = to_wiz_clk_div(hw);
784 struct regmap_field *field = div->field;
787 val = divider_get_val(rate, parent_rate, div->table, 2, 0x0);
791 return regmap_field_write(field, val);
794 static const struct clk_ops wiz_clk_div_ops = {
795 .recalc_rate = wiz_clk_div_recalc_rate,
796 .round_rate = wiz_clk_div_round_rate,
797 .set_rate = wiz_clk_div_set_rate,
800 static int wiz_div_clk_register(struct wiz *wiz, struct device_node *node,
801 struct regmap_field *field,
802 const struct clk_div_table *table)
804 struct device *dev = wiz->dev;
805 struct wiz_clk_divider *div;
806 struct clk_init_data *init;
807 const char **parent_names;
812 div = devm_kzalloc(dev, sizeof(*div), GFP_KERNEL);
816 snprintf(clk_name, sizeof(clk_name), "%s_%s", dev_name(dev),
819 parent_names = devm_kzalloc(dev, sizeof(char *), GFP_KERNEL);
823 of_clk_parent_fill(node, parent_names, 1);
825 init = &div->clk_data;
827 init->ops = &wiz_clk_div_ops;
829 init->parent_names = parent_names;
830 init->num_parents = 1;
831 init->name = clk_name;
837 clk = devm_clk_register(dev, &div->hw);
841 ret = of_clk_add_provider(node, of_clk_src_simple_get, clk);
843 dev_err(dev, "Failed to add clock provider: %s\n", clk_name);
848 static void wiz_clock_cleanup(struct wiz *wiz, struct device_node *node)
850 const struct wiz_clk_mux_sel *clk_mux_sel = wiz->clk_mux_sel;
851 struct device *dev = wiz->dev;
852 struct device_node *clk_node;
855 if (wiz->type == AM64_WIZ_10G) {
856 of_clk_del_provider(dev->of_node);
860 for (i = 0; i < WIZ_MUX_NUM_CLOCKS; i++) {
861 clk_node = of_get_child_by_name(node, clk_mux_sel[i].node_name);
862 of_clk_del_provider(clk_node);
863 of_node_put(clk_node);
866 for (i = 0; i < wiz->clk_div_sel_num; i++) {
867 clk_node = of_get_child_by_name(node, clk_div_sel[i].node_name);
868 of_clk_del_provider(clk_node);
869 of_node_put(clk_node);
872 of_clk_del_provider(wiz->dev->of_node);
875 static int wiz_clock_register(struct wiz *wiz)
877 const struct wiz_clk_mux_sel *clk_mux_sel = wiz->clk_mux_sel;
878 struct device *dev = wiz->dev;
879 struct device_node *node = dev->of_node;
884 if (wiz->type != AM64_WIZ_10G)
887 clk_index = TI_WIZ_PLL0_REFCLK;
888 for (i = 0; i < WIZ_MUX_NUM_CLOCKS; i++, clk_index++) {
889 ret = wiz_mux_clk_register(wiz, wiz->mux_sel_field[i], &clk_mux_sel[i], clk_index);
891 dev_err(dev, "Failed to register clk: %s\n", output_clk_names[clk_index]);
896 ret = wiz_phy_en_refclk_register(wiz);
898 dev_err(dev, "Failed to add phy-en-refclk\n");
902 wiz->clk_data.clks = wiz->output_clks;
903 wiz->clk_data.clk_num = WIZ_MAX_OUTPUT_CLOCKS;
904 ret = of_clk_add_provider(node, of_clk_src_onecell_get, &wiz->clk_data);
906 dev_err(dev, "Failed to add clock provider: %s\n", node->name);
911 static int wiz_clock_init(struct wiz *wiz, struct device_node *node)
913 const struct wiz_clk_mux_sel *clk_mux_sel = wiz->clk_mux_sel;
914 struct device *dev = wiz->dev;
915 struct device_node *clk_node;
916 const char *node_name;
922 clk = devm_clk_get(dev, "core_ref_clk");
924 dev_err(dev, "core_ref_clk clock not found\n");
928 wiz->input_clks[WIZ_CORE_REFCLK] = clk;
930 rate = clk_get_rate(clk);
931 if (rate >= 100000000)
932 regmap_field_write(wiz->pma_cmn_refclk_int_mode, 0x1);
934 regmap_field_write(wiz->pma_cmn_refclk_int_mode, 0x3);
936 clk = devm_clk_get(dev, "ext_ref_clk");
938 dev_err(dev, "ext_ref_clk clock not found\n");
942 wiz->input_clks[WIZ_EXT_REFCLK] = clk;
944 rate = clk_get_rate(clk);
945 if (rate >= 100000000)
946 regmap_field_write(wiz->pma_cmn_refclk_mode, 0x0);
948 regmap_field_write(wiz->pma_cmn_refclk_mode, 0x2);
950 if (wiz->type == AM64_WIZ_10G) {
951 ret = wiz_clock_register(wiz);
953 dev_err(dev, "Failed to register wiz clocks\n");
957 for (i = 0; i < WIZ_MUX_NUM_CLOCKS; i++) {
958 node_name = clk_mux_sel[i].node_name;
959 clk_node = of_get_child_by_name(node, node_name);
961 dev_err(dev, "Unable to get %s node\n", node_name);
966 ret = wiz_mux_of_clk_register(wiz, clk_node, wiz->mux_sel_field[i],
967 clk_mux_sel[i].table);
969 dev_err(dev, "Failed to register %s clock\n",
971 of_node_put(clk_node);
975 of_node_put(clk_node);
978 for (i = 0; i < wiz->clk_div_sel_num; i++) {
979 node_name = clk_div_sel[i].node_name;
980 clk_node = of_get_child_by_name(node, node_name);
982 dev_err(dev, "Unable to get %s node\n", node_name);
987 ret = wiz_div_clk_register(wiz, clk_node, wiz->div_sel_field[i],
988 clk_div_sel[i].table);
990 dev_err(dev, "Failed to register %s clock\n",
992 of_node_put(clk_node);
996 of_node_put(clk_node);
1001 wiz_clock_cleanup(wiz, node);
1006 static int wiz_phy_reset_assert(struct reset_controller_dev *rcdev,
1009 struct device *dev = rcdev->dev;
1010 struct wiz *wiz = dev_get_drvdata(dev);
1014 ret = regmap_field_write(wiz->phy_reset_n, false);
1018 ret = regmap_field_write(wiz->p_enable[id - 1], P_ENABLE_DISABLE);
1022 static int wiz_phy_fullrt_div(struct wiz *wiz, int lane)
1024 if (wiz->type != AM64_WIZ_10G)
1027 if (wiz->lane_phy_type[lane] == PHY_TYPE_PCIE)
1028 return regmap_field_write(wiz->p0_fullrt_div[lane], 0x1);
1033 static int wiz_phy_reset_deassert(struct reset_controller_dev *rcdev,
1036 struct device *dev = rcdev->dev;
1037 struct wiz *wiz = dev_get_drvdata(dev);
1040 /* if typec-dir gpio was specified, set LN10 SWAP bit based on that */
1041 if (id == 0 && wiz->gpio_typec_dir) {
1042 if (wiz->typec_dir_delay)
1043 msleep_interruptible(wiz->typec_dir_delay);
1045 if (gpiod_get_value_cansleep(wiz->gpio_typec_dir))
1046 regmap_field_write(wiz->typec_ln10_swap, 1);
1048 regmap_field_write(wiz->typec_ln10_swap, 0);
1052 ret = regmap_field_write(wiz->phy_reset_n, true);
1056 ret = wiz_phy_fullrt_div(wiz, id - 1);
1060 if (wiz->lane_phy_type[id - 1] == PHY_TYPE_DP)
1061 ret = regmap_field_write(wiz->p_enable[id - 1], P_ENABLE);
1063 ret = regmap_field_write(wiz->p_enable[id - 1], P_ENABLE_FORCE);
1068 static const struct reset_control_ops wiz_phy_reset_ops = {
1069 .assert = wiz_phy_reset_assert,
1070 .deassert = wiz_phy_reset_deassert,
1073 static const struct regmap_config wiz_regmap_config = {
1080 static const struct of_device_id wiz_id_table[] = {
1082 .compatible = "ti,j721e-wiz-16g", .data = (void *)J721E_WIZ_16G
1085 .compatible = "ti,j721e-wiz-10g", .data = (void *)J721E_WIZ_10G
1088 .compatible = "ti,am64-wiz-10g", .data = (void *)AM64_WIZ_10G
1092 MODULE_DEVICE_TABLE(of, wiz_id_table);
1094 static int wiz_get_lane_phy_types(struct device *dev, struct wiz *wiz)
1096 struct device_node *serdes, *subnode;
1098 serdes = of_get_child_by_name(dev->of_node, "serdes");
1100 dev_err(dev, "%s: Getting \"serdes\"-node failed\n", __func__);
1104 for_each_child_of_node(serdes, subnode) {
1105 u32 reg, num_lanes = 1, phy_type = PHY_NONE;
1108 if (!(of_node_name_eq(subnode, "phy") ||
1109 of_node_name_eq(subnode, "link")))
1112 ret = of_property_read_u32(subnode, "reg", ®);
1114 of_node_put(subnode);
1116 "%s: Reading \"reg\" from \"%s\" failed: %d\n",
1117 __func__, subnode->name, ret);
1120 of_property_read_u32(subnode, "cdns,num-lanes", &num_lanes);
1121 of_property_read_u32(subnode, "cdns,phy-type", &phy_type);
1123 dev_dbg(dev, "%s: Lanes %u-%u have phy-type %u\n", __func__,
1124 reg, reg + num_lanes - 1, phy_type);
1126 for (i = reg; i < reg + num_lanes; i++)
1127 wiz->lane_phy_type[i] = phy_type;
1133 static int wiz_probe(struct platform_device *pdev)
1135 struct reset_controller_dev *phy_reset_dev;
1136 struct device *dev = &pdev->dev;
1137 struct device_node *node = dev->of_node;
1138 struct platform_device *serdes_pdev;
1139 bool already_configured = false;
1140 struct device_node *child_node;
1141 struct regmap *regmap;
1142 struct resource res;
1148 wiz = devm_kzalloc(dev, sizeof(*wiz), GFP_KERNEL);
1152 wiz->type = (enum wiz_type)of_device_get_match_data(dev);
1154 child_node = of_get_child_by_name(node, "serdes");
1156 dev_err(dev, "Failed to get SERDES child DT node\n");
1160 ret = of_address_to_resource(child_node, 0, &res);
1162 dev_err(dev, "Failed to get memory resource\n");
1163 goto err_addr_to_resource;
1166 base = devm_ioremap(dev, res.start, resource_size(&res));
1169 goto err_addr_to_resource;
1172 regmap = devm_regmap_init_mmio(dev, base, &wiz_regmap_config);
1173 if (IS_ERR(regmap)) {
1174 dev_err(dev, "Failed to initialize regmap\n");
1175 ret = PTR_ERR(regmap);
1176 goto err_addr_to_resource;
1179 ret = of_property_read_u32(node, "num-lanes", &num_lanes);
1181 dev_err(dev, "Failed to read num-lanes property\n");
1182 goto err_addr_to_resource;
1185 if (num_lanes > WIZ_MAX_LANES) {
1186 dev_err(dev, "Cannot support %d lanes\n", num_lanes);
1188 goto err_addr_to_resource;
1191 wiz->gpio_typec_dir = devm_gpiod_get_optional(dev, "typec-dir",
1193 if (IS_ERR(wiz->gpio_typec_dir)) {
1194 ret = PTR_ERR(wiz->gpio_typec_dir);
1195 if (ret != -EPROBE_DEFER)
1196 dev_err(dev, "Failed to request typec-dir gpio: %d\n",
1198 goto err_addr_to_resource;
1201 if (wiz->gpio_typec_dir) {
1202 ret = of_property_read_u32(node, "typec-dir-debounce-ms",
1203 &wiz->typec_dir_delay);
1204 if (ret && ret != -EINVAL) {
1205 dev_err(dev, "Invalid typec-dir-debounce property\n");
1206 goto err_addr_to_resource;
1209 /* use min. debounce from Type-C spec if not provided in DT */
1211 wiz->typec_dir_delay = WIZ_TYPEC_DIR_DEBOUNCE_MIN;
1213 if (wiz->typec_dir_delay < WIZ_TYPEC_DIR_DEBOUNCE_MIN ||
1214 wiz->typec_dir_delay > WIZ_TYPEC_DIR_DEBOUNCE_MAX) {
1216 dev_err(dev, "Invalid typec-dir-debounce property\n");
1217 goto err_addr_to_resource;
1221 ret = wiz_get_lane_phy_types(dev, wiz);
1226 wiz->regmap = regmap;
1227 wiz->num_lanes = num_lanes;
1228 if (wiz->type == J721E_WIZ_10G || wiz->type == AM64_WIZ_10G)
1229 wiz->clk_mux_sel = clk_mux_sel_10g;
1231 wiz->clk_mux_sel = clk_mux_sel_16g;
1233 wiz->clk_div_sel = clk_div_sel;
1235 if (wiz->type == J721E_WIZ_10G || wiz->type == AM64_WIZ_10G)
1236 wiz->clk_div_sel_num = WIZ_DIV_NUM_CLOCKS_10G;
1238 wiz->clk_div_sel_num = WIZ_DIV_NUM_CLOCKS_16G;
1240 platform_set_drvdata(pdev, wiz);
1242 ret = wiz_regfield_init(wiz);
1244 dev_err(dev, "Failed to initialize regfields\n");
1245 goto err_addr_to_resource;
1248 phy_reset_dev = &wiz->wiz_phy_reset_dev;
1249 phy_reset_dev->dev = dev;
1250 phy_reset_dev->ops = &wiz_phy_reset_ops,
1251 phy_reset_dev->owner = THIS_MODULE,
1252 phy_reset_dev->of_node = node;
1253 /* Reset for each of the lane and one for the entire SERDES */
1254 phy_reset_dev->nr_resets = num_lanes + 1;
1256 ret = devm_reset_controller_register(dev, phy_reset_dev);
1258 dev_warn(dev, "Failed to register reset controller\n");
1259 goto err_addr_to_resource;
1262 pm_runtime_enable(dev);
1263 ret = pm_runtime_get_sync(dev);
1265 dev_err(dev, "pm_runtime_get_sync failed\n");
1269 ret = wiz_clock_init(wiz, node);
1271 dev_warn(dev, "Failed to initialize clocks\n");
1275 for (i = 0; i < wiz->num_lanes; i++) {
1276 regmap_field_read(wiz->p_enable[i], &val);
1277 if (val & (P_ENABLE | P_ENABLE_FORCE)) {
1278 already_configured = true;
1283 if (!already_configured) {
1284 ret = wiz_init(wiz);
1286 dev_err(dev, "WIZ initialization failed\n");
1291 serdes_pdev = of_platform_device_create(child_node, NULL, dev);
1293 dev_WARN(dev, "Unable to create SERDES platform device\n");
1297 wiz->serdes_pdev = serdes_pdev;
1299 of_node_put(child_node);
1303 wiz_clock_cleanup(wiz, node);
1306 pm_runtime_put(dev);
1307 pm_runtime_disable(dev);
1309 err_addr_to_resource:
1310 of_node_put(child_node);
1315 static int wiz_remove(struct platform_device *pdev)
1317 struct device *dev = &pdev->dev;
1318 struct device_node *node = dev->of_node;
1319 struct platform_device *serdes_pdev;
1322 wiz = dev_get_drvdata(dev);
1323 serdes_pdev = wiz->serdes_pdev;
1325 of_platform_device_destroy(&serdes_pdev->dev, NULL);
1326 wiz_clock_cleanup(wiz, node);
1327 pm_runtime_put(dev);
1328 pm_runtime_disable(dev);
1333 static struct platform_driver wiz_driver = {
1335 .remove = wiz_remove,
1338 .of_match_table = wiz_id_table,
1341 module_platform_driver(wiz_driver);
1343 MODULE_AUTHOR("Texas Instruments Inc.");
1344 MODULE_DESCRIPTION("TI J721E WIZ driver");
1345 MODULE_LICENSE("GPL v2");