Skip to contentSkip to conversation

phy-zynqmp: Postpone getting clock rate until actually needed

PATCH Applied Mike Looijmans 3 participants 4 messages Apr 28, 2025 – May 14, 2025 1 message not in the archive

Subsystems (3)
lore
Share & tools
lore

A message that is not in the archive (sent off-list or not yet received): 1b153bce-a66a-45ee-a5c6-963ea6fb1c82.949ef384-8293-46b8-903f-40a477c056ae.298e943d-5a80-491d-b36f-77b3b9a86df9@emailsignatures365.codetwo.com

#1 lore raw

PATCH v2 1/1 phy-zynqmp: Postpone getting clock rate until actually needed

At probe time the driver would display the following error and abort:
xilinx-psgtr fd400000.phy: Invalid rate 0 for reference clock 0

At probe time, the associated GTR driver (e.g. SATA or PCIe) hasn't initialized the clock yet, so clk_get_rate() likely returns 0 if the clock is programmable. So this driver only works if the clock is fixed.

The PHY driver doesn't need to know the clock frequency at probe yet, so wait until the associated driver initializes the lane before requesting the clock rate setting.

In addition to allowing the driver to be used with programmable clocks, this also reduces the driver's runtime memory footprint by removing an array of pointers from struct xpsgtr_phy.

---

Changes in v2:
Explain the issue and the fix better in the commit text Propagate errors (as reported by Laurent Pinchart)

 drivers/phy/xilinx/phy-zynqmp.c | 70 +++++++++++++++++----------------
 1 file changed, 37 insertions(+), 33 deletions(-)
