Lines Matching refs:dp83640
231 struct dp83640_private *dp83640 = phydev->priv; in ext_read() local
234 if (dp83640->clock->page != page) { in ext_read()
236 dp83640->clock->page = page; in ext_read()
247 struct dp83640_private *dp83640 = phydev->priv; in ext_write() local
249 if (dp83640->clock->page != page) { in ext_write()
251 dp83640->clock->page = page; in ext_write()
310 struct dp83640_private *dp83640 = clock->chosen; in periodic_output() local
311 struct phy_device *phydev = dp83640->phydev; in periodic_output()
538 struct dp83640_private *dp83640 = phydev->priv; in enable_status_frames() local
539 struct dp83640_clock *clock = dp83640->clock; in enable_status_frames()
585 static void prune_rx_ts(struct dp83640_private *dp83640) in prune_rx_ts() argument
590 list_for_each_safe(this, next, &dp83640->rxts) { in prune_rx_ts()
594 list_add(&rxts->list, &dp83640->rxpool); in prune_rx_ts()
733 static int decode_evnt(struct dp83640_private *dp83640, in decode_evnt() argument
761 dp83640->edata.sec_hi = phy_txts->sec_hi; in decode_evnt()
763 dp83640->edata.sec_lo = phy_txts->sec_lo; in decode_evnt()
765 dp83640->edata.ns_hi = phy_txts->ns_hi; in decode_evnt()
767 dp83640->edata.ns_lo = phy_txts->ns_lo; in decode_evnt()
776 event.timestamp = phy2txts(&dp83640->edata); in decode_evnt()
784 ptp_clock_event(dp83640->clock->ptp_clock, &event); in decode_evnt()
841 static void decode_rxts(struct dp83640_private *dp83640, in decode_rxts() argument
854 spin_lock_irqsave(&dp83640->rx_lock, flags); in decode_rxts()
856 prune_rx_ts(dp83640); in decode_rxts()
858 if (list_empty(&dp83640->rxpool)) { in decode_rxts()
862 rxts = list_first_entry(&dp83640->rxpool, struct rxts, list); in decode_rxts()
866 spin_lock(&dp83640->rx_queue.lock); in decode_rxts()
867 skb_queue_walk(&dp83640->rx_queue, skb) { in decode_rxts()
872 __skb_unlink(skb, &dp83640->rx_queue); in decode_rxts()
877 list_add(&rxts->list, &dp83640->rxpool); in decode_rxts()
881 spin_unlock(&dp83640->rx_queue.lock); in decode_rxts()
884 list_add_tail(&rxts->list, &dp83640->rxts); in decode_rxts()
886 spin_unlock_irqrestore(&dp83640->rx_lock, flags); in decode_rxts()
889 static void decode_txts(struct dp83640_private *dp83640, in decode_txts() argument
899 skb = skb_dequeue(&dp83640->tx_queue); in decode_txts()
911 skb = skb_dequeue(&dp83640->tx_queue); in decode_txts()
922 static void decode_status_frame(struct dp83640_private *dp83640, in decode_status_frame() argument
944 decode_rxts(dp83640, phy_rxts); in decode_status_frame()
950 decode_txts(dp83640, phy_txts); in decode_status_frame()
955 size = decode_evnt(dp83640, ptr, len, ests); in decode_status_frame()
1120 struct dp83640_private *dp83640; in dp83640_probe() local
1130 dp83640 = kzalloc(sizeof(struct dp83640_private), GFP_KERNEL); in dp83640_probe()
1131 if (!dp83640) in dp83640_probe()
1134 dp83640->phydev = phydev; in dp83640_probe()
1135 INIT_DELAYED_WORK(&dp83640->ts_work, rx_timestamp_work); in dp83640_probe()
1137 INIT_LIST_HEAD(&dp83640->rxts); in dp83640_probe()
1138 INIT_LIST_HEAD(&dp83640->rxpool); in dp83640_probe()
1140 list_add(&dp83640->rx_pool_data[i].list, &dp83640->rxpool); in dp83640_probe()
1142 phydev->priv = dp83640; in dp83640_probe()
1144 spin_lock_init(&dp83640->rx_lock); in dp83640_probe()
1145 skb_queue_head_init(&dp83640->rx_queue); in dp83640_probe()
1146 skb_queue_head_init(&dp83640->tx_queue); in dp83640_probe()
1148 dp83640->clock = clock; in dp83640_probe()
1151 clock->chosen = dp83640; in dp83640_probe()
1158 list_add_tail(&dp83640->list, &clock->phylist); in dp83640_probe()
1165 kfree(dp83640); in dp83640_probe()
1176 struct dp83640_private *tmp, *dp83640 = phydev->priv; in dp83640_remove() local
1182 cancel_delayed_work_sync(&dp83640->ts_work); in dp83640_remove()
1184 skb_queue_purge(&dp83640->rx_queue); in dp83640_remove()
1185 skb_queue_purge(&dp83640->tx_queue); in dp83640_remove()
1187 clock = dp83640_clock_get(dp83640->clock); in dp83640_remove()
1189 if (dp83640 == clock->chosen) { in dp83640_remove()
1195 if (tmp == dp83640) { in dp83640_remove()
1203 kfree(dp83640); in dp83640_remove()
1208 struct dp83640_private *dp83640 = phydev->priv; in dp83640_config_init() local
1209 struct dp83640_clock *clock = dp83640->clock; in dp83640_config_init()
1289 struct dp83640_private *dp83640 = phydev->priv; in dp83640_hwtstamp() local
1302 dp83640->hwts_tx_en = cfg.tx_type; in dp83640_hwtstamp()
1306 dp83640->hwts_rx_en = 0; in dp83640_hwtstamp()
1307 dp83640->layer = 0; in dp83640_hwtstamp()
1308 dp83640->version = 0; in dp83640_hwtstamp()
1313 dp83640->hwts_rx_en = 1; in dp83640_hwtstamp()
1314 dp83640->layer = PTP_CLASS_L4; in dp83640_hwtstamp()
1315 dp83640->version = PTP_CLASS_V1; in dp83640_hwtstamp()
1320 dp83640->hwts_rx_en = 1; in dp83640_hwtstamp()
1321 dp83640->layer = PTP_CLASS_L4; in dp83640_hwtstamp()
1322 dp83640->version = PTP_CLASS_V2; in dp83640_hwtstamp()
1327 dp83640->hwts_rx_en = 1; in dp83640_hwtstamp()
1328 dp83640->layer = PTP_CLASS_L2; in dp83640_hwtstamp()
1329 dp83640->version = PTP_CLASS_V2; in dp83640_hwtstamp()
1334 dp83640->hwts_rx_en = 1; in dp83640_hwtstamp()
1335 dp83640->layer = PTP_CLASS_L4 | PTP_CLASS_L2; in dp83640_hwtstamp()
1336 dp83640->version = PTP_CLASS_V2; in dp83640_hwtstamp()
1342 txcfg0 = (dp83640->version & TX_PTP_VER_MASK) << TX_PTP_VER_SHIFT; in dp83640_hwtstamp()
1343 rxcfg0 = (dp83640->version & TX_PTP_VER_MASK) << TX_PTP_VER_SHIFT; in dp83640_hwtstamp()
1345 if (dp83640->layer & PTP_CLASS_L2) { in dp83640_hwtstamp()
1349 if (dp83640->layer & PTP_CLASS_L4) { in dp83640_hwtstamp()
1354 if (dp83640->hwts_tx_en) in dp83640_hwtstamp()
1357 if (dp83640->hwts_tx_en == HWTSTAMP_TX_ONESTEP_SYNC) in dp83640_hwtstamp()
1360 if (dp83640->hwts_rx_en) in dp83640_hwtstamp()
1363 mutex_lock(&dp83640->clock->extreg_lock); in dp83640_hwtstamp()
1368 mutex_unlock(&dp83640->clock->extreg_lock); in dp83640_hwtstamp()
1375 struct dp83640_private *dp83640 = in rx_timestamp_work() local
1380 while ((skb = skb_dequeue(&dp83640->rx_queue))) { in rx_timestamp_work()
1385 skb_queue_head(&dp83640->rx_queue, skb); in rx_timestamp_work()
1392 if (!skb_queue_empty(&dp83640->rx_queue)) in rx_timestamp_work()
1393 schedule_delayed_work(&dp83640->ts_work, SKB_TIMESTAMP_TIMEOUT); in rx_timestamp_work()
1399 struct dp83640_private *dp83640 = phydev->priv; in dp83640_rxtstamp() local
1407 decode_status_frame(dp83640, skb); in dp83640_rxtstamp()
1412 if (!dp83640->hwts_rx_en) in dp83640_rxtstamp()
1415 if ((type & dp83640->version) == 0 || (type & dp83640->layer) == 0) in dp83640_rxtstamp()
1418 spin_lock_irqsave(&dp83640->rx_lock, flags); in dp83640_rxtstamp()
1419 prune_rx_ts(dp83640); in dp83640_rxtstamp()
1420 list_for_each_safe(this, next, &dp83640->rxts) { in dp83640_rxtstamp()
1428 list_add(&rxts->list, &dp83640->rxpool); in dp83640_rxtstamp()
1432 spin_unlock_irqrestore(&dp83640->rx_lock, flags); in dp83640_rxtstamp()
1437 skb_queue_tail(&dp83640->rx_queue, skb); in dp83640_rxtstamp()
1438 schedule_delayed_work(&dp83640->ts_work, SKB_TIMESTAMP_TIMEOUT); in dp83640_rxtstamp()
1449 struct dp83640_private *dp83640 = phydev->priv; in dp83640_txtstamp() local
1451 switch (dp83640->hwts_tx_en) { in dp83640_txtstamp()
1461 skb_queue_tail(&dp83640->tx_queue, skb); in dp83640_txtstamp()
1473 struct dp83640_private *dp83640 = dev->priv; in dp83640_ts_info() local
1479 info->phc_index = ptp_clock_index(dp83640->clock->ptp_clock); in dp83640_ts_info()