From: Sergey Temerkhanov <sergey.temerkha...@intel.com>

Move CGU block to the beginning of ice_ptp_hw.c

Signed-off-by: Sergey Temerkhanov <sergey.temerkha...@intel.com>
Reviewed-by: Przemek Kitszel <przemyslaw.kits...@intel.com>
Reviewed-by: Arkadiusz Kubalewski <arkadiusz.kubalew...@intel.com>
Signed-off-by: Karol Kolacinski <karol.kolacin...@intel.com>
---
V6 -> V7: - removed leftover code in ice_read_cgu_reg_e82x()
          - changed .data assignment in ice_write_cgu_reg_e82x()
          - restored u32 cast in ice_ptp_reset_ts_memory_quad_e82x() to avoid
            false positive warning
V5 -> V6: - adjusted returns in ice_read/write_cgu_reg_e82x()
          - added cgu_msg init when declaring in ice_read/write_cgu_reg_e82x()
          - changed TS_PHY_LOW_S to TS_PHY_LOW_M and adjusted with FIELD_PREP()
          - removed unncecessary casts

 drivers/net/ethernet/intel/ice/ice_ptp_hw.c | 567 ++++++++++----------
 drivers/net/ethernet/intel/ice/ice_ptp_hw.h |   4 +-
 2 files changed, 281 insertions(+), 290 deletions(-)

diff --git a/drivers/net/ethernet/intel/ice/ice_ptp_hw.c 
b/drivers/net/ethernet/intel/ice/ice_ptp_hw.c
index 3c0efdd3cb8a..b74e410ce015 100644
--- a/drivers/net/ethernet/intel/ice/ice_ptp_hw.c
+++ b/drivers/net/ethernet/intel/ice/ice_ptp_hw.c
@@ -226,6 +226,281 @@ static u64 ice_ptp_read_src_incval(struct ice_hw *hw)
        return ((u64)(hi & INCVAL_HIGH_M) << 32) | lo;
 }
 
+/**
+ * ice_read_cgu_reg_e82x - Read a CGU register
+ * @hw: pointer to the HW struct
+ * @addr: Register address to read
+ * @val: storage for register value read
+ *
+ * Read the contents of a register of the Clock Generation Unit. Only
+ * applicable to E822 devices.
+ */
+static int ice_read_cgu_reg_e82x(struct ice_hw *hw, u32 addr, u32 *val)
+{
+       struct ice_sbq_msg_input cgu_msg = {
+               .opcode = ice_sbq_msg_rd,
+               .dest_dev = cgu,
+               .msg_addr_low = addr
+       };
+       int err;
+
+       err = ice_sbq_rw_reg(hw, &cgu_msg);
+       if (err) {
+               ice_debug(hw, ICE_DBG_PTP, "Failed to read CGU register 0x%04x, 
err %d\n",
+                         addr, err);
+               return err;
+       }
+
+       *val = cgu_msg.data;
+
+       return 0;
+}
+
+/**
+ * ice_write_cgu_reg_e82x - Write a CGU register
+ * @hw: pointer to the HW struct
+ * @addr: Register address to write
+ * @val: value to write into the register
+ *
+ * Write the specified value to a register of the Clock Generation Unit. Only
+ * applicable to E822 devices.
+ */
+static int ice_write_cgu_reg_e82x(struct ice_hw *hw, u32 addr, u32 val)
+{
+       struct ice_sbq_msg_input cgu_msg = {
+               .opcode = ice_sbq_msg_wr,
+               .dest_dev = cgu,
+               .msg_addr_low = addr,
+               .data = val
+       };
+       int err;
+
+       err = ice_sbq_rw_reg(hw, &cgu_msg);
+       if (err) {
+               ice_debug(hw, ICE_DBG_PTP, "Failed to write CGU register 
0x%04x, err %d\n",
+                         addr, err);
+               return err;
+       }
+
+       return err;
+}
+
+/**
+ * ice_clk_freq_str - Convert time_ref_freq to string
+ * @clk_freq: Clock frequency
+ *
+ * Convert the specified TIME_REF clock frequency to a string.
+ */
+static const char *ice_clk_freq_str(enum ice_time_ref_freq clk_freq)
+{
+       switch (clk_freq) {
+       case ICE_TIME_REF_FREQ_25_000:
+               return "25 MHz";
+       case ICE_TIME_REF_FREQ_122_880:
+               return "122.88 MHz";
+       case ICE_TIME_REF_FREQ_125_000:
+               return "125 MHz";
+       case ICE_TIME_REF_FREQ_153_600:
+               return "153.6 MHz";
+       case ICE_TIME_REF_FREQ_156_250:
+               return "156.25 MHz";
+       case ICE_TIME_REF_FREQ_245_760:
+               return "245.76 MHz";
+       default:
+               return "Unknown";
+       }
+}
+
+/**
+ * ice_clk_src_str - Convert time_ref_src to string
+ * @clk_src: Clock source
+ *
+ * Convert the specified clock source to its string name.
+ */
+static const char *ice_clk_src_str(enum ice_clk_src clk_src)
+{
+       switch (clk_src) {
+       case ICE_CLK_SRC_TCX0:
+               return "TCX0";
+       case ICE_CLK_SRC_TIME_REF:
+               return "TIME_REF";
+       default:
+               return "Unknown";
+       }
+}
+
+/**
+ * ice_cfg_cgu_pll_e82x - Configure the Clock Generation Unit
+ * @hw: pointer to the HW struct
+ * @clk_freq: Clock frequency to program
+ * @clk_src: Clock source to select (TIME_REF, or TCX0)
+ *
+ * Configure the Clock Generation Unit with the desired clock frequency and
+ * time reference, enabling the PLL which drives the PTP hardware clock.
+ */
+static int ice_cfg_cgu_pll_e82x(struct ice_hw *hw,
+                               enum ice_time_ref_freq clk_freq,
+                               enum ice_clk_src clk_src)
+{
+       union tspll_ro_bwm_lf bwm_lf;
+       union nac_cgu_dword19 dw19;
+       union nac_cgu_dword22 dw22;
+       union nac_cgu_dword24 dw24;
+       union nac_cgu_dword9 dw9;
+       int err;
+
+       if (clk_freq >= NUM_ICE_TIME_REF_FREQ) {
+               dev_warn(ice_hw_to_dev(hw), "Invalid TIME_REF frequency %u\n",
+                        clk_freq);
+               return -EINVAL;
+       }
+
+       if (clk_src >= NUM_ICE_CLK_SRC) {
+               dev_warn(ice_hw_to_dev(hw), "Invalid clock source %u\n",
+                        clk_src);
+               return -EINVAL;
+       }
+
+       if (clk_src == ICE_CLK_SRC_TCX0 &&
+           clk_freq != ICE_TIME_REF_FREQ_25_000) {
+               dev_warn(ice_hw_to_dev(hw),
+                        "TCX0 only supports 25 MHz frequency\n");
+               return -EINVAL;
+       }
+
+       err = ice_read_cgu_reg_e82x(hw, NAC_CGU_DWORD9, &dw9.val);
+       if (err)
+               return err;
+
+       err = ice_read_cgu_reg_e82x(hw, NAC_CGU_DWORD24, &dw24.val);
+       if (err)
+               return err;
+
+       err = ice_read_cgu_reg_e82x(hw, TSPLL_RO_BWM_LF, &bwm_lf.val);
+       if (err)
+               return err;
+
+       /* Log the current clock configuration */
+       ice_debug(hw, ICE_DBG_PTP, "Current CGU configuration -- %s, clk_src 
%s, clk_freq %s, PLL %s\n",
+                 dw24.field.ts_pll_enable ? "enabled" : "disabled",
+                 ice_clk_src_str(dw24.field.time_ref_sel),
+                 ice_clk_freq_str(dw9.field.time_ref_freq_sel),
+                 bwm_lf.field.plllock_true_lock_cri ? "locked" : "unlocked");
+
+       /* Disable the PLL before changing the clock source or frequency */
+       if (dw24.field.ts_pll_enable) {
+               dw24.field.ts_pll_enable = 0;
+
+               err = ice_write_cgu_reg_e82x(hw, NAC_CGU_DWORD24, dw24.val);
+               if (err)
+                       return err;
+       }
+
+       /* Set the frequency */
+       dw9.field.time_ref_freq_sel = clk_freq;
+       err = ice_write_cgu_reg_e82x(hw, NAC_CGU_DWORD9, dw9.val);
+       if (err)
+               return err;
+
+       /* Configure the TS PLL feedback divisor */
+       err = ice_read_cgu_reg_e82x(hw, NAC_CGU_DWORD19, &dw19.val);
+       if (err)
+               return err;
+
+       dw19.field.tspll_fbdiv_intgr = e822_cgu_params[clk_freq].feedback_div;
+       dw19.field.tspll_ndivratio = 1;
+
+       err = ice_write_cgu_reg_e82x(hw, NAC_CGU_DWORD19, dw19.val);
+       if (err)
+               return err;
+
+       /* Configure the TS PLL post divisor */
+       err = ice_read_cgu_reg_e82x(hw, NAC_CGU_DWORD22, &dw22.val);
+       if (err)
+               return err;
+
+       dw22.field.time1588clk_div = e822_cgu_params[clk_freq].post_pll_div;
+       dw22.field.time1588clk_sel_div2 = 0;
+
+       err = ice_write_cgu_reg_e82x(hw, NAC_CGU_DWORD22, dw22.val);
+       if (err)
+               return err;
+
+       /* Configure the TS PLL pre divisor and clock source */
+       err = ice_read_cgu_reg_e82x(hw, NAC_CGU_DWORD24, &dw24.val);
+       if (err)
+               return err;
+
+       dw24.field.ref1588_ck_div = e822_cgu_params[clk_freq].refclk_pre_div;
+       dw24.field.tspll_fbdiv_frac = e822_cgu_params[clk_freq].frac_n_div;
+       dw24.field.time_ref_sel = clk_src;
+
+       err = ice_write_cgu_reg_e82x(hw, NAC_CGU_DWORD24, dw24.val);
+       if (err)
+               return err;
+
+       /* Finally, enable the PLL */
+       dw24.field.ts_pll_enable = 1;
+
+       err = ice_write_cgu_reg_e82x(hw, NAC_CGU_DWORD24, dw24.val);
+       if (err)
+               return err;
+
+       /* Wait to verify if the PLL locks */
+       usleep_range(1000, 5000);
+
+       err = ice_read_cgu_reg_e82x(hw, TSPLL_RO_BWM_LF, &bwm_lf.val);
+       if (err)
+               return err;
+
+       if (!bwm_lf.field.plllock_true_lock_cri) {
+               dev_warn(ice_hw_to_dev(hw), "CGU PLL failed to lock\n");
+               return -EBUSY;
+       }
+
+       /* Log the current clock configuration */
+       ice_debug(hw, ICE_DBG_PTP, "New CGU configuration -- %s, clk_src %s, 
clk_freq %s, PLL %s\n",
+                 dw24.field.ts_pll_enable ? "enabled" : "disabled",
+                 ice_clk_src_str(dw24.field.time_ref_sel),
+                 ice_clk_freq_str(dw9.field.time_ref_freq_sel),
+                 bwm_lf.field.plllock_true_lock_cri ? "locked" : "unlocked");
+
+       return 0;
+}
+
+/**
+ * ice_init_cgu_e82x - Initialize CGU with settings from firmware
+ * @hw: pointer to the HW structure
+ *
+ * Initialize the Clock Generation Unit of the E822 device.
+ */
+static int ice_init_cgu_e82x(struct ice_hw *hw)
+{
+       struct ice_ts_func_info *ts_info = &hw->func_caps.ts_func_info;
+       union tspll_cntr_bist_settings cntr_bist;
+       int err;
+
+       err = ice_read_cgu_reg_e82x(hw, TSPLL_CNTR_BIST_SETTINGS,
+                                   &cntr_bist.val);
+       if (err)
+               return err;
+
+       /* Disable sticky lock detection so lock err reported is accurate */
+       cntr_bist.field.i_plllock_sel_0 = 0;
+       cntr_bist.field.i_plllock_sel_1 = 0;
+
+       err = ice_write_cgu_reg_e82x(hw, TSPLL_CNTR_BIST_SETTINGS,
+                                    cntr_bist.val);
+       if (err)
+               return err;
+
+       /* Configure the CGU PLL using the parameters from the function
+        * capabilities.
+        */
+       return ice_cfg_cgu_pll_e82x(hw, ts_info->time_ref,
+                                  (enum ice_clk_src)ts_info->clk_src);
+}
+
 /**
  * ice_ptp_tmr_cmd_to_src_reg - Convert to source timer command value
  * @hw: pointer to HW struct
@@ -623,9 +898,8 @@ ice_write_40b_phy_reg_e82x(struct ice_hw *hw, u8 port, u16 
low_addr, u64 val)
                          low_addr);
                return -EINVAL;
        }
-
-       low = (u32)(val & P_REG_40B_LOW_M);
-       high = (u32)(val >> P_REG_40B_HIGH_S);
+       low = FIELD_GET(P_REG_40B_LOW_M, val);
+       high = FIELD_GET(P_REG_40B_HIGH_M, val);
 
        err = ice_write_phy_reg_e82x(hw, port, low_addr, low);
        if (err) {
@@ -830,7 +1104,7 @@ ice_read_phy_tstamp_e82x(struct ice_hw *hw, u8 quad, u8 
idx, u64 *tstamp)
         * lower 8 bits in the low register, and the upper 32 bits in the high
         * register.
         */
-       *tstamp = ((u64)hi) << TS_PHY_HIGH_S | ((u64)lo & TS_PHY_LOW_M);
+       *tstamp = FIELD_PREP(TS_PHY_HIGH_M, hi) | FIELD_PREP(TS_PHY_LOW_M, lo);
 
        return 0;
 }
@@ -884,7 +1158,7 @@ ice_clear_phy_tstamp_e82x(struct ice_hw *hw, u8 quad, u8 
idx)
 void ice_ptp_reset_ts_memory_quad_e82x(struct ice_hw *hw, u8 quad)
 {
        ice_write_quad_reg_e82x(hw, quad, Q_REG_TS_CTRL, Q_REG_TS_CTRL_M);
-       ice_write_quad_reg_e82x(hw, quad, Q_REG_TS_CTRL, ~(u32)Q_REG_TS_CTRL_M);
+       ice_write_quad_reg_e82x(hw, quad, Q_REG_TS_CTRL, (u32)~Q_REG_TS_CTRL_M);
 }
 
 /**
@@ -899,289 +1173,6 @@ static void ice_ptp_reset_ts_memory_e82x(struct ice_hw 
*hw)
                ice_ptp_reset_ts_memory_quad_e82x(hw, quad);
 }
 
-/**
- * ice_read_cgu_reg_e82x - Read a CGU register
- * @hw: pointer to the HW struct
- * @addr: Register address to read
- * @val: storage for register value read
- *
- * Read the contents of a register of the Clock Generation Unit. Only
- * applicable to E822 devices.
- */
-static int
-ice_read_cgu_reg_e82x(struct ice_hw *hw, u32 addr, u32 *val)
-{
-       struct ice_sbq_msg_input cgu_msg;
-       int err;
-
-       cgu_msg.opcode = ice_sbq_msg_rd;
-       cgu_msg.dest_dev = cgu;
-       cgu_msg.msg_addr_low = addr;
-       cgu_msg.msg_addr_high = 0x0;
-
-       err = ice_sbq_rw_reg(hw, &cgu_msg);
-       if (err) {
-               ice_debug(hw, ICE_DBG_PTP, "Failed to read CGU register 0x%04x, 
err %d\n",
-                         addr, err);
-               return err;
-       }
-
-       *val = cgu_msg.data;
-
-       return err;
-}
-
-/**
- * ice_write_cgu_reg_e82x - Write a CGU register
- * @hw: pointer to the HW struct
- * @addr: Register address to write
- * @val: value to write into the register
- *
- * Write the specified value to a register of the Clock Generation Unit. Only
- * applicable to E822 devices.
- */
-static int
-ice_write_cgu_reg_e82x(struct ice_hw *hw, u32 addr, u32 val)
-{
-       struct ice_sbq_msg_input cgu_msg;
-       int err;
-
-       cgu_msg.opcode = ice_sbq_msg_wr;
-       cgu_msg.dest_dev = cgu;
-       cgu_msg.msg_addr_low = addr;
-       cgu_msg.msg_addr_high = 0x0;
-       cgu_msg.data = val;
-
-       err = ice_sbq_rw_reg(hw, &cgu_msg);
-       if (err) {
-               ice_debug(hw, ICE_DBG_PTP, "Failed to write CGU register 
0x%04x, err %d\n",
-                         addr, err);
-               return err;
-       }
-
-       return err;
-}
-
-/**
- * ice_clk_freq_str - Convert time_ref_freq to string
- * @clk_freq: Clock frequency
- *
- * Convert the specified TIME_REF clock frequency to a string.
- */
-static const char *ice_clk_freq_str(u8 clk_freq)
-{
-       switch ((enum ice_time_ref_freq)clk_freq) {
-       case ICE_TIME_REF_FREQ_25_000:
-               return "25 MHz";
-       case ICE_TIME_REF_FREQ_122_880:
-               return "122.88 MHz";
-       case ICE_TIME_REF_FREQ_125_000:
-               return "125 MHz";
-       case ICE_TIME_REF_FREQ_153_600:
-               return "153.6 MHz";
-       case ICE_TIME_REF_FREQ_156_250:
-               return "156.25 MHz";
-       case ICE_TIME_REF_FREQ_245_760:
-               return "245.76 MHz";
-       default:
-               return "Unknown";
-       }
-}
-
-/**
- * ice_clk_src_str - Convert time_ref_src to string
- * @clk_src: Clock source
- *
- * Convert the specified clock source to its string name.
- */
-static const char *ice_clk_src_str(u8 clk_src)
-{
-       switch ((enum ice_clk_src)clk_src) {
-       case ICE_CLK_SRC_TCX0:
-               return "TCX0";
-       case ICE_CLK_SRC_TIME_REF:
-               return "TIME_REF";
-       default:
-               return "Unknown";
-       }
-}
-
-/**
- * ice_cfg_cgu_pll_e82x - Configure the Clock Generation Unit
- * @hw: pointer to the HW struct
- * @clk_freq: Clock frequency to program
- * @clk_src: Clock source to select (TIME_REF, or TCX0)
- *
- * Configure the Clock Generation Unit with the desired clock frequency and
- * time reference, enabling the PLL which drives the PTP hardware clock.
- */
-static int
-ice_cfg_cgu_pll_e82x(struct ice_hw *hw, enum ice_time_ref_freq clk_freq,
-                    enum ice_clk_src clk_src)
-{
-       union tspll_ro_bwm_lf bwm_lf;
-       union nac_cgu_dword19 dw19;
-       union nac_cgu_dword22 dw22;
-       union nac_cgu_dword24 dw24;
-       union nac_cgu_dword9 dw9;
-       int err;
-
-       if (clk_freq >= NUM_ICE_TIME_REF_FREQ) {
-               dev_warn(ice_hw_to_dev(hw), "Invalid TIME_REF frequency %u\n",
-                        clk_freq);
-               return -EINVAL;
-       }
-
-       if (clk_src >= NUM_ICE_CLK_SRC) {
-               dev_warn(ice_hw_to_dev(hw), "Invalid clock source %u\n",
-                        clk_src);
-               return -EINVAL;
-       }
-
-       if (clk_src == ICE_CLK_SRC_TCX0 &&
-           clk_freq != ICE_TIME_REF_FREQ_25_000) {
-               dev_warn(ice_hw_to_dev(hw),
-                        "TCX0 only supports 25 MHz frequency\n");
-               return -EINVAL;
-       }
-
-       err = ice_read_cgu_reg_e82x(hw, NAC_CGU_DWORD9, &dw9.val);
-       if (err)
-               return err;
-
-       err = ice_read_cgu_reg_e82x(hw, NAC_CGU_DWORD24, &dw24.val);
-       if (err)
-               return err;
-
-       err = ice_read_cgu_reg_e82x(hw, TSPLL_RO_BWM_LF, &bwm_lf.val);
-       if (err)
-               return err;
-
-       /* Log the current clock configuration */
-       ice_debug(hw, ICE_DBG_PTP, "Current CGU configuration -- %s, clk_src 
%s, clk_freq %s, PLL %s\n",
-                 dw24.field.ts_pll_enable ? "enabled" : "disabled",
-                 ice_clk_src_str(dw24.field.time_ref_sel),
-                 ice_clk_freq_str(dw9.field.time_ref_freq_sel),
-                 bwm_lf.field.plllock_true_lock_cri ? "locked" : "unlocked");
-
-       /* Disable the PLL before changing the clock source or frequency */
-       if (dw24.field.ts_pll_enable) {
-               dw24.field.ts_pll_enable = 0;
-
-               err = ice_write_cgu_reg_e82x(hw, NAC_CGU_DWORD24, dw24.val);
-               if (err)
-                       return err;
-       }
-
-       /* Set the frequency */
-       dw9.field.time_ref_freq_sel = clk_freq;
-       err = ice_write_cgu_reg_e82x(hw, NAC_CGU_DWORD9, dw9.val);
-       if (err)
-               return err;
-
-       /* Configure the TS PLL feedback divisor */
-       err = ice_read_cgu_reg_e82x(hw, NAC_CGU_DWORD19, &dw19.val);
-       if (err)
-               return err;
-
-       dw19.field.tspll_fbdiv_intgr = e822_cgu_params[clk_freq].feedback_div;
-       dw19.field.tspll_ndivratio = 1;
-
-       err = ice_write_cgu_reg_e82x(hw, NAC_CGU_DWORD19, dw19.val);
-       if (err)
-               return err;
-
-       /* Configure the TS PLL post divisor */
-       err = ice_read_cgu_reg_e82x(hw, NAC_CGU_DWORD22, &dw22.val);
-       if (err)
-               return err;
-
-       dw22.field.time1588clk_div = e822_cgu_params[clk_freq].post_pll_div;
-       dw22.field.time1588clk_sel_div2 = 0;
-
-       err = ice_write_cgu_reg_e82x(hw, NAC_CGU_DWORD22, dw22.val);
-       if (err)
-               return err;
-
-       /* Configure the TS PLL pre divisor and clock source */
-       err = ice_read_cgu_reg_e82x(hw, NAC_CGU_DWORD24, &dw24.val);
-       if (err)
-               return err;
-
-       dw24.field.ref1588_ck_div = e822_cgu_params[clk_freq].refclk_pre_div;
-       dw24.field.tspll_fbdiv_frac = e822_cgu_params[clk_freq].frac_n_div;
-       dw24.field.time_ref_sel = clk_src;
-
-       err = ice_write_cgu_reg_e82x(hw, NAC_CGU_DWORD24, dw24.val);
-       if (err)
-               return err;
-
-       /* Finally, enable the PLL */
-       dw24.field.ts_pll_enable = 1;
-
-       err = ice_write_cgu_reg_e82x(hw, NAC_CGU_DWORD24, dw24.val);
-       if (err)
-               return err;
-
-       /* Wait to verify if the PLL locks */
-       usleep_range(1000, 5000);
-
-       err = ice_read_cgu_reg_e82x(hw, TSPLL_RO_BWM_LF, &bwm_lf.val);
-       if (err)
-               return err;
-
-       if (!bwm_lf.field.plllock_true_lock_cri) {
-               dev_warn(ice_hw_to_dev(hw), "CGU PLL failed to lock\n");
-               return -EBUSY;
-       }
-
-       /* Log the current clock configuration */
-       ice_debug(hw, ICE_DBG_PTP, "New CGU configuration -- %s, clk_src %s, 
clk_freq %s, PLL %s\n",
-                 dw24.field.ts_pll_enable ? "enabled" : "disabled",
-                 ice_clk_src_str(dw24.field.time_ref_sel),
-                 ice_clk_freq_str(dw9.field.time_ref_freq_sel),
-                 bwm_lf.field.plllock_true_lock_cri ? "locked" : "unlocked");
-
-       return 0;
-}
-
-/**
- * ice_init_cgu_e82x - Initialize CGU with settings from firmware
- * @hw: pointer to the HW structure
- *
- * Initialize the Clock Generation Unit of the E822 device.
- */
-static int ice_init_cgu_e82x(struct ice_hw *hw)
-{
-       struct ice_ts_func_info *ts_info = &hw->func_caps.ts_func_info;
-       union tspll_cntr_bist_settings cntr_bist;
-       int err;
-
-       err = ice_read_cgu_reg_e82x(hw, TSPLL_CNTR_BIST_SETTINGS,
-                                   &cntr_bist.val);
-       if (err)
-               return err;
-
-       /* Disable sticky lock detection so lock err reported is accurate */
-       cntr_bist.field.i_plllock_sel_0 = 0;
-       cntr_bist.field.i_plllock_sel_1 = 0;
-
-       err = ice_write_cgu_reg_e82x(hw, TSPLL_CNTR_BIST_SETTINGS,
-                                    cntr_bist.val);
-       if (err)
-               return err;
-
-       /* Configure the CGU PLL using the parameters from the function
-        * capabilities.
-        */
-       err = ice_cfg_cgu_pll_e82x(hw, ts_info->time_ref,
-                                  (enum ice_clk_src)ts_info->clk_src);
-       if (err)
-               return err;
-
-       return 0;
-}
-
 /**
  * ice_ptp_set_vernier_wl - Set the window length for vernier calibration
  * @hw: pointer to the HW struct
diff --git a/drivers/net/ethernet/intel/ice/ice_ptp_hw.h 
b/drivers/net/ethernet/intel/ice/ice_ptp_hw.h
index 5223e17d2806..48c0bc179110 100644
--- a/drivers/net/ethernet/intel/ice/ice_ptp_hw.h
+++ b/drivers/net/ethernet/intel/ice/ice_ptp_hw.h
@@ -377,8 +377,8 @@ int ice_cgu_get_output_pin_state_caps(struct ice_hw *hw, u8 
pin_id,
 #define P_REG_TIMETUS_L                        0x410
 #define P_REG_TIMETUS_U                        0x414
 
-#define P_REG_40B_LOW_M                        0xFF
-#define P_REG_40B_HIGH_S               8
+#define P_REG_40B_LOW_M                        GENMASK(7, 0)
+#define P_REG_40B_HIGH_M               GENMASK(39, 8)
 
 /* PHY window length registers */
 #define P_REG_WL                       0x40C
-- 
2.43.0

Reply via email to