drivers/phy/xilinx/phy-zynqmp.c +37 -33
index 05a4a59f7c40..fe6b4925d166 100644
@@ -222,7 +222,6 @@ struct xpsgtr_phy {
  * @siou: siou base address
  * @gtr_mutex: mutex for locking
  * @phys: PHY lanes
- * @refclk_sscs: spread spectrum settings for the reference clocks
  * @clk: reference clocks
  * @tx_term_fix: fix for GT issue
  * @saved_icm_cfg0: stored value of ICM CFG0 register
@@ -235,7 +234,6 @@ struct xpsgtr_dev {
 	void __iomem *siou;
 	struct mutex gtr_mutex; /* mutex for locking */
 	struct xpsgtr_phy phys[NUM_LANES];
-	const struct xpsgtr_ssc *refclk_sscs[NUM_LANES];
 	struct clk *clk[NUM_LANES];
 	bool tx_term_fix;
 	unsigned int saved_icm_cfg0;
@@ -398,13 +396,40 @@ static int xpsgtr_wait_pll_lock(struct phy *phy)
 	return ret;
 }
 
+/* Get the spread spectrum (SSC) settings for the reference clock rate */
+static const struct xpsgtr_ssc *xpsgtr_find_sscs(struct xpsgtr_phy *gtr_phy)
+{
+	unsigned long rate;
+	struct clk *clk;
+	unsigned int i;
+
+	clk = gtr_phy->dev->clk[gtr_phy->refclk];
+	rate = clk_get_rate(clk);
+
+	for (i = 0 ; i < ARRAY_SIZE(ssc_lookup); i++) {
+		/* Allow an error of 100 ppm */
+		unsigned long error = ssc_lookup[i].refclk_rate / 10000;
+
+		if (abs(rate - ssc_lookup[i].refclk_rate) < error)
+			return &ssc_lookup[i];
+	}
+
+	dev_err(gtr_phy->dev->dev, "Invalid rate %lu for reference clock %u\n",
+		rate, gtr_phy->refclk);
+
+	return NULL;
+}
+
 /* Configure PLL and spread-sprectrum clock. */
-static void xpsgtr_configure_pll(struct xpsgtr_phy *gtr_phy)
+static int xpsgtr_configure_pll(struct xpsgtr_phy *gtr_phy)
 {
 	const struct xpsgtr_ssc *ssc;
 	u32 step_size;
 
-	ssc = gtr_phy->dev->refclk_sscs[gtr_phy->refclk];
+	ssc = xpsgtr_find_sscs(gtr_phy);
+	if (!ssc)
+		return -EINVAL;
+
 	step_size = ssc->step_size;
 
 	xpsgtr_clr_set(gtr_phy->dev, PLL_REF_SEL(gtr_phy->lane),
@@ -446,6 +471,8 @@ static void xpsgtr_configure_pll(struct xpsgtr_phy *gtr_phy)
 	xpsgtr_clr_set_phy(gtr_phy, L0_PLL_SS_STEP_SIZE_3_MSB,
 			   STEP_SIZE_3_MASK, (step_size & STEP_SIZE_3_MASK) |
 			   FORCE_STEP_SIZE | FORCE_STEPS);
+
+	return 0;
 }
 
 /* Configure the lane protocol. */
@@ -658,7 +685,10 @@ static int xpsgtr_phy_init(struct phy *phy)
 	 * Configure the PLL, the lane protocol, and perform protocol-specific
 	 * initialization.
 	 */
-	xpsgtr_configure_pll(gtr_phy);
+	ret = xpsgtr_configure_pll(gtr_phy);
+	if (ret)
+		goto out;
+
 	xpsgtr_lane_set_protocol(gtr_phy);
 
 	switch (gtr_phy->protocol) {
@@ -823,8 +853,7 @@ static struct phy *xpsgtr_xlate(struct device *dev,
 	}
 
 	refclk = args->args[3];
-	if (refclk >= ARRAY_SIZE(gtr_dev->refclk_sscs) ||
-	    !gtr_dev->refclk_sscs[refclk]) {
+	if (refclk >= ARRAY_SIZE(gtr_dev->clk)) {
 		dev_err(dev, "Invalid reference clock number %u\n", refclk);
 		return ERR_PTR(-EINVAL);
 	}
@@ -928,9 +957,7 @@ static int xpsgtr_get_ref_clocks(struct xpsgtr_dev *gtr_dev)
 {
 	unsigned int refclk;
 
-	for (refclk = 0; refclk < ARRAY_SIZE(gtr_dev->refclk_sscs); ++refclk) {
-		unsigned long rate;
-		unsigned int i;
+	for (refclk = 0; refclk < ARRAY_SIZE(gtr_dev->clk); ++refclk) {
 		struct clk *clk;
 		char name[8];
 
@@ -946,29 +973,6 @@ static int xpsgtr_get_ref_clocks(struct xpsgtr_dev *gtr_dev)
 			continue;
 
 		gtr_dev->clk[refclk] = clk;
-
-		/*
-		 * Get the spread spectrum (SSC) settings for the reference
-		 * clock rate.
-		 */
-		rate = clk_get_rate(clk);
-
-		for (i = 0 ; i < ARRAY_SIZE(ssc_lookup); i++) {
-			/* Allow an error of 100 ppm */
-			unsigned long error = ssc_lookup[i].refclk_rate / 10000;
-
-			if (abs(rate - ssc_lookup[i].refclk_rate) < error) {
-				gtr_dev->refclk_sscs[refclk] = &ssc_lookup[i];
-				break;
-			}
-		}
-
-		if (i == ARRAY_SIZE(ssc_lookup)) {
-			dev_err(gtr_dev->dev,
-				"Invalid rate %lu for reference clock %u\n",
-				rate, refclk);
-			return -EINVAL;
-		}
 	}
 
 	return 0;
Signature · 20 lines
2.43.0

base-commit: 8cc713032dae3b74742d90a35e2f93b6cb23684f
branch: linux-master-xilinx-pcie-reset

Met vriendelijke groet / kind regards,

Mike Looijmans
System Expert


TOPIC Embedded Products B.V.
Materiaalweg 4, 5681 RJ Best
The Netherlands

T: +31 (0) 499 33 69 69
E: [email protected]
W: www.topic.nl

Please consider the environment before printing this e-mail
maintainer Acked-by on v2 1/1
#2 lore raw

+ Radhey, Harini

Quoted 150 lines · Mike Looijmans

At probe time the driver would display the following error and abort:
xilinx-psgtr fd400000.phy: Invalid rate 0 for reference clock 0

At probe time, the associated GTR driver (e.g. SATA or PCIe) hasn't initialized the clock yet, so clk_get_rate() likely returns 0 if the clock is programmable. So this driver only works if the clock is fixed.

The PHY driver doesn't need to know the clock frequency at probe yet, so wait until the associated driver initializes the lane before requesting the clock rate setting.

In addition to allowing the driver to be used with programmable clocks, this also reduces the driver's runtime memory footprint by removing an array of pointers from struct xpsgtr_phy.

---

Changes in v2:
Explain the issue and the fix better in the commit text Propagate errors (as reported by Laurent Pinchart)

  drivers/phy/xilinx/phy-zynqmp.c | 70 +++++++++++++++++----------------
  1 file changed, 37 insertions(+), 33 deletions(-)
drivers/phy/xilinx/phy-zynqmp.c +37 -26
index 05a4a59f7c40..fe6b4925d166 100644
@@ -222,7 +222,6 @@ struct xpsgtr_phy {
   * @siou: siou base address
   * @gtr_mutex: mutex for locking
   * @phys: PHY lanes
- * @refclk_sscs: spread spectrum settings for the reference clocks
   * @clk: reference clocks
   * @tx_term_fix: fix for GT issue
   * @saved_icm_cfg0: stored value of ICM CFG0 register
@@ -235,7 +234,6 @@ struct xpsgtr_dev {
  	void __iomem *siou;
  	struct mutex gtr_mutex; /* mutex for locking */
  	struct xpsgtr_phy phys[NUM_LANES];
-	const struct xpsgtr_ssc *refclk_sscs[NUM_LANES];
  	struct clk *clk[NUM_LANES];
  	bool tx_term_fix;
  	unsigned int saved_icm_cfg0;
@@ -398,13 +396,40 @@ static int xpsgtr_wait_pll_lock(struct phy *phy)
  	return ret;
  }
 
+/* Get the spread spectrum (SSC) settings for the reference clock rate */
+static const struct xpsgtr_ssc *xpsgtr_find_sscs(struct xpsgtr_phy *gtr_phy)
+{
+	unsigned long rate;
+	struct clk *clk;
+	unsigned int i;
+
+	clk = gtr_phy->dev->clk[gtr_phy->refclk];
+	rate = clk_get_rate(clk);
+
+	for (i = 0 ; i < ARRAY_SIZE(ssc_lookup); i++) {
+		/* Allow an error of 100 ppm */
+		unsigned long error = ssc_lookup[i].refclk_rate / 10000;
+
+		if (abs(rate - ssc_lookup[i].refclk_rate) < error)
+			return &ssc_lookup[i];
+	}
+
+	dev_err(gtr_phy->dev->dev, "Invalid rate %lu for reference clock %u\n",
+		rate, gtr_phy->refclk);
+
+	return NULL;
+}
+
  /* Configure PLL and spread-sprectrum clock. */
-static void xpsgtr_configure_pll(struct xpsgtr_phy *gtr_phy)
+static int xpsgtr_configure_pll(struct xpsgtr_phy *gtr_phy)
  {
  	const struct xpsgtr_ssc *ssc;
  	u32 step_size;
 
-	ssc = gtr_phy->dev->refclk_sscs[gtr_phy->refclk];
+	ssc = xpsgtr_find_sscs(gtr_phy);
+	if (!ssc)
+		return -EINVAL;
+
  	step_size = ssc->step_size;
 
  	xpsgtr_clr_set(gtr_phy->dev, PLL_REF_SEL(gtr_phy->lane),
@@ -446,6 +471,8 @@ static void xpsgtr_configure_pll(struct xpsgtr_phy *gtr_phy)
  	xpsgtr_clr_set_phy(gtr_phy, L0_PLL_SS_STEP_SIZE_3_MSB,
  			   STEP_SIZE_3_MASK, (step_size & STEP_SIZE_3_MASK) |
  			   FORCE_STEP_SIZE | FORCE_STEPS);
+
+	return 0;
  }
 
  /* Configure the lane protocol. */
@@ -658,7 +685,10 @@ static int xpsgtr_phy_init(struct phy *phy)
  	 * Configure the PLL, the lane protocol, and perform protocol-specific
  	 * initialization.
  	 */
-	xpsgtr_configure_pll(gtr_phy);
+	ret = xpsgtr_configure_pll(gtr_phy);
+	if (ret)
+		goto out;
+
  	xpsgtr_lane_set_protocol(gtr_phy);
 
  	switch (gtr_phy->protocol) {
@@ -823,8 +853,7 @@ static struct phy *xpsgtr_xlate(struct device *dev,
  	}
 
  	refclk = args->args[3];
-	if (refclk >= ARRAY_SIZE(gtr_dev->refclk_sscs) ||
-	    !gtr_dev->refclk_sscs[refclk]) {
+	if (refclk >= ARRAY_SIZE(gtr_dev->clk)) {
  		dev_err(dev, "Invalid reference clock number %u\n", refclk);
  		return ERR_PTR(-EINVAL);
  	}
@@ -928,9 +957,7 @@ static int xpsgtr_get_ref_clocks(struct xpsgtr_dev *gtr_dev)
  {
  	unsigned int refclk;
 
-	for (refclk = 0; refclk < ARRAY_SIZE(gtr_dev->refclk_sscs); ++refclk) {
-		unsigned long rate;
-		unsigned int i;
+	for (refclk = 0; refclk < ARRAY_SIZE(gtr_dev->clk); ++refclk) {
  		struct clk *clk;
  		char name[8];
 
@@ -946,29 +973,6 @@ static int xpsgtr_get_ref_clocks(struct xpsgtr_dev *gtr_dev)
  			continue;
 
  		gtr_dev->clk[refclk] = clk;
-
-		/*
-		 * Get the spread spectrum (SSC) settings for the reference
-		 * clock rate.
-		 */
-		rate = clk_get_rate(clk);
-
-		for (i = 0 ; i < ARRAY_SIZE(ssc_lookup); i++) {
-			/* Allow an error of 100 ppm */
-			unsigned long error = ssc_lookup[i].refclk_rate / 10000;
-
-			if (abs(rate - ssc_lookup[i].refclk_rate) < error) {
-				gtr_dev->refclk_sscs[refclk] = &ssc_lookup[i];
-				break;
-			}
-		}

drivers/phy/xilinx/phy-zynqmp.c static int xpsgtr_get_ref_clocks(struct xpsgtr_dev *gtr_dev) · line 978

Quoted 10 lines
drivers/phy/xilinx/phy-zynqmp.c +0 -7
-
-		if (i == ARRAY_SIZE(ssc_lookup)) {
-			dev_err(gtr_dev->dev,
-				"Invalid rate %lu for reference clock %u\n",
-				rate, refclk);
-			return -EINVAL;
-		}
  	}
 
  	return 0;

Sorry for delay.
Radhey/Harini: Please test this but I have read that code and changes looks good to me.

Thanks,
Michal

#3 lore raw
Quoted 159 lines · Michal Simek

+ Radhey, Harini

Quoted 150 lines · Mike Looijmans

At probe time the driver would display the following error and abort:
   xilinx-psgtr fd400000.phy: Invalid rate 0 for reference clock 0

At probe time, the associated GTR driver (e.g. SATA or PCIe) hasn't initialized the clock yet, so clk_get_rate() likely returns 0 if the clock is programmable. So this driver only works if the clock is fixed.

The PHY driver doesn't need to know the clock frequency at probe yet, so wait until the associated driver initializes the lane before requesting the clock rate setting.

In addition to allowing the driver to be used with programmable clocks, this also reduces the driver's runtime memory footprint by removing an array of pointers from struct xpsgtr_phy.

---

Changes in v2:
Explain the issue and the fix better in the commit text Propagate errors (as reported by Laurent Pinchart)

  drivers/phy/xilinx/phy-zynqmp.c | 70 +++++++++++++++++----------------

  1 file changed, 37 insertions(+), 33 deletions(-)
drivers/phy/xilinx/phy-zynqmp.c +0 -1
index 05a4a59f7c40..fe6b4925d166 100644
@@ -222,7 +222,6 @@ struct xpsgtr_phy {
    * @siou: siou base address
    * @gtr_mutex: mutex for locking
    * @phys: PHY lanes
- * @refclk_sscs: spread spectrum settings for the reference clocks
    * @clk: reference clocks
    * @tx_term_fix: fix for GT issue
    * @saved_icm_cfg0: stored value of ICM CFG0 register
@@ -235,7 +234,6 @@ struct xpsgtr_dev {
       void __iomem *siou;

      struct mutex gtr_mutex; /* mutex for locking */ struct xpsgtr_phy phys[NUM_LANES];
-    const struct xpsgtr_ssc *refclk_sscs[NUM_LANES]; struct clk *clk[NUM_LANES];
      bool tx_term_fix;
      unsigned int saved_icm_cfg0;

drivers/phy/xilinx/phy-zynqmp.c +0 -0
@@ -398,13 +396,40 @@ static int xpsgtr_wait_pll_lock(struct phy *phy)
       return ret;
   }

  +/* Get the spread spectrum (SSC) settings for the reference clock rate */

drivers/phy/xilinx/phy-zynqmp.c +23 -0
+static const struct xpsgtr_ssc *xpsgtr_find_sscs(struct xpsgtr_phy *gtr_phy)
+{
+    unsigned long rate;
+    struct clk *clk;
+    unsigned int i;
+
+    clk = gtr_phy->dev->clk[gtr_phy->refclk];
+    rate = clk_get_rate(clk);
+
+    for (i = 0 ; i < ARRAY_SIZE(ssc_lookup); i++) {
+        /* Allow an error of 100 ppm */
+        unsigned long error = ssc_lookup[i].refclk_rate / 10000;
+
+        if (abs(rate - ssc_lookup[i].refclk_rate) < error)
+            return &ssc_lookup[i];
+    }
+
+    dev_err(gtr_phy->dev->dev, "Invalid rate %lu for reference clock %u\n",
+        rate, gtr_phy->refclk);
+
+    return NULL;
+}
+

  /* Configure PLL and spread-sprectrum clock. */

drivers/phy/xilinx/phy-zynqmp.c +1 -1
-static void xpsgtr_configure_pll(struct xpsgtr_phy *gtr_phy)
+static int xpsgtr_configure_pll(struct xpsgtr_phy *gtr_phy)

  {
      const struct xpsgtr_ssc *ssc;
      u32 step_size;
  -    ssc = gtr_phy->dev->refclk_sscs[gtr_phy->refclk]; +    ssc = xpsgtr_find_sscs(gtr_phy);
+    if (!ssc)
+        return -EINVAL;
+
      step_size = ssc->step_size; xpsgtr_clr_set(gtr_phy->dev, PLL_REF_SEL(gtr_phy->lane),

drivers/phy/xilinx/phy-zynqmp.c +0 -0
@@ -446,6 +471,8 @@ static void xpsgtr_configure_pll(struct xpsgtr_phy 
 *gtr_phy)
       xpsgtr_clr_set_phy(gtr_phy, L0_PLL_SS_STEP_SIZE_3_MSB,

                 STEP_SIZE_3_MASK, (step_size & STEP_SIZE_3_MASK) | FORCE_STEP_SIZE | FORCE_STEPS);
+
+    return 0;
  }
    /* Configure the lane protocol. */

drivers/phy/xilinx/phy-zynqmp.c +6 -5
@@ -658,7 +685,10 @@ static int xpsgtr_phy_init(struct phy *phy)
        * Configure the PLL, the lane protocol, and perform protocol-specific
        * initialization.
        */
-    xpsgtr_configure_pll(gtr_phy);
+    ret = xpsgtr_configure_pll(gtr_phy);
+    if (ret)
+        goto out;
+
       xpsgtr_lane_set_protocol(gtr_phy);
         switch (gtr_phy->protocol) {
@@ -823,8 +853,7 @@ static struct phy *xpsgtr_xlate(struct device *dev,
       }
         refclk = args->args[3];
-    if (refclk >= ARRAY_SIZE(gtr_dev->refclk_sscs) ||
-        !gtr_dev->refclk_sscs[refclk]) {
+    if (refclk >= ARRAY_SIZE(gtr_dev->clk)) {
           dev_err(dev, "Invalid reference clock number %u\n", refclk);
           return ERR_PTR(-EINVAL);
       }
@@ -928,9 +957,7 @@ static int xpsgtr_get_ref_clocks(struct xpsgtr_dev 
 *gtr_dev)
   {
       unsigned int refclk;
   -    for (refclk = 0; refclk < ARRAY_SIZE(gtr_dev->refclk_sscs); ++refclk) {
-        unsigned long rate;
-        unsigned int i;
+    for (refclk = 0; refclk < ARRAY_SIZE(gtr_dev->clk); ++refclk) {
           struct clk *clk;
           char name[8];

  @@ -946,29 +973,6 @@ static int xpsgtr_get_ref_clocks(struct xpsgtr_dev *gtr_dev) continue;
            gtr_dev->clk[refclk] = clk;

drivers/phy/xilinx/phy-zynqmp.c +0 -23
-
-        /*
-         * Get the spread spectrum (SSC) settings for the reference
-         * clock rate.
-         */
-        rate = clk_get_rate(clk);
-
-        for (i = 0 ; i < ARRAY_SIZE(ssc_lookup); i++) {
-            /* Allow an error of 100 ppm */
-            unsigned long error = ssc_lookup[i].refclk_rate / 10000;
-
-            if (abs(rate - ssc_lookup[i].refclk_rate) < error) {
-                gtr_dev->refclk_sscs[refclk] = &ssc_lookup[i];
-                break;
-            }
-        }
-
-        if (i == ARRAY_SIZE(ssc_lookup)) {
-            dev_err(gtr_dev->dev,
-                "Invalid rate %lu for reference clock %u\n",
-                rate, refclk);
-            return -EINVAL;
-        }
Quoted 2 lines

      }
        return 0;

Sorry for delay.
Radhey/Harini: Please test this but I have read that code and changes looks good to me.

Quoted 5 lines

Thanks,
Michal

Any further comments? Anything I need to do?

M.

maintainer Applied
#4 lore raw
In reply to Mike Looijmans
Quoted 8 lines · Mike Looijmans

At probe time the driver would display the following error and abort:
xilinx-psgtr fd400000.phy: Invalid rate 0 for reference clock 0

At probe time, the associated GTR driver (e.g. SATA or PCIe) hasn't initialized the clock yet, so clk_get_rate() likely returns 0 if the clock is programmable. So this driver only works if the clock is fixed.

[...]

Applied, thanks!

[1/1] phy-zynqmp: Postpone getting clock rate until actually needed

      commit: 065d5885f6180c534b7b176847b3e008f4e11850

Best regards,

Signature · 1 line
~Vinod