Lines Matching refs:dp83640
219 struct dp83640_private *dp83640 = phydev->priv; in ext_read() local
222 if (dp83640->clock->page != page) { in ext_read()
224 dp83640->clock->page = page; in ext_read()
235 struct dp83640_private *dp83640 = phydev->priv; in ext_write() local
237 if (dp83640->clock->page != page) { in ext_write()
239 dp83640->clock->page = page; in ext_write()
298 struct dp83640_private *dp83640 = clock->chosen; in periodic_output() local
299 struct phy_device *phydev = dp83640->phydev; in periodic_output()
542 struct dp83640_private *dp83640 = phydev->priv; in enable_status_frames() local
543 struct dp83640_clock *clock = dp83640->clock; in enable_status_frames()
590 static void prune_rx_ts(struct dp83640_private *dp83640) in prune_rx_ts() argument
595 list_for_each_safe(this, next, &dp83640->rxts) { in prune_rx_ts()
599 list_add(&rxts->list, &dp83640->rxpool); in prune_rx_ts()
739 static int decode_evnt(struct dp83640_private *dp83640, in decode_evnt() argument
767 dp83640->edata.sec_hi = phy_txts->sec_hi; in decode_evnt()
770 dp83640->edata.sec_lo = phy_txts->sec_lo; in decode_evnt()
773 dp83640->edata.ns_hi = phy_txts->ns_hi; in decode_evnt()
776 dp83640->edata.ns_lo = phy_txts->ns_lo; in decode_evnt()
785 event.timestamp = phy2txts(&dp83640->edata); in decode_evnt()
793 ptp_clock_event(dp83640->clock->ptp_clock, &event); in decode_evnt()
850 static void decode_rxts(struct dp83640_private *dp83640, in decode_rxts() argument
863 spin_lock_irqsave(&dp83640->rx_lock, flags); in decode_rxts()
865 prune_rx_ts(dp83640); in decode_rxts()
867 if (list_empty(&dp83640->rxpool)) { in decode_rxts()
871 rxts = list_first_entry(&dp83640->rxpool, struct rxts, list); in decode_rxts()
875 spin_lock(&dp83640->rx_queue.lock); in decode_rxts()
876 skb_queue_walk(&dp83640->rx_queue, skb) { in decode_rxts()
881 __skb_unlink(skb, &dp83640->rx_queue); in decode_rxts()
885 list_add(&rxts->list, &dp83640->rxpool); in decode_rxts()
889 spin_unlock(&dp83640->rx_queue.lock); in decode_rxts()
892 list_add_tail(&rxts->list, &dp83640->rxts); in decode_rxts()
894 spin_unlock_irqrestore(&dp83640->rx_lock, flags); in decode_rxts()
900 static void decode_txts(struct dp83640_private *dp83640, in decode_txts() argument
911 skb = skb_dequeue(&dp83640->tx_queue); in decode_txts()
922 skb = skb_dequeue(&dp83640->tx_queue); in decode_txts()
938 static void decode_status_frame(struct dp83640_private *dp83640, in decode_status_frame() argument
960 decode_rxts(dp83640, phy_rxts); in decode_status_frame()
966 decode_txts(dp83640, phy_txts); in decode_status_frame()
971 size = decode_evnt(dp83640, ptr, len, ests); in decode_status_frame()
1137 struct dp83640_private *dp83640; in dp83640_probe() local
1147 dp83640 = kzalloc(sizeof(struct dp83640_private), GFP_KERNEL); in dp83640_probe()
1148 if (!dp83640) in dp83640_probe()
1151 dp83640->phydev = phydev; in dp83640_probe()
1152 INIT_DELAYED_WORK(&dp83640->ts_work, rx_timestamp_work); in dp83640_probe()
1154 INIT_LIST_HEAD(&dp83640->rxts); in dp83640_probe()
1155 INIT_LIST_HEAD(&dp83640->rxpool); in dp83640_probe()
1157 list_add(&dp83640->rx_pool_data[i].list, &dp83640->rxpool); in dp83640_probe()
1159 phydev->priv = dp83640; in dp83640_probe()
1161 spin_lock_init(&dp83640->rx_lock); in dp83640_probe()
1162 skb_queue_head_init(&dp83640->rx_queue); in dp83640_probe()
1163 skb_queue_head_init(&dp83640->tx_queue); in dp83640_probe()
1165 dp83640->clock = clock; in dp83640_probe()
1168 clock->chosen = dp83640; in dp83640_probe()
1176 list_add_tail(&dp83640->list, &clock->phylist); in dp83640_probe()
1183 kfree(dp83640); in dp83640_probe()
1194 struct dp83640_private *tmp, *dp83640 = phydev->priv; in dp83640_remove() local
1200 cancel_delayed_work_sync(&dp83640->ts_work); in dp83640_remove()
1202 skb_queue_purge(&dp83640->rx_queue); in dp83640_remove()
1203 skb_queue_purge(&dp83640->tx_queue); in dp83640_remove()
1205 clock = dp83640_clock_get(dp83640->clock); in dp83640_remove()
1207 if (dp83640 == clock->chosen) { in dp83640_remove()
1213 if (tmp == dp83640) { in dp83640_remove()
1221 kfree(dp83640); in dp83640_remove()
1243 struct dp83640_private *dp83640 = phydev->priv; in dp83640_config_init() local
1244 struct dp83640_clock *clock = dp83640->clock; in dp83640_config_init()
1324 struct dp83640_private *dp83640 = phydev->priv; in dp83640_hwtstamp() local
1337 dp83640->hwts_tx_en = cfg.tx_type; in dp83640_hwtstamp()
1341 dp83640->hwts_rx_en = 0; in dp83640_hwtstamp()
1342 dp83640->layer = 0; in dp83640_hwtstamp()
1343 dp83640->version = 0; in dp83640_hwtstamp()
1348 dp83640->hwts_rx_en = 1; in dp83640_hwtstamp()
1349 dp83640->layer = PTP_CLASS_L4; in dp83640_hwtstamp()
1350 dp83640->version = PTP_CLASS_V1; in dp83640_hwtstamp()
1355 dp83640->hwts_rx_en = 1; in dp83640_hwtstamp()
1356 dp83640->layer = PTP_CLASS_L4; in dp83640_hwtstamp()
1357 dp83640->version = PTP_CLASS_V2; in dp83640_hwtstamp()
1362 dp83640->hwts_rx_en = 1; in dp83640_hwtstamp()
1363 dp83640->layer = PTP_CLASS_L2; in dp83640_hwtstamp()
1364 dp83640->version = PTP_CLASS_V2; in dp83640_hwtstamp()
1369 dp83640->hwts_rx_en = 1; in dp83640_hwtstamp()
1370 dp83640->layer = PTP_CLASS_L4 | PTP_CLASS_L2; in dp83640_hwtstamp()
1371 dp83640->version = PTP_CLASS_V2; in dp83640_hwtstamp()
1377 txcfg0 = (dp83640->version & TX_PTP_VER_MASK) << TX_PTP_VER_SHIFT; in dp83640_hwtstamp()
1378 rxcfg0 = (dp83640->version & TX_PTP_VER_MASK) << TX_PTP_VER_SHIFT; in dp83640_hwtstamp()
1380 if (dp83640->layer & PTP_CLASS_L2) { in dp83640_hwtstamp()
1384 if (dp83640->layer & PTP_CLASS_L4) { in dp83640_hwtstamp()
1389 if (dp83640->hwts_tx_en) in dp83640_hwtstamp()
1392 if (dp83640->hwts_tx_en == HWTSTAMP_TX_ONESTEP_SYNC) in dp83640_hwtstamp()
1395 if (dp83640->hwts_rx_en) in dp83640_hwtstamp()
1398 mutex_lock(&dp83640->clock->extreg_lock); in dp83640_hwtstamp()
1403 mutex_unlock(&dp83640->clock->extreg_lock); in dp83640_hwtstamp()
1410 struct dp83640_private *dp83640 = in rx_timestamp_work() local
1415 while ((skb = skb_dequeue(&dp83640->rx_queue))) { in rx_timestamp_work()
1420 skb_queue_head(&dp83640->rx_queue, skb); in rx_timestamp_work()
1427 if (!skb_queue_empty(&dp83640->rx_queue)) in rx_timestamp_work()
1428 schedule_delayed_work(&dp83640->ts_work, SKB_TIMESTAMP_TIMEOUT); in rx_timestamp_work()
1434 struct dp83640_private *dp83640 = phydev->priv; in dp83640_rxtstamp() local
1442 decode_status_frame(dp83640, skb); in dp83640_rxtstamp()
1447 if (!dp83640->hwts_rx_en) in dp83640_rxtstamp()
1450 if ((type & dp83640->version) == 0 || (type & dp83640->layer) == 0) in dp83640_rxtstamp()
1453 spin_lock_irqsave(&dp83640->rx_lock, flags); in dp83640_rxtstamp()
1454 prune_rx_ts(dp83640); in dp83640_rxtstamp()
1455 list_for_each_safe(this, next, &dp83640->rxts) { in dp83640_rxtstamp()
1462 list_add(&rxts->list, &dp83640->rxpool); in dp83640_rxtstamp()
1466 spin_unlock_irqrestore(&dp83640->rx_lock, flags); in dp83640_rxtstamp()
1471 skb_queue_tail(&dp83640->rx_queue, skb); in dp83640_rxtstamp()
1472 schedule_delayed_work(&dp83640->ts_work, SKB_TIMESTAMP_TIMEOUT); in dp83640_rxtstamp()
1484 struct dp83640_private *dp83640 = phydev->priv; in dp83640_txtstamp() local
1486 switch (dp83640->hwts_tx_en) { in dp83640_txtstamp()
1497 skb_queue_tail(&dp83640->tx_queue, skb); in dp83640_txtstamp()
1509 struct dp83640_private *dp83640 = dev->priv; in dp83640_ts_info() local
1515 info->phc_index = ptp_clock_index(dp83640->clock->ptp_clock); in dp83640_ts_info()