Lines Matching refs:dp83640
220 struct dp83640_private *dp83640 = phydev->priv; in ext_read() local
223 if (dp83640->clock->page != page) { in ext_read()
225 dp83640->clock->page = page; in ext_read()
236 struct dp83640_private *dp83640 = phydev->priv; in ext_write() local
238 if (dp83640->clock->page != page) { in ext_write()
240 dp83640->clock->page = page; in ext_write()
299 struct dp83640_private *dp83640 = clock->chosen; in periodic_output() local
300 struct phy_device *phydev = dp83640->phydev; in periodic_output()
543 struct dp83640_private *dp83640 = phydev->priv; in enable_status_frames() local
544 struct dp83640_clock *clock = dp83640->clock; in enable_status_frames()
591 static void prune_rx_ts(struct dp83640_private *dp83640) in prune_rx_ts() argument
596 list_for_each_safe(this, next, &dp83640->rxts) { in prune_rx_ts()
600 list_add(&rxts->list, &dp83640->rxpool); in prune_rx_ts()
740 static int decode_evnt(struct dp83640_private *dp83640, in decode_evnt() argument
768 dp83640->edata.sec_hi = phy_txts->sec_hi; in decode_evnt()
771 dp83640->edata.sec_lo = phy_txts->sec_lo; in decode_evnt()
774 dp83640->edata.ns_hi = phy_txts->ns_hi; in decode_evnt()
777 dp83640->edata.ns_lo = phy_txts->ns_lo; in decode_evnt()
786 event.timestamp = phy2txts(&dp83640->edata); in decode_evnt()
794 ptp_clock_event(dp83640->clock->ptp_clock, &event); in decode_evnt()
833 static void decode_rxts(struct dp83640_private *dp83640, in decode_rxts() argument
846 spin_lock_irqsave(&dp83640->rx_lock, flags); in decode_rxts()
848 prune_rx_ts(dp83640); in decode_rxts()
850 if (list_empty(&dp83640->rxpool)) { in decode_rxts()
854 rxts = list_first_entry(&dp83640->rxpool, struct rxts, list); in decode_rxts()
858 spin_lock(&dp83640->rx_queue.lock); in decode_rxts()
859 skb_queue_walk(&dp83640->rx_queue, skb) { in decode_rxts()
864 __skb_unlink(skb, &dp83640->rx_queue); in decode_rxts()
868 list_add(&rxts->list, &dp83640->rxpool); in decode_rxts()
872 spin_unlock(&dp83640->rx_queue.lock); in decode_rxts()
875 list_add_tail(&rxts->list, &dp83640->rxts); in decode_rxts()
877 spin_unlock_irqrestore(&dp83640->rx_lock, flags); in decode_rxts()
883 static void decode_txts(struct dp83640_private *dp83640, in decode_txts() argument
894 skb = skb_dequeue(&dp83640->tx_queue); in decode_txts()
905 skb = skb_dequeue(&dp83640->tx_queue); in decode_txts()
921 static void decode_status_frame(struct dp83640_private *dp83640, in decode_status_frame() argument
943 decode_rxts(dp83640, phy_rxts); in decode_status_frame()
949 decode_txts(dp83640, phy_txts); in decode_status_frame()
954 size = decode_evnt(dp83640, ptr, len, ests); in decode_status_frame()
1117 struct dp83640_private *dp83640 = phydev->priv; in dp83640_config_init() local
1118 struct dp83640_clock *clock = dp83640->clock; in dp83640_config_init()
1198 struct dp83640_private *dp83640 = in dp83640_hwtstamp() local
1212 dp83640->hwts_tx_en = cfg.tx_type; in dp83640_hwtstamp()
1216 dp83640->hwts_rx_en = 0; in dp83640_hwtstamp()
1217 dp83640->layer = 0; in dp83640_hwtstamp()
1218 dp83640->version = 0; in dp83640_hwtstamp()
1223 dp83640->hwts_rx_en = 1; in dp83640_hwtstamp()
1224 dp83640->layer = PTP_CLASS_L4; in dp83640_hwtstamp()
1225 dp83640->version = PTP_CLASS_V1; in dp83640_hwtstamp()
1231 dp83640->hwts_rx_en = 1; in dp83640_hwtstamp()
1232 dp83640->layer = PTP_CLASS_L4; in dp83640_hwtstamp()
1233 dp83640->version = PTP_CLASS_V2; in dp83640_hwtstamp()
1239 dp83640->hwts_rx_en = 1; in dp83640_hwtstamp()
1240 dp83640->layer = PTP_CLASS_L2; in dp83640_hwtstamp()
1241 dp83640->version = PTP_CLASS_V2; in dp83640_hwtstamp()
1247 dp83640->hwts_rx_en = 1; in dp83640_hwtstamp()
1248 dp83640->layer = PTP_CLASS_L4 | PTP_CLASS_L2; in dp83640_hwtstamp()
1249 dp83640->version = PTP_CLASS_V2; in dp83640_hwtstamp()
1256 txcfg0 = (dp83640->version & TX_PTP_VER_MASK) << TX_PTP_VER_SHIFT; in dp83640_hwtstamp()
1257 rxcfg0 = (dp83640->version & TX_PTP_VER_MASK) << TX_PTP_VER_SHIFT; in dp83640_hwtstamp()
1259 if (dp83640->layer & PTP_CLASS_L2) { in dp83640_hwtstamp()
1263 if (dp83640->layer & PTP_CLASS_L4) { in dp83640_hwtstamp()
1268 if (dp83640->hwts_tx_en) in dp83640_hwtstamp()
1271 if (dp83640->hwts_tx_en == HWTSTAMP_TX_ONESTEP_SYNC) in dp83640_hwtstamp()
1274 if (dp83640->hwts_rx_en) in dp83640_hwtstamp()
1277 mutex_lock(&dp83640->clock->extreg_lock); in dp83640_hwtstamp()
1279 ext_write(0, dp83640->phydev, PAGE5, PTP_TXCFG0, txcfg0); in dp83640_hwtstamp()
1280 ext_write(0, dp83640->phydev, PAGE5, PTP_RXCFG0, rxcfg0); in dp83640_hwtstamp()
1282 mutex_unlock(&dp83640->clock->extreg_lock); in dp83640_hwtstamp()
1289 struct dp83640_private *dp83640 = in rx_timestamp_work() local
1294 while ((skb = skb_dequeue(&dp83640->rx_queue))) { in rx_timestamp_work()
1299 skb_queue_head(&dp83640->rx_queue, skb); in rx_timestamp_work()
1306 if (!skb_queue_empty(&dp83640->rx_queue)) in rx_timestamp_work()
1307 schedule_delayed_work(&dp83640->ts_work, SKB_TIMESTAMP_TIMEOUT); in rx_timestamp_work()
1313 struct dp83640_private *dp83640 = in dp83640_rxtstamp() local
1322 decode_status_frame(dp83640, skb); in dp83640_rxtstamp()
1327 if (!dp83640->hwts_rx_en) in dp83640_rxtstamp()
1330 if ((type & dp83640->version) == 0 || (type & dp83640->layer) == 0) in dp83640_rxtstamp()
1333 spin_lock_irqsave(&dp83640->rx_lock, flags); in dp83640_rxtstamp()
1334 prune_rx_ts(dp83640); in dp83640_rxtstamp()
1335 list_for_each_safe(this, next, &dp83640->rxts) { in dp83640_rxtstamp()
1342 list_add(&rxts->list, &dp83640->rxpool); in dp83640_rxtstamp()
1346 spin_unlock_irqrestore(&dp83640->rx_lock, flags); in dp83640_rxtstamp()
1351 skb_queue_tail(&dp83640->rx_queue, skb); in dp83640_rxtstamp()
1352 schedule_delayed_work(&dp83640->ts_work, SKB_TIMESTAMP_TIMEOUT); in dp83640_rxtstamp()
1364 struct dp83640_private *dp83640 = in dp83640_txtstamp() local
1367 switch (dp83640->hwts_tx_en) { in dp83640_txtstamp()
1378 skb_queue_tail(&dp83640->tx_queue, skb); in dp83640_txtstamp()
1391 struct dp83640_private *dp83640 = in dp83640_ts_info() local
1398 info->phc_index = ptp_clock_index(dp83640->clock->ptp_clock); in dp83640_ts_info()
1415 struct dp83640_private *dp83640; in dp83640_probe() local
1425 dp83640 = kzalloc(sizeof(struct dp83640_private), GFP_KERNEL); in dp83640_probe()
1426 if (!dp83640) in dp83640_probe()
1429 dp83640->phydev = phydev; in dp83640_probe()
1430 dp83640->mii_ts.rxtstamp = dp83640_rxtstamp; in dp83640_probe()
1431 dp83640->mii_ts.txtstamp = dp83640_txtstamp; in dp83640_probe()
1432 dp83640->mii_ts.hwtstamp = dp83640_hwtstamp; in dp83640_probe()
1433 dp83640->mii_ts.ts_info = dp83640_ts_info; in dp83640_probe()
1435 INIT_DELAYED_WORK(&dp83640->ts_work, rx_timestamp_work); in dp83640_probe()
1436 INIT_LIST_HEAD(&dp83640->rxts); in dp83640_probe()
1437 INIT_LIST_HEAD(&dp83640->rxpool); in dp83640_probe()
1439 list_add(&dp83640->rx_pool_data[i].list, &dp83640->rxpool); in dp83640_probe()
1441 phydev->mii_ts = &dp83640->mii_ts; in dp83640_probe()
1442 phydev->priv = dp83640; in dp83640_probe()
1444 spin_lock_init(&dp83640->rx_lock); in dp83640_probe()
1445 skb_queue_head_init(&dp83640->rx_queue); in dp83640_probe()
1446 skb_queue_head_init(&dp83640->tx_queue); in dp83640_probe()
1448 dp83640->clock = clock; in dp83640_probe()
1451 clock->chosen = dp83640; in dp83640_probe()
1459 list_add_tail(&dp83640->list, &clock->phylist); in dp83640_probe()
1466 kfree(dp83640); in dp83640_probe()
1477 struct dp83640_private *tmp, *dp83640 = phydev->priv; in dp83640_remove() local
1485 cancel_delayed_work_sync(&dp83640->ts_work); in dp83640_remove()
1487 skb_queue_purge(&dp83640->rx_queue); in dp83640_remove()
1488 skb_queue_purge(&dp83640->tx_queue); in dp83640_remove()
1490 clock = dp83640_clock_get(dp83640->clock); in dp83640_remove()
1492 if (dp83640 == clock->chosen) { in dp83640_remove()
1498 if (tmp == dp83640) { in dp83640_remove()
1506 kfree(dp83640); in dp83640_remove()