1 /* Intel PRO/1000 Linux driver
2 * Copyright(c) 1999 - 2014 Intel Corporation.
4 * This program is free software; you can redistribute it and/or modify it
5 * under the terms and conditions of the GNU General Public License,
6 * version 2, as published by the Free Software Foundation.
8 * This program is distributed in the hope it will be useful, but WITHOUT
9 * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or
10 * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for
13 * The full GNU General Public License is included in this distribution in
14 * the file called "COPYING".
16 * Contact Information:
17 * Linux NICS <linux.nics@intel.com>
18 * e1000-devel Mailing List <e1000-devel@lists.sourceforge.net>
19 * Intel Corporation, 5200 N.E. Elam Young Parkway, Hillsboro, OR 97124-6497
22 /* PTP 1588 Hardware Clock (PHC)
23 * Derived from PTP Hardware Clock driver for Intel 82576 and 82580 (igb)
24 * Copyright (C) 2011 Richard Cochran <richardcochran@gmail.com>
30 * e1000e_phc_adjfreq - adjust the frequency of the hardware clock
31 * @ptp: ptp clock structure
32 * @delta: Desired frequency change in parts per billion
34 * Adjust the frequency of the PHC cycle counter by the indicated delta from
37 static int e1000e_phc_adjfreq(struct ptp_clock_info
*ptp
, s32 delta
)
39 struct e1000_adapter
*adapter
= container_of(ptp
, struct e1000_adapter
,
41 struct e1000_hw
*hw
= &adapter
->hw
;
45 u32 timinca
, incvalue
;
48 if ((delta
> ptp
->max_adj
) || (delta
<= -1000000000))
56 /* Get the System Time Register SYSTIM base frequency */
57 ret_val
= e1000e_get_base_timinca(adapter
, &timinca
);
61 spin_lock_irqsave(&adapter
->systim_lock
, flags
);
63 incvalue
= timinca
& E1000_TIMINCA_INCVALUE_MASK
;
65 adjustment
= incvalue
;
67 adjustment
= div_u64(adjustment
, 1000000000);
69 incvalue
= neg_adj
? (incvalue
- adjustment
) : (incvalue
+ adjustment
);
71 timinca
&= ~E1000_TIMINCA_INCVALUE_MASK
;
74 ew32(TIMINCA
, timinca
);
76 spin_unlock_irqrestore(&adapter
->systim_lock
, flags
);
82 * e1000e_phc_adjtime - Shift the time of the hardware clock
83 * @ptp: ptp clock structure
84 * @delta: Desired change in nanoseconds
86 * Adjust the timer by resetting the timecounter structure.
88 static int e1000e_phc_adjtime(struct ptp_clock_info
*ptp
, s64 delta
)
90 struct e1000_adapter
*adapter
= container_of(ptp
, struct e1000_adapter
,
94 spin_lock_irqsave(&adapter
->systim_lock
, flags
);
95 timecounter_adjtime(&adapter
->tc
, delta
);
96 spin_unlock_irqrestore(&adapter
->systim_lock
, flags
);
102 * e1000e_phc_gettime - Reads the current time from the hardware clock
103 * @ptp: ptp clock structure
104 * @ts: timespec structure to hold the current time value
106 * Read the timecounter and return the correct value in ns after converting
107 * it into a struct timespec.
109 static int e1000e_phc_gettime(struct ptp_clock_info
*ptp
, struct timespec64
*ts
)
111 struct e1000_adapter
*adapter
= container_of(ptp
, struct e1000_adapter
,
117 spin_lock_irqsave(&adapter
->systim_lock
, flags
);
118 ns
= timecounter_read(&adapter
->tc
);
119 spin_unlock_irqrestore(&adapter
->systim_lock
, flags
);
121 ts
->tv_sec
= div_u64_rem(ns
, NSEC_PER_SEC
, &remainder
);
122 ts
->tv_nsec
= remainder
;
128 * e1000e_phc_settime - Set the current time on the hardware clock
129 * @ptp: ptp clock structure
130 * @ts: timespec containing the new time for the cycle counter
132 * Reset the timecounter to use a new base value instead of the kernel
135 static int e1000e_phc_settime(struct ptp_clock_info
*ptp
,
136 const struct timespec64
*ts
)
138 struct e1000_adapter
*adapter
= container_of(ptp
, struct e1000_adapter
,
143 ns
= timespec64_to_ns(ts
);
145 /* reset the timecounter */
146 spin_lock_irqsave(&adapter
->systim_lock
, flags
);
147 timecounter_init(&adapter
->tc
, &adapter
->cc
, ns
);
148 spin_unlock_irqrestore(&adapter
->systim_lock
, flags
);
154 * e1000e_phc_enable - enable or disable an ancillary feature
155 * @ptp: ptp clock structure
156 * @request: Desired resource to enable or disable
157 * @on: Caller passes one to enable or zero to disable
159 * Enable (or disable) ancillary features of the PHC subsystem.
160 * Currently, no ancillary features are supported.
162 static int e1000e_phc_enable(struct ptp_clock_info __always_unused
*ptp
,
163 struct ptp_clock_request __always_unused
*request
,
164 int __always_unused on
)
169 static void e1000e_systim_overflow_work(struct work_struct
*work
)
171 struct e1000_adapter
*adapter
= container_of(work
, struct e1000_adapter
,
172 systim_overflow_work
.work
);
173 struct e1000_hw
*hw
= &adapter
->hw
;
174 struct timespec64 ts
;
176 adapter
->ptp_clock_info
.gettime64(&adapter
->ptp_clock_info
, &ts
);
178 e_dbg("SYSTIM overflow check at %lld.%09lu\n", ts
.tv_sec
, ts
.tv_nsec
);
180 schedule_delayed_work(&adapter
->systim_overflow_work
,
181 E1000_SYSTIM_OVERFLOW_PERIOD
);
184 static const struct ptp_clock_info e1000e_ptp_clock_info
= {
185 .owner
= THIS_MODULE
,
191 .adjfreq
= e1000e_phc_adjfreq
,
192 .adjtime
= e1000e_phc_adjtime
,
193 .gettime64
= e1000e_phc_gettime
,
194 .settime64
= e1000e_phc_settime
,
195 .enable
= e1000e_phc_enable
,
199 * e1000e_ptp_init - initialize PTP for devices which support it
200 * @adapter: board private structure
202 * This function performs the required steps for enabling PTP support.
203 * If PTP support has already been loaded it simply calls the cyclecounter
204 * init routine and exits.
206 void e1000e_ptp_init(struct e1000_adapter
*adapter
)
208 struct e1000_hw
*hw
= &adapter
->hw
;
210 adapter
->ptp_clock
= NULL
;
212 if (!(adapter
->flags
& FLAG_HAS_HW_TIMESTAMP
))
215 adapter
->ptp_clock_info
= e1000e_ptp_clock_info
;
217 snprintf(adapter
->ptp_clock_info
.name
,
218 sizeof(adapter
->ptp_clock_info
.name
), "%pm",
219 adapter
->netdev
->perm_addr
);
221 switch (hw
->mac
.type
) {
225 if (((hw
->mac
.type
!= e1000_pch_lpt
) &&
226 (hw
->mac
.type
!= e1000_pch_spt
)) ||
227 (er32(TSYNCRXCTL
) & E1000_TSYNCRXCTL_SYSCFI
)) {
228 adapter
->ptp_clock_info
.max_adj
= 24000000 - 1;
234 adapter
->ptp_clock_info
.max_adj
= 600000000 - 1;
240 INIT_DELAYED_WORK(&adapter
->systim_overflow_work
,
241 e1000e_systim_overflow_work
);
243 schedule_delayed_work(&adapter
->systim_overflow_work
,
244 E1000_SYSTIM_OVERFLOW_PERIOD
);
246 adapter
->ptp_clock
= ptp_clock_register(&adapter
->ptp_clock_info
,
247 &adapter
->pdev
->dev
);
248 if (IS_ERR(adapter
->ptp_clock
)) {
249 adapter
->ptp_clock
= NULL
;
250 e_err("ptp_clock_register failed\n");
252 e_info("registered PHC clock\n");
257 * e1000e_ptp_remove - disable PTP device and stop the overflow check
258 * @adapter: board private structure
260 * Stop the PTP support, and cancel the delayed work.
262 void e1000e_ptp_remove(struct e1000_adapter
*adapter
)
264 if (!(adapter
->flags
& FLAG_HAS_HW_TIMESTAMP
))
267 cancel_delayed_work_sync(&adapter
->systim_overflow_work
);
269 if (adapter
->ptp_clock
) {
270 ptp_clock_unregister(adapter
->ptp_clock
);
271 adapter
->ptp_clock
= NULL
;
272 e_info("removed PHC\n");