ethernet/engleder/tsnep_ptp.c

6 void tsnep_get_system_time(struct tsnep_adapter *adapter, u64 *time)
13 	high = ioread32(adapter->addr + ECM_SYSTEM_TIME_HIGH);
15 		low = ioread32(adapter->addr + ECM_SYSTEM_TIME_LOW);
17 		high = ioread32(adapter->addr + ECM_SYSTEM_TIME_HIGH);
24 	struct tsnep_adapter *adapter = netdev_priv(netdev);
65 		memcpy(&adapter->hwtstamp_config, &config,
66 		       sizeof(adapter->hwtstamp_config));
69 	if (copy_to_user(ifr->ifr_data, &adapter->hwtstamp_config,
70 			 sizeof(adapter->hwtstamp_config)))
78 	struct tsnep_adapter *adapter = container_of(ptp, struct tsnep_adapter,
99 	iowrite32(rate_offset & 0xFFFFFFFF, adapter->addr + ECM_CLOCK_RATE);
106 	struct tsnep_adapter *adapter = container_of(ptp, struct tsnep_adapter,
111 	spin_lock_irqsave(&adapter->ptp_lock, flags);
113 	tsnep_get_system_time(adapter, &system_time);
120 	iowrite32(system_time >> 32, adapter->addr + ECM_SYSTEM_TIME_HIGH);
122 		  adapter->addr + ECM_SYSTEM_TIME_LOW);
124 	spin_unlock_irqrestore(&adapter->ptp_lock, flags);
133 	struct tsnep_adapter *adapter = container_of(ptp, struct tsnep_adapter,
141 	high = ioread32(adapter->addr + ECM_SYSTEM_TIME_HIGH);
144 		low = ioread32(adapter->addr + ECM_SYSTEM_TIME_LOW);
147 		high = ioread32(adapter->addr + ECM_SYSTEM_TIME_HIGH);
159 	struct tsnep_adapter *adapter = container_of(ptp, struct tsnep_adapter,
164 	spin_lock_irqsave(&adapter->ptp_lock, flags);
169 	iowrite32(system_time >> 32, adapter->addr + ECM_SYSTEM_TIME_HIGH);
171 		  adapter->addr + ECM_SYSTEM_TIME_LOW);
173 	spin_unlock_irqrestore(&adapter->ptp_lock, flags);
182 	struct tsnep_adapter *adapter = container_of(ptp, struct tsnep_adapter,
190 	high = ioread32(adapter->addr + ECM_COUNTER_HIGH);
193 		low = ioread32(adapter->addr + ECM_COUNTER_LOW);
196 		high = ioread32(adapter->addr + ECM_COUNTER_HIGH);
205 int tsnep_ptp_init(struct tsnep_adapter *adapter)
209 	adapter->hwtstamp_config.rx_filter = HWTSTAMP_FILTER_NONE;
210 	adapter->hwtstamp_config.tx_type = HWTSTAMP_TX_OFF;
212 	snprintf(adapter->ptp_clock_info.name, 16, "%s", TSNEP);
213 	adapter->ptp_clock_info.owner = THIS_MODULE;
217 	adapter->ptp_clock_info.max_adj = (500000000 / 8 - 1);
218 	adapter->ptp_clock_info.adjfine = tsnep_ptp_adjfine;
219 	adapter->ptp_clock_info.adjtime = tsnep_ptp_adjtime;
220 	adapter->ptp_clock_info.gettimex64 = tsnep_ptp_gettimex64;
221 	adapter->ptp_clock_info.settime64 = tsnep_ptp_settime64;
222 	adapter->ptp_clock_info.getcyclesx64 = tsnep_ptp_getcyclesx64;
224 	spin_lock_init(&adapter->ptp_lock);
226 	adapter->ptp_clock = ptp_clock_register(&adapter->ptp_clock_info,
227 						&adapter->pdev->dev);
228 	if (IS_ERR(adapter->ptp_clock)) {
229 		netdev_err(adapter->netdev, "ptp_clock_register failed\n");
231 		retval = PTR_ERR(adapter->ptp_clock);
232 		adapter->ptp_clock = NULL;
233 	} else if (adapter->ptp_clock) {
234 		netdev_info(adapter->netdev, "PHC added\n");
240 void tsnep_ptp_cleanup(struct tsnep_adapter *adapter)
242 	if (adapter->ptp_clock) {
243 		ptp_clock_unregister(adapter->ptp_clock);
244 		netdev_info(adapter->netdev, "PHC removed\n");