ptp: lan743x: use diff_by_scaled_ppm in .adjfine implementation

Update the lan743x driver to use the recently added diff_by_scaled_ppm
helper function. This reduces the amount of code required in lan743x_ptp.c
driver file.

Signed-off-by: Jacob Keller <jacob.e.keller@intel.com>
Acked-by: Richard Cochran <richardcochran@gmail.com>
Cc: Bryan Whitehead <bryan.whitehead@microchip.com>
Cc: UNGLinuxDriver@microchip.com
Signed-off-by: David S. Miller <davem@davemloft.net>
This commit is contained in:
Jacob Keller 2022-10-28 04:04:18 -07:00 committed by David S. Miller
parent c56dff6a9a
commit 8bc900cbff
1 changed files with 6 additions and 13 deletions

View File

@ -339,25 +339,18 @@ static int lan743x_ptpci_adjfine(struct ptp_clock_info *ptpci, long scaled_ppm)
struct lan743x_adapter *adapter =
container_of(ptp, struct lan743x_adapter, ptp);
u32 lan743x_rate_adj = 0;
bool positive = true;
u64 u64_delta = 0;
u64 u64_delta;
if ((scaled_ppm < (-LAN743X_PTP_MAX_FINE_ADJ_IN_SCALED_PPM)) ||
scaled_ppm > LAN743X_PTP_MAX_FINE_ADJ_IN_SCALED_PPM) {
return -EINVAL;
}
if (scaled_ppm > 0) {
u64_delta = (u64)scaled_ppm;
positive = true;
} else {
u64_delta = (u64)(-scaled_ppm);
positive = false;
}
u64_delta = (u64_delta << 19);
lan743x_rate_adj = div_u64(u64_delta, 1000000);
if (positive)
lan743x_rate_adj |= PTP_CLOCK_RATE_ADJ_DIR_;
/* diff_by_scaled_ppm returns true if the difference is negative */
if (diff_by_scaled_ppm(1ULL << 35, scaled_ppm, &u64_delta))
lan743x_rate_adj = (u32)u64_delta;
else
lan743x_rate_adj = (u32)u64_delta | PTP_CLOCK_RATE_ADJ_DIR_;
lan743x_csr_write(adapter, PTP_CLOCK_RATE_ADJ,
lan743x_rate_adj);