Lines Matching +full:extts +full:- +full:fifo
1 // SPDX-License-Identifier: GPL-2.0+
9 * Copyright (c) 2010-2013 Micrel, Inc.
126 * The value is calculated as following: (1/1000000)/((2^-32)/4)
132 * The value is calculated as following: (1/1000000)/((2^-32)/8)
413 /* Lock for Rx ts fifo */
527 const struct kszphy_type *type = phydev->drv->driver_data; in kszphy_config_intr()
531 if (type && type->interrupt_level_mask) in kszphy_config_intr()
532 mask = type->interrupt_level_mask; in kszphy_config_intr()
544 if (phydev->interrupts == PHY_INTERRUPT_ENABLED) { in kszphy_config_intr()
607 return -EINVAL; in kszphy_setup_led()
627 * unique (non-broadcast) address on a shared bus.
668 struct kszphy_priv *priv = phydev->priv; in kszphy_config_reset()
671 if (priv->rmii_ref_clk_sel) { in kszphy_config_reset()
672 ret = kszphy_rmii_clk_sel(phydev, priv->rmii_ref_clk_sel_val); in kszphy_config_reset()
680 if (priv->type && priv->led_mode >= 0) in kszphy_config_reset()
681 kszphy_setup_led(phydev, priv->type->led_mode_reg, priv->led_mode); in kszphy_config_reset()
688 struct kszphy_priv *priv = phydev->priv; in kszphy_config_init()
694 type = priv->type; in kszphy_config_init()
696 if (type && type->has_broadcast_disable) in kszphy_config_init()
699 if (type && type->has_nand_tree_disable) in kszphy_config_init()
707 struct device_node *of_node = phydev->mdio.dev.of_node; in ksz8041_fiber_mode()
709 return of_property_read_bool(of_node, "micrel,fiber-mode"); in ksz8041_fiber_mode()
718 phydev->dev_flags |= MICREL_PHY_FXEN; in ksz8041_config_init()
722 linkmode_and(phydev->supported, phydev->supported, mask); in ksz8041_config_init()
724 phydev->supported); in ksz8041_config_init()
725 linkmode_and(phydev->advertising, phydev->advertising, mask); in ksz8041_config_init()
727 phydev->advertising); in ksz8041_config_init()
728 phydev->autoneg = AUTONEG_DISABLE; in ksz8041_config_init()
736 /* Skip auto-negotiation in fiber mode */ in ksz8041_config_aneg()
737 if (phydev->dev_flags & MICREL_PHY_FXEN) { in ksz8041_config_aneg()
738 phydev->speed = SPEED_100; in ksz8041_config_aneg()
750 if (!phy_id_compare(phydev->phy_id, PHY_ID_KSZ8051, MICREL_PHY_ID_MASK)) in ksz8051_ksz8795_match_phy_device()
776 /* KSZPHY_OMSO_FACTORY_TEST is set at de-assertion of the reset line in ksz8081_config_init()
778 * pull-down is missing, the factory test mode should be cleared by in ksz8081_config_init()
820 /* The MDI-X configuration is automatically changed by the PHY after in ksz8081_config_aneg()
821 * switching from autoneg off to on. So, take MDI-X configuration under in ksz8081_config_aneg()
824 return ksz8081_config_mdix(phydev, phydev->mdix_ctrl); in ksz8081_config_aneg()
837 phydev->mdix_ctrl = ETH_TP_MDI_X; in ksz8081_mdix_update()
839 phydev->mdix_ctrl = ETH_TP_MDI; in ksz8081_mdix_update()
841 phydev->mdix_ctrl = ETH_TP_MDI_AUTO; in ksz8081_mdix_update()
849 phydev->mdix = ETH_TP_MDI; in ksz8081_mdix_update()
851 phydev->mdix = ETH_TP_MDI_X; in ksz8081_mdix_update()
900 int val1 = -1; in ksz9021_load_values_from_of()
901 int val2 = -2; in ksz9021_load_values_from_of()
902 int val3 = -3; in ksz9021_load_values_from_of()
903 int val4 = -4; in ksz9021_load_values_from_of()
927 if (val1 != -1) in ksz9021_load_values_from_of()
930 if (val2 != -2) in ksz9021_load_values_from_of()
933 if (val3 != -3) in ksz9021_load_values_from_of()
936 if (val4 != -4) in ksz9021_load_values_from_of()
951 dev_walker = &phydev->mdio.dev; in ksz9021_config_init()
953 of_node = dev_walker->of_node; in ksz9021_config_init()
954 dev_walker = dev_walker->parent; in ksz9021_config_init()
961 "txen-skew-ps", "txc-skew-ps", in ksz9021_config_init()
962 "rxdv-skew-ps", "rxc-skew-ps"); in ksz9021_config_init()
965 "rxd0-skew-ps", "rxd1-skew-ps", in ksz9021_config_init()
966 "rxd2-skew-ps", "rxd3-skew-ps"); in ksz9021_config_init()
969 "txd0-skew-ps", "txd1-skew-ps", in ksz9021_config_init()
970 "txd2-skew-ps", "txd3-skew-ps"); in ksz9021_config_init()
1013 /* set rx to +0.30ns and rx_clk to -0.90ns to compensate the
1019 /* set tx to -0.42ns and tx_clk to +0.96ns to get 1.38ns delay */
1039 int val[4] = {-1, -2, -3, -4}; in ksz9031_of_load_skew_values()
1062 if (val[i] != -(i + 1)) { in ksz9031_of_load_skew_values()
1091 /* Enable energy-detect power-down mode */
1108 switch (phydev->interface) { in ksz9031_config_rgmii_delay()
1167 static const char *clk_skews[2] = {"rxc-skew-ps", "txc-skew-ps"}; in ksz9031_config_init()
1169 "rxd0-skew-ps", "rxd1-skew-ps", in ksz9031_config_init()
1170 "rxd2-skew-ps", "rxd3-skew-ps" in ksz9031_config_init()
1173 "txd0-skew-ps", "txd1-skew-ps", in ksz9031_config_init()
1174 "txd2-skew-ps", "txd3-skew-ps" in ksz9031_config_init()
1176 static const char *control_skews[2] = {"txen-skew-ps", "rxdv-skew-ps"}; in ksz9031_config_init()
1188 dev_walker = &phydev->mdio.dev; in ksz9031_config_init()
1190 of_node = dev_walker->of_node; in ksz9031_config_init()
1191 dev_walker = dev_walker->parent; in ksz9031_config_init()
1221 "*-skew-ps values should be used only with RGMII PHY modes\n"); in ksz9031_config_init()
1224 * When the device links in the 1000BASE-T slave mode only, in ksz9031_config_init()
1238 if (of_property_read_bool(of_node, "micrel,force-master")) { in ksz9031_config_init()
1268 int val[4] = {-(1 + KSZ9131_OFFSET), -(2 + KSZ9131_OFFSET), in ksz9131_of_load_skew_values()
1269 -(3 + KSZ9131_OFFSET), -(4 + KSZ9131_OFFSET)}; in ksz9131_of_load_skew_values()
1285 if (skewval < -KSZ9131_OFFSET) in ksz9131_of_load_skew_values()
1286 skewval = -KSZ9131_OFFSET; in ksz9131_of_load_skew_values()
1304 if (val[i] != -(i + 1 + KSZ9131_OFFSET)) { in ksz9131_of_load_skew_values()
1322 const struct kszphy_type *type = phydev->drv->driver_data; in ksz9131_config_rgmii_delay()
1326 switch (phydev->interface) { in ksz9131_config_rgmii_delay()
1328 rxcdll_val = type->disable_dll_rx_bit; in ksz9131_config_rgmii_delay()
1329 txcdll_val = type->disable_dll_tx_bit; in ksz9131_config_rgmii_delay()
1337 txcdll_val = type->disable_dll_tx_bit; in ksz9131_config_rgmii_delay()
1340 rxcdll_val = type->disable_dll_rx_bit; in ksz9131_config_rgmii_delay()
1348 KSZ9131RN_RXC_DLL_CTRL, type->disable_dll_mask, in ksz9131_config_rgmii_delay()
1354 KSZ9131RN_TXC_DLL_CTRL, type->disable_dll_mask, in ksz9131_config_rgmii_delay()
1360 * When LEDs are configured in Individual Mode, LED1 is ON in a no-link
1381 char *clk_skews[2] = {"rxc-skew-psec", "txc-skew-psec"}; in ksz9131_config_init()
1383 "rxd0-skew-psec", "rxd1-skew-psec", in ksz9131_config_init()
1384 "rxd2-skew-psec", "rxd3-skew-psec" in ksz9131_config_init()
1387 "txd0-skew-psec", "txd1-skew-psec", in ksz9131_config_init()
1388 "txd2-skew-psec", "txd3-skew-psec" in ksz9131_config_init()
1390 char *control_skews[2] = {"txen-skew-psec", "rxdv-skew-psec"}; in ksz9131_config_init()
1394 phydev->mdix_ctrl = ETH_TP_MDI_AUTO; in ksz9131_config_init()
1396 dev_walker = &phydev->mdio.dev; in ksz9131_config_init()
1398 of_node = dev_walker->of_node; in ksz9131_config_init()
1399 dev_walker = dev_walker->parent; in ksz9131_config_init()
1453 if (phydev->mdix_ctrl != ETH_TP_MDI_AUTO) { in ksz9131_mdix_update()
1454 phydev->mdix = phydev->mdix_ctrl; in ksz9131_mdix_update()
1462 phydev->mdix = ETH_TP_MDI; in ksz9131_mdix_update()
1464 phydev->mdix = ETH_TP_MDI_X; in ksz9131_mdix_update()
1466 phydev->mdix = ETH_TP_MDI_INVALID; in ksz9131_mdix_update()
1512 ret = ksz9131_config_mdix(phydev, phydev->mdix_ctrl); in ksz9131_config_aneg()
1533 linkmode_and(phydev->supported_eee, phydev->supported, in ksz9477_get_features()
1552 phydev->duplex = DUPLEX_HALF; in ksz8873mll_read_status()
1554 phydev->duplex = DUPLEX_FULL; in ksz8873mll_read_status()
1557 phydev->speed = SPEED_10; in ksz8873mll_read_status()
1559 phydev->speed = SPEED_100; in ksz8873mll_read_status()
1561 phydev->link = 1; in ksz8873mll_read_status()
1562 phydev->pause = phydev->asym_pause = 0; in ksz8873mll_read_status()
1577 * link-up may fail after a link-up to link-down transition. in ksz9031_get_features()
1584 linkmode_clear_bit(ETHTOOL_LINK_MODE_Asym_Pause_BIT, phydev->supported); in ksz9031_get_features()
1589 linkmode_set_bit(ETHTOOL_LINK_MODE_Pause_BIT, phydev->supported); in ksz9031_get_features()
1609 phydev->link = 0; in ksz9031_read_status()
1610 if (phydev->drv->config_intr && phy_interrupt_is_valid(phydev)) in ksz9031_read_status()
1611 phydev->drv->config_intr(phydev); in ksz9031_read_status()
1620 struct kszphy_priv *priv = phydev->priv; in ksz9x31_cable_test_start()
1623 /* KSZ9131RNX, DS00002841B-page 38, 4.14 LinkMD (R) Cable Diagnostic in ksz9x31_cable_test_start()
1624 * Prior to running the cable diagnostics, Auto-negotiation should in ksz9x31_cable_test_start()
1635 /* KSZ9131RNX, DS00002841B-page 38, 4.14 LinkMD (R) Cable Diagnostic in ksz9x31_cable_test_start()
1636 * The Master-Slave configuration should be set to Slave by writing in ksz9x31_cable_test_start()
1637 * a value of 0x1000 to the Auto-Negotiation Master Slave Control in ksz9x31_cable_test_start()
1645 priv->vct_ctrl1000 = ret & (CTL1000_ENABLE_MASTER | CTL1000_AS_MASTER); in ksz9x31_cable_test_start()
1690 /* KSZ9131RNX, DS00002841B-page 38, 4.14 LinkMD (R) Cable Diagnostic in ksz9x31_cable_test_fault_length()
1692 * distance to fault = (VCT_DATA - 22) * 4 / cable propagation velocity in ksz9x31_cable_test_fault_length()
1695 dt = clamp(dt - 22, 0, 255); in ksz9x31_cable_test_fault_length()
1727 /* KSZ9131RNX, DS00002841B-page 38, 4.14 LinkMD (R) Cable Diagnostic in ksz9x31_cable_test_one_pair()
1748 return -EAGAIN; in ksz9x31_cable_test_one_pair()
1767 struct kszphy_priv *priv = phydev->priv; in ksz9x31_cable_test_get_status()
1775 while (pair_mask && retries--) { in ksz9x31_cable_test_get_status()
1778 if (ret == -EAGAIN) in ksz9x31_cable_test_get_status()
1804 priv->vct_ctrl1000); in ksz9x31_cable_test_get_status()
1826 * counter intuitive, the "-X" in "1 = Force MDI" in the data in ksz886x_config_mdix()
1828 * 1 = Force MDI (sic!) (transmit on RX+/RX- pins) in ksz886x_config_mdix()
1829 * 0 = Normal operation (transmit on TX+/TX- pins) in ksz886x_config_mdix()
1854 if (phydev->autoneg != AUTONEG_ENABLE) { in ksz886x_config_aneg()
1876 /* The MDI-X configuration is automatically changed by the PHY after in ksz886x_config_aneg()
1877 * switching from autoneg off to on. So, take MDI-X configuration under in ksz886x_config_aneg()
1880 return ksz886x_config_mdix(phydev, phydev->mdix_ctrl); in ksz886x_config_aneg()
1893 phydev->mdix_ctrl = ETH_TP_MDI_X; in ksz886x_mdix_update()
1895 phydev->mdix_ctrl = ETH_TP_MDI; in ksz886x_mdix_update()
1897 phydev->mdix_ctrl = ETH_TP_MDI_AUTO; in ksz886x_mdix_update()
1906 phydev->mdix = ETH_TP_MDI_X; in ksz886x_mdix_update()
1908 phydev->mdix = ETH_TP_MDI; in ksz886x_mdix_update()
1940 /* Transmit waveform amplitude can be improved (1000BASE-T, 100BASE-TX, 10BASE-Te) */
1969 * necessary to set the PHY to 100 Mbps speed with auto-negotiation in ksz9477_phy_errata()
1970 * disabled by writing to register 0xN100-0xN101. After writing the in ksz9477_phy_errata()
1972 * register settings, write register 0xN100-0xN101 again to enable in ksz9477_phy_errata()
1973 * and restart auto-negotiation. in ksz9477_phy_errata()
1982 err = phy_write_mmd(phydev, errata->dev_addr, errata->reg_addr, errata->val); in ksz9477_phy_errata()
1999 if ((phydev->phy_id & 0xf) == 1) { in ksz9477_config_init()
2008 if (phydev->dev_flags & MICREL_NO_EEE) in ksz9477_config_init()
2030 struct kszphy_priv *priv = phydev->priv; in kszphy_get_stat()
2038 val = val & ((1 << stat.bits) - 1); in kszphy_get_stat()
2039 priv->stats[i] += val; in kszphy_get_stat()
2040 ret = priv->stats[i]; in kszphy_get_stat()
2057 struct kszphy_priv *priv = phydev->priv; in kszphy_enable_clk()
2059 if (!priv->clk_enable && priv->clk) { in kszphy_enable_clk()
2060 clk_prepare_enable(priv->clk); in kszphy_enable_clk()
2061 priv->clk_enable = true; in kszphy_enable_clk()
2067 struct kszphy_priv *priv = phydev->priv; in kszphy_disable_clk()
2069 if (priv->clk_enable && priv->clk) { in kszphy_disable_clk()
2070 clk_disable_unprepare(priv->clk); in kszphy_disable_clk()
2071 priv->clk_enable = false; in kszphy_disable_clk()
2099 phydev->interrupts = PHY_INTERRUPT_DISABLED; in kszphy_suspend()
2100 if (phydev->drv->config_intr) in kszphy_suspend()
2101 phydev->drv->config_intr(phydev); in kszphy_suspend()
2109 const struct kszphy_type *type = phydev->drv->driver_data; in kszphy_parse_led_mode()
2110 const struct device_node *np = phydev->mdio.dev.of_node; in kszphy_parse_led_mode()
2111 struct kszphy_priv *priv = phydev->priv; in kszphy_parse_led_mode()
2114 if (type && type->led_mode_reg) { in kszphy_parse_led_mode()
2115 ret = of_property_read_u32(np, "micrel,led-mode", in kszphy_parse_led_mode()
2116 &priv->led_mode); in kszphy_parse_led_mode()
2119 priv->led_mode = -1; in kszphy_parse_led_mode()
2121 if (priv->led_mode > 3) { in kszphy_parse_led_mode()
2123 priv->led_mode); in kszphy_parse_led_mode()
2124 priv->led_mode = -1; in kszphy_parse_led_mode()
2127 priv->led_mode = -1; in kszphy_parse_led_mode()
2139 /* After switching from power-down to normal mode, an internal global in kszphy_resume()
2151 phydev->interrupts = PHY_INTERRUPT_ENABLED; in kszphy_resume()
2152 if (phydev->drv->config_intr) in kszphy_resume()
2153 phydev->drv->config_intr(phydev); in kszphy_resume()
2190 /* After switching from power-down to normal mode, an internal global in ksz9477_resume()
2197 if ((phydev->phy_id & 0xf) == 1) { in ksz9477_resume()
2205 phydev->interrupts = PHY_INTERRUPT_ENABLED; in ksz9477_resume()
2206 if (phydev->drv->config_intr) in ksz9477_resume()
2207 phydev->drv->config_intr(phydev); in ksz9477_resume()
2230 /* Re-program the value after chip is reset. */ in ksz8061_resume()
2237 phydev->interrupts = PHY_INTERRUPT_ENABLED; in ksz8061_resume()
2238 if (phydev->drv->config_intr) in ksz8061_resume()
2239 phydev->drv->config_intr(phydev); in ksz8061_resume()
2252 const struct kszphy_type *type = phydev->drv->driver_data; in kszphy_probe()
2253 const struct device_node *np = phydev->mdio.dev.of_node; in kszphy_probe()
2257 priv = devm_kzalloc(&phydev->mdio.dev, sizeof(*priv), GFP_KERNEL); in kszphy_probe()
2259 return -ENOMEM; in kszphy_probe()
2261 phydev->priv = priv; in kszphy_probe()
2263 priv->type = type; in kszphy_probe()
2267 clk = devm_clk_get_optional_enabled(&phydev->mdio.dev, "rmii-ref"); in kszphy_probe()
2274 priv->rmii_ref_clk_sel = type->has_rmii_ref_clk_sel; in kszphy_probe()
2276 "micrel,rmii-reference-clock-select-25-mhz"); in kszphy_probe()
2279 priv->rmii_ref_clk_sel_val = rmii_ref_clk_sel_25_mhz; in kszphy_probe()
2281 priv->rmii_ref_clk_sel_val = !rmii_ref_clk_sel_25_mhz; in kszphy_probe()
2285 return -EINVAL; in kszphy_probe()
2288 /* unnamed clock from the generic ethernet-phy binding */ in kszphy_probe()
2289 clk = devm_clk_get_optional_enabled(&phydev->mdio.dev, NULL); in kszphy_probe()
2296 priv->clk = clk; in kszphy_probe()
2299 phydev->port = PORT_FIBRE; in kszphy_probe()
2301 /* Support legacy board-file configuration */ in kszphy_probe()
2302 if (phydev->dev_flags & MICREL_PHY_50MHZ_CLK) { in kszphy_probe()
2303 priv->rmii_ref_clk_sel = true; in kszphy_probe()
2304 priv->rmii_ref_clk_sel_val = true; in kszphy_probe()
2314 * confuse the internal state machine - disable auto neg here. in lan8814_cable_test_start()
2323 if (phydev->dev_flags & MICREL_KSZ8_P1_ERRATA) in ksz886x_cable_test_start()
2324 return -EOPNOTSUPP; in ksz886x_cable_test_start()
2328 * confuse the internal state machine - disable auto neg here. in ksz886x_cable_test_start()
2374 * (DELTA_TIME - 22) * 0.8 for lan8814 phy. in ksz886x_cable_test_fault_length()
2379 return ((dt - 22) * 800) / 10; in ksz886x_cable_test_fault_length()
2386 const struct kszphy_type *type = phydev->drv->driver_data; in ksz886x_cable_test_wait_for_completion()
2389 ret = phy_read_poll_timeout(phydev, type->cable_diag_reg, val, in ksz886x_cable_test_wait_for_completion()
2423 return -EAGAIN; in lan8814_cable_test_one_pair()
2451 * We can workaround this limitation by using the MDI-X functionality. in ksz886x_cable_test_one_pair()
2458 switch (phydev->phy_id & MICREL_PHY_ID_MASK) { in ksz886x_cable_test_one_pair()
2466 ret = -ENODEV; in ksz886x_cable_test_one_pair()
2488 return -EAGAIN; in ksz886x_cable_test_one_pair()
2506 const struct kszphy_type *type = phydev->drv->driver_data; in ksz886x_cable_test_get_status()
2507 unsigned long pair_mask = type->pair_mask; in ksz886x_cable_test_get_status()
2515 while (pair_mask && retries--) { in ksz886x_cable_test_get_status()
2517 if (type->cable_diag_reg == LAN8814_CABLE_DIAG) in ksz886x_cable_test_get_status()
2521 if (ret == -EAGAIN) in ksz886x_cable_test_get_status()
2634 struct phy_device *phydev = ptp_priv->phydev; in lan8814_ts_info()
2635 struct lan8814_shared_priv *shared = phydev->shared->priv; in lan8814_ts_info()
2637 info->so_timestamping = SOF_TIMESTAMPING_TX_HARDWARE | in lan8814_ts_info()
2641 info->phc_index = ptp_clock_index(shared->ptp_clock); in lan8814_ts_info()
2643 info->tx_types = in lan8814_ts_info()
2648 info->rx_filters = in lan8814_ts_info()
2681 ptp_priv->hwts_tx_type = config->tx_type; in lan8814_hwtstamp()
2682 ptp_priv->rx_filter = config->rx_filter; in lan8814_hwtstamp()
2684 switch (config->rx_filter) { in lan8814_hwtstamp()
2686 ptp_priv->layer = 0; in lan8814_hwtstamp()
2687 ptp_priv->version = 0; in lan8814_hwtstamp()
2692 ptp_priv->layer = PTP_CLASS_L4; in lan8814_hwtstamp()
2693 ptp_priv->version = PTP_CLASS_V2; in lan8814_hwtstamp()
2698 ptp_priv->layer = PTP_CLASS_L2; in lan8814_hwtstamp()
2699 ptp_priv->version = PTP_CLASS_V2; in lan8814_hwtstamp()
2704 ptp_priv->layer = PTP_CLASS_L4 | PTP_CLASS_L2; in lan8814_hwtstamp()
2705 ptp_priv->version = PTP_CLASS_V2; in lan8814_hwtstamp()
2708 return -ERANGE; in lan8814_hwtstamp()
2711 if (ptp_priv->layer & PTP_CLASS_L2) { in lan8814_hwtstamp()
2714 } else if (ptp_priv->layer & PTP_CLASS_L4) { in lan8814_hwtstamp()
2718 lanphy_write_page_reg(ptp_priv->phydev, 5, PTP_RX_PARSE_CONFIG, rxcfg); in lan8814_hwtstamp()
2719 lanphy_write_page_reg(ptp_priv->phydev, 5, PTP_TX_PARSE_CONFIG, txcfg); in lan8814_hwtstamp()
2723 lanphy_write_page_reg(ptp_priv->phydev, 5, PTP_RX_TIMESTAMP_EN, pkt_ts_enable); in lan8814_hwtstamp()
2724 lanphy_write_page_reg(ptp_priv->phydev, 5, PTP_TX_TIMESTAMP_EN, pkt_ts_enable); in lan8814_hwtstamp()
2726 tx_mod = lanphy_read_page_reg(ptp_priv->phydev, 5, PTP_TX_MOD); in lan8814_hwtstamp()
2727 if (ptp_priv->hwts_tx_type == HWTSTAMP_TX_ONESTEP_SYNC) { in lan8814_hwtstamp()
2728 lanphy_write_page_reg(ptp_priv->phydev, 5, PTP_TX_MOD, in lan8814_hwtstamp()
2730 } else if (ptp_priv->hwts_tx_type == HWTSTAMP_TX_ON) { in lan8814_hwtstamp()
2731 lanphy_write_page_reg(ptp_priv->phydev, 5, PTP_TX_MOD, in lan8814_hwtstamp()
2735 if (config->rx_filter != HWTSTAMP_FILTER_NONE) in lan8814_hwtstamp()
2736 lan8814_config_ts_intr(ptp_priv->phydev, true); in lan8814_hwtstamp()
2738 lan8814_config_ts_intr(ptp_priv->phydev, false); in lan8814_hwtstamp()
2741 list_for_each_entry_safe(rx_ts, tmp, &ptp_priv->rx_ts_list, list) { in lan8814_hwtstamp()
2742 list_del(&rx_ts->list); in lan8814_hwtstamp()
2745 skb_queue_purge(&ptp_priv->rx_queue); in lan8814_hwtstamp()
2746 skb_queue_purge(&ptp_priv->tx_queue); in lan8814_hwtstamp()
2748 lan8814_flush_fifo(ptp_priv->phydev, false); in lan8814_hwtstamp()
2749 lan8814_flush_fifo(ptp_priv->phydev, true); in lan8814_hwtstamp()
2759 switch (ptp_priv->hwts_tx_type) { in lan8814_txtstamp()
2767 skb_shinfo(skb)->tx_flags |= SKBTX_IN_PROGRESS; in lan8814_txtstamp()
2768 skb_queue_tail(&ptp_priv->tx_queue, skb); in lan8814_txtstamp()
2790 *sig = (__force u16)(ntohs(ptp_header->sequence_id)); in lan8814_get_sig_rx()
2807 spin_lock_irqsave(&ptp_priv->rx_ts_lock, flags); in lan8814_match_rx_skb()
2808 list_for_each_entry_safe(rx_ts, tmp, &ptp_priv->rx_ts_list, list) { in lan8814_match_rx_skb()
2810 if (memcmp(&skb_sig, &rx_ts->seq_id, sizeof(rx_ts->seq_id))) in lan8814_match_rx_skb()
2815 shhwtstamps->hwtstamp = ktime_set(rx_ts->seconds, in lan8814_match_rx_skb()
2816 rx_ts->nsec); in lan8814_match_rx_skb()
2817 list_del(&rx_ts->list); in lan8814_match_rx_skb()
2823 spin_unlock_irqrestore(&ptp_priv->rx_ts_lock, flags); in lan8814_match_rx_skb()
2835 if (ptp_priv->rx_filter == HWTSTAMP_FILTER_NONE || in lan8814_rxtstamp()
2839 if ((type & ptp_priv->version) == 0 || (type & ptp_priv->layer) == 0) in lan8814_rxtstamp()
2846 skb_queue_tail(&ptp_priv->rx_queue, skb); in lan8814_rxtstamp()
2884 struct phy_device *phydev = shared->phydev; in lan8814_ptpci_gettime64()
2888 mutex_lock(&shared->shared_lock); in lan8814_ptpci_gettime64()
2890 mutex_unlock(&shared->shared_lock); in lan8814_ptpci_gettime64()
2891 ts->tv_sec = seconds; in lan8814_ptpci_gettime64()
2892 ts->tv_nsec = nano_seconds; in lan8814_ptpci_gettime64()
2902 struct phy_device *phydev = shared->phydev; in lan8814_ptpci_settime64()
2904 mutex_lock(&shared->shared_lock); in lan8814_ptpci_settime64()
2905 lan8814_ptp_clock_set(phydev, ts->tv_sec, ts->tv_nsec); in lan8814_ptpci_settime64()
2906 mutex_unlock(&shared->shared_lock); in lan8814_ptpci_settime64()
2952 nano_seconds -= 1000000000; in lan8814_ptp_clock_step()
2957 } else if (time_step_ns < -15000000000LL) { in lan8814_ptp_clock_step()
2959 time_step_ns = -time_step_ns; in lan8814_ptp_clock_step()
2962 set_seconds -= div_u64_rem(time_step_ns, 1000000000LL, in lan8814_ptp_clock_step()
2966 set_seconds--; in lan8814_ptp_clock_step()
2969 nano_seconds -= nano_seconds_step; in lan8814_ptp_clock_step()
2982 abs_time_step_ns = (u64)(-time_step_ns); in lan8814_ptp_clock_step()
2983 seconds = -((s32)div_u64_rem(abs_time_step_ns, 1000000000, in lan8814_ptp_clock_step()
2991 seconds--; in lan8814_ptp_clock_step()
2992 nano_seconds = (1000000000 - nano_seconds); in lan8814_ptp_clock_step()
3004 nano_seconds -= 1000000000; in lan8814_ptp_clock_step()
3025 seconds -= ((s32)adjustment_value); in lan8814_ptp_clock_step()
3028 set_seconds -= adjustment_value; in lan8814_ptp_clock_step()
3031 u32 adjustment_value = (u32)(-seconds); in lan8814_ptp_clock_step()
3074 struct phy_device *phydev = shared->phydev; in lan8814_ptpci_adjtime()
3076 mutex_lock(&shared->shared_lock); in lan8814_ptpci_adjtime()
3078 mutex_unlock(&shared->shared_lock); in lan8814_ptpci_adjtime()
3087 struct phy_device *phydev = shared->phydev; in lan8814_ptpci_adjfine()
3093 scaled_ppm = -scaled_ppm; in lan8814_ptpci_adjfine()
3106 mutex_lock(&shared->shared_lock); in lan8814_ptpci_adjfine()
3109 mutex_unlock(&shared->shared_lock); in lan8814_ptpci_adjfine()
3209 struct phy_device *phydev = shared->phydev; in lan8814_ptp_perout()
3216 if (rq->perout.flags & ~PTP_PEROUT_DUTY_CYCLE) in lan8814_ptp_perout()
3217 return -EOPNOTSUPP; in lan8814_ptp_perout()
3219 mutex_lock(&shared->shared_lock); in lan8814_ptp_perout()
3220 event = rq->perout.index; in lan8814_ptp_perout()
3221 pin = ptp_find_pin(shared->ptp_clock, PTP_PF_PEROUT, event); in lan8814_ptp_perout()
3223 mutex_unlock(&shared->shared_lock); in lan8814_ptp_perout()
3224 return -EBUSY; in lan8814_ptp_perout()
3230 mutex_unlock(&shared->shared_lock); in lan8814_ptp_perout()
3234 ts_on.tv_sec = rq->perout.on.sec; in lan8814_ptp_perout()
3235 ts_on.tv_nsec = rq->perout.on.nsec; in lan8814_ptp_perout()
3238 ts_period.tv_sec = rq->perout.period.sec; in lan8814_ptp_perout()
3239 ts_period.tv_nsec = rq->perout.period.nsec; in lan8814_ptp_perout()
3245 mutex_unlock(&shared->shared_lock); in lan8814_ptp_perout()
3246 return -EOPNOTSUPP; in lan8814_ptp_perout()
3252 mutex_unlock(&shared->shared_lock); in lan8814_ptp_perout()
3253 return -EINVAL; in lan8814_ptp_perout()
3308 lan8814_ptp_set_target(phydev, event, rq->perout.start.sec, in lan8814_ptp_perout()
3309 rq->perout.start.nsec); in lan8814_ptp_perout()
3310 lan8814_ptp_set_reload(phydev, event, rq->perout.period.sec, in lan8814_ptp_perout()
3311 rq->perout.period.nsec); in lan8814_ptp_perout()
3313 mutex_unlock(&shared->shared_lock); in lan8814_ptp_perout()
3382 struct phy_device *phydev = shared->phydev; in lan8814_ptp_extts()
3385 if (rq->extts.flags & ~(PTP_ENABLE_FEATURE | in lan8814_ptp_extts()
3388 return -EOPNOTSUPP; in lan8814_ptp_extts()
3390 pin = ptp_find_pin(shared->ptp_clock, PTP_PF_EXTTS, in lan8814_ptp_extts()
3391 rq->extts.index); in lan8814_ptp_extts()
3392 if (pin == -1 || pin != LAN8814_PTP_EXTTS_NUM) in lan8814_ptp_extts()
3393 return -EINVAL; in lan8814_ptp_extts()
3395 mutex_lock(&shared->shared_lock); in lan8814_ptp_extts()
3397 lan8814_ptp_extts_on(phydev, pin, rq->extts.flags); in lan8814_ptp_extts()
3401 mutex_unlock(&shared->shared_lock); in lan8814_ptp_extts()
3409 switch (rq->type) { in lan8814_ptpci_enable()
3415 return -EINVAL; in lan8814_ptpci_enable()
3430 return -1; in lan8814_ptpci_verify()
3434 return -1; in lan8814_ptpci_verify()
3437 return -1; in lan8814_ptpci_verify()
3454 *sig = (__force u16)(ntohs(ptp_header->sequence_id)); in lan8814_get_sig_tx()
3467 spin_lock_irqsave(&ptp_priv->tx_queue.lock, flags); in lan8814_match_tx_skb()
3468 skb_queue_walk_safe(&ptp_priv->tx_queue, skb, skb_tmp) { in lan8814_match_tx_skb()
3475 __skb_unlink(skb, &ptp_priv->tx_queue); in lan8814_match_tx_skb()
3479 spin_unlock_irqrestore(&ptp_priv->tx_queue.lock, flags); in lan8814_match_tx_skb()
3490 struct phy_device *phydev = ptp_priv->phydev; in lan8814_dequeue_tx_skb()
3500 struct phy_device *phydev = ptp_priv->phydev; in lan8814_get_tx_ts()
3506 /* If other timestamps are available in the FIFO, in lan8814_get_tx_ts()
3522 spin_lock_irqsave(&ptp_priv->rx_queue.lock, flags); in lan8814_match_skb()
3523 skb_queue_walk_safe(&ptp_priv->rx_queue, skb, skb_tmp) { in lan8814_match_skb()
3527 if (memcmp(&skb_sig, &rx_ts->seq_id, sizeof(rx_ts->seq_id))) in lan8814_match_skb()
3530 __skb_unlink(skb, &ptp_priv->rx_queue); in lan8814_match_skb()
3535 spin_unlock_irqrestore(&ptp_priv->rx_queue.lock, flags); in lan8814_match_skb()
3540 shhwtstamps->hwtstamp = ktime_set(rx_ts->seconds, rx_ts->nsec); in lan8814_match_skb()
3556 spin_lock_irqsave(&ptp_priv->rx_ts_lock, flags); in lan8814_match_rx_ts()
3557 list_add(&rx_ts->list, &ptp_priv->rx_ts_list); in lan8814_match_rx_ts()
3558 spin_unlock_irqrestore(&ptp_priv->rx_ts_lock, flags); in lan8814_match_rx_ts()
3566 struct phy_device *phydev = ptp_priv->phydev; in lan8814_get_rx_ts()
3575 lan8814_ptp_rx_ts_get(phydev, &rx_ts->seconds, &rx_ts->nsec, in lan8814_get_rx_ts()
3576 &rx_ts->seq_id); in lan8814_get_rx_ts()
3579 /* If other timestamps are available in the FIFO, in lan8814_get_rx_ts()
3588 struct kszphy_priv *priv = phydev->priv; in lan8814_handle_ptp_interrupt()
3589 struct kszphy_ptp_priv *ptp_priv = &priv->ptp_priv; in lan8814_handle_ptp_interrupt()
3599 skb_queue_purge(&ptp_priv->tx_queue); in lan8814_handle_ptp_interrupt()
3604 skb_queue_purge(&ptp_priv->rx_queue); in lan8814_handle_ptp_interrupt()
3610 struct phy_device *phydev = shared->phydev; in lan8814_gpio_process_cap()
3626 return -1; in lan8814_gpio_process_cap()
3649 ptp_clock_event(shared->ptp_clock, &ptp_event); in lan8814_gpio_process_cap()
3656 struct lan8814_shared_priv *shared = phydev->shared->priv; in lan8814_handle_gpio_interrupt()
3659 mutex_lock(&shared->shared_lock); in lan8814_handle_gpio_interrupt()
3661 mutex_unlock(&shared->shared_lock); in lan8814_handle_gpio_interrupt()
3670 /* MDI-X setting for swap A,B transmit */ in lan8804_config_init()
3717 /* By default interrupt buffer is open-drain in which case the interrupt in lan8804_config_intr()
3719 * push-pull to be able to change interrupt polarity in lan8804_config_intr()
3724 if (phydev->interrupts == PHY_INTERRUPT_ENABLED) { in lan8804_config_intr()
3795 if (phydev->interrupts == PHY_INTERRUPT_ENABLED) { in lan8814_config_intr()
3814 struct kszphy_priv *priv = phydev->priv; in lan8814_ptp_init()
3815 struct kszphy_ptp_priv *ptp_priv = &priv->ptp_priv; in lan8814_ptp_init()
3847 skb_queue_head_init(&ptp_priv->tx_queue); in lan8814_ptp_init()
3848 skb_queue_head_init(&ptp_priv->rx_queue); in lan8814_ptp_init()
3849 INIT_LIST_HEAD(&ptp_priv->rx_ts_list); in lan8814_ptp_init()
3850 spin_lock_init(&ptp_priv->rx_ts_lock); in lan8814_ptp_init()
3852 ptp_priv->phydev = phydev; in lan8814_ptp_init()
3854 ptp_priv->mii_ts.rxtstamp = lan8814_rxtstamp; in lan8814_ptp_init()
3855 ptp_priv->mii_ts.txtstamp = lan8814_txtstamp; in lan8814_ptp_init()
3856 ptp_priv->mii_ts.hwtstamp = lan8814_hwtstamp; in lan8814_ptp_init()
3857 ptp_priv->mii_ts.ts_info = lan8814_ts_info; in lan8814_ptp_init()
3859 phydev->mii_ts = &ptp_priv->mii_ts; in lan8814_ptp_init()
3862 phydev->default_timestamp = true; in lan8814_ptp_init()
3867 struct lan8814_shared_priv *shared = phydev->shared->priv; in lan8814_ptp_probe_once()
3870 mutex_init(&shared->shared_lock); in lan8814_ptp_probe_once()
3872 shared->pin_config = devm_kmalloc_array(&phydev->mdio.dev, in lan8814_ptp_probe_once()
3874 sizeof(*shared->pin_config), in lan8814_ptp_probe_once()
3876 if (!shared->pin_config) in lan8814_ptp_probe_once()
3877 return -ENOMEM; in lan8814_ptp_probe_once()
3880 struct ptp_pin_desc *ptp_pin = &shared->pin_config[i]; in lan8814_ptp_probe_once()
3883 snprintf(ptp_pin->name, in lan8814_ptp_probe_once()
3884 sizeof(ptp_pin->name), "lan8814_ptp_pin_%02d", i); in lan8814_ptp_probe_once()
3885 ptp_pin->index = i; in lan8814_ptp_probe_once()
3886 ptp_pin->func = PTP_PF_NONE; in lan8814_ptp_probe_once()
3889 shared->ptp_clock_info.owner = THIS_MODULE; in lan8814_ptp_probe_once()
3890 snprintf(shared->ptp_clock_info.name, 30, "%s", phydev->drv->name); in lan8814_ptp_probe_once()
3891 shared->ptp_clock_info.max_adj = 31249999; in lan8814_ptp_probe_once()
3892 shared->ptp_clock_info.n_alarm = 0; in lan8814_ptp_probe_once()
3893 shared->ptp_clock_info.n_ext_ts = LAN8814_PTP_EXTTS_NUM; in lan8814_ptp_probe_once()
3894 shared->ptp_clock_info.n_pins = LAN8814_PTP_GPIO_NUM; in lan8814_ptp_probe_once()
3895 shared->ptp_clock_info.pps = 0; in lan8814_ptp_probe_once()
3896 shared->ptp_clock_info.pin_config = shared->pin_config; in lan8814_ptp_probe_once()
3897 shared->ptp_clock_info.n_per_out = LAN8814_PTP_PEROUT_NUM; in lan8814_ptp_probe_once()
3898 shared->ptp_clock_info.adjfine = lan8814_ptpci_adjfine; in lan8814_ptp_probe_once()
3899 shared->ptp_clock_info.adjtime = lan8814_ptpci_adjtime; in lan8814_ptp_probe_once()
3900 shared->ptp_clock_info.gettime64 = lan8814_ptpci_gettime64; in lan8814_ptp_probe_once()
3901 shared->ptp_clock_info.settime64 = lan8814_ptpci_settime64; in lan8814_ptp_probe_once()
3902 shared->ptp_clock_info.getcrosststamp = NULL; in lan8814_ptp_probe_once()
3903 shared->ptp_clock_info.enable = lan8814_ptpci_enable; in lan8814_ptp_probe_once()
3904 shared->ptp_clock_info.verify = lan8814_ptpci_verify; in lan8814_ptp_probe_once()
3906 shared->ptp_clock = ptp_clock_register(&shared->ptp_clock_info, in lan8814_ptp_probe_once()
3907 &phydev->mdio.dev); in lan8814_ptp_probe_once()
3908 if (IS_ERR(shared->ptp_clock)) { in lan8814_ptp_probe_once()
3910 PTR_ERR(shared->ptp_clock)); in lan8814_ptp_probe_once()
3911 return -EINVAL; in lan8814_ptp_probe_once()
3915 if (!shared->ptp_clock) in lan8814_ptp_probe_once()
3920 shared->phydev = phydev; in lan8814_ptp_probe_once()
3951 struct kszphy_priv *lan8814 = phydev->priv; in lan8814_config_init()
3964 /* MDI-X setting for swap A,B transmit */ in lan8814_config_init()
3970 if (lan8814->led_mode >= 0) in lan8814_config_init()
3971 lan8814_setup_led(phydev, lan8814->led_mode); in lan8814_config_init()
3985 gpiod = devm_gpiod_get_optional(&phydev->mdio.dev, "coma-mode", in lan8814_release_coma_mode()
4026 const struct kszphy_type *type = phydev->drv->driver_data; in lan8814_probe()
4031 priv = devm_kzalloc(&phydev->mdio.dev, sizeof(*priv), GFP_KERNEL); in lan8814_probe()
4033 return -ENOMEM; in lan8814_probe()
4035 phydev->priv = priv; in lan8814_probe()
4037 priv->type = type; in lan8814_probe()
4041 /* Strap-in value for PHY address, below register read gives starting in lan8814_probe()
4045 devm_phy_package_join(&phydev->mdio.dev, phydev, in lan8814_probe()
4153 /* 10M/100M Ethernet Signal Tuning Errata for Shorted-Center Tap in lan8841_config_init()
4199 if (phydev->interrupts == PHY_INTERRUPT_ENABLED) { in lan8841_config_intr()
4240 struct phy_device *phydev = ptp_priv->phydev; in lan8841_ptp_get_tx_ts()
4274 struct phy_device *phydev = ptp_priv->phydev; in lan8841_ptp_flush_fifo()
4297 struct phy_device *phydev = ptp_priv->phydev; in lan8841_gpio_process_cap()
4302 pin = ptp_find_pin_unlocked(ptp_priv->ptp_clock, PTP_PF_EXTTS, 0); in lan8841_gpio_process_cap()
4303 if (pin == -1) in lan8841_gpio_process_cap()
4315 mutex_lock(&ptp_priv->ptp_lock); in lan8841_gpio_process_cap()
4333 mutex_unlock(&ptp_priv->ptp_lock); in lan8841_gpio_process_cap()
4341 ptp_clock_event(ptp_priv->ptp_clock, &ptp_event); in lan8841_gpio_process_cap()
4346 struct kszphy_priv *priv = phydev->priv; in lan8841_handle_ptp_interrupt()
4347 struct kszphy_ptp_priv *ptp_priv = &priv->ptp_priv; in lan8841_handle_ptp_interrupt()
4361 skb_queue_purge(&ptp_priv->tx_queue); in lan8841_handle_ptp_interrupt()
4402 info->phc_index = ptp_priv->ptp_clock ? in lan8841_ts_info()
4403 ptp_clock_index(ptp_priv->ptp_clock) : -1; in lan8841_ts_info()
4404 if (info->phc_index == -1) in lan8841_ts_info()
4407 info->so_timestamping = SOF_TIMESTAMPING_TX_HARDWARE | in lan8841_ts_info()
4411 info->tx_types = (1 << HWTSTAMP_TX_OFF) | in lan8841_ts_info()
4415 info->rx_filters = (1 << HWTSTAMP_FILTER_NONE) | in lan8841_ts_info()
4430 struct phy_device *phydev = ptp_priv->phydev; in lan8841_ptp_enable_processing()
4451 ptp_schedule_worker(ptp_priv->ptp_clock, 0); in lan8841_ptp_enable_processing()
4464 ptp_cancel_worker_sync(ptp_priv->ptp_clock); in lan8841_ptp_enable_processing()
4477 struct phy_device *phydev = ptp_priv->phydev; in lan8841_hwtstamp()
4481 ptp_priv->hwts_tx_type = config->tx_type; in lan8841_hwtstamp()
4482 ptp_priv->rx_filter = config->rx_filter; in lan8841_hwtstamp()
4484 switch (config->rx_filter) { in lan8841_hwtstamp()
4486 ptp_priv->layer = 0; in lan8841_hwtstamp()
4487 ptp_priv->version = 0; in lan8841_hwtstamp()
4492 ptp_priv->layer = PTP_CLASS_L4; in lan8841_hwtstamp()
4493 ptp_priv->version = PTP_CLASS_V2; in lan8841_hwtstamp()
4498 ptp_priv->layer = PTP_CLASS_L2; in lan8841_hwtstamp()
4499 ptp_priv->version = PTP_CLASS_V2; in lan8841_hwtstamp()
4504 ptp_priv->layer = PTP_CLASS_L4 | PTP_CLASS_L2; in lan8841_hwtstamp()
4505 ptp_priv->version = PTP_CLASS_V2; in lan8841_hwtstamp()
4508 return -ERANGE; in lan8841_hwtstamp()
4514 if (ptp_priv->layer & PTP_CLASS_L2) { in lan8841_hwtstamp()
4517 } else if (ptp_priv->layer & PTP_CLASS_L4) { in lan8841_hwtstamp()
4533 ptp_priv->hwts_tx_type == HWTSTAMP_TX_ONESTEP_SYNC ? in lan8841_hwtstamp()
4538 config->rx_filter != HWTSTAMP_FILTER_NONE); in lan8841_hwtstamp()
4540 skb_queue_purge(&ptp_priv->tx_queue); in lan8841_hwtstamp()
4561 if (ptp_priv->rx_filter == HWTSTAMP_FILTER_NONE || in lan8841_rxtstamp()
4565 if ((type & ptp_priv->version) == 0 || (type & ptp_priv->layer) == 0) in lan8841_rxtstamp()
4568 spin_lock_irqsave(&ptp_priv->seconds_lock, flags); in lan8841_rxtstamp()
4569 ts.tv_sec = ptp_priv->seconds; in lan8841_rxtstamp()
4570 spin_unlock_irqrestore(&ptp_priv->seconds_lock, flags); in lan8841_rxtstamp()
4571 ts_header = __be32_to_cpu(header->reserved2); in lan8841_rxtstamp()
4578 ts.tv_sec -= GENMASK(1, 0) + 1; in lan8841_rxtstamp()
4582 shhwtstamps->hwtstamp = in lan8841_rxtstamp()
4585 header->reserved2 = 0; in lan8841_rxtstamp()
4602 struct phy_device *phydev = ptp_priv->phydev; in lan8841_ptp_set_target()
4630 ts->tv_sec + LAN8841_BUFFER_TIME, 0); in lan8841_ptp_update_target()
4641 struct phy_device *phydev = ptp_priv->phydev; in lan8841_ptp_set_reload()
4675 struct phy_device *phydev = ptp_priv->phydev; in lan8841_ptp_settime64()
4680 mutex_lock(&ptp_priv->ptp_lock); in lan8841_ptp_settime64()
4681 phy_write_mmd(phydev, 2, LAN8841_PTP_LTC_SET_SEC_LO, lower_16_bits(ts->tv_sec)); in lan8841_ptp_settime64()
4682 phy_write_mmd(phydev, 2, LAN8841_PTP_LTC_SET_SEC_MID, upper_16_bits(ts->tv_sec)); in lan8841_ptp_settime64()
4683 phy_write_mmd(phydev, 2, LAN8841_PTP_LTC_SET_SEC_HI, upper_32_bits(ts->tv_sec) & 0xffff); in lan8841_ptp_settime64()
4684 phy_write_mmd(phydev, 2, LAN8841_PTP_LTC_SET_NS_LO, lower_16_bits(ts->tv_nsec)); in lan8841_ptp_settime64()
4685 phy_write_mmd(phydev, 2, LAN8841_PTP_LTC_SET_NS_HI, upper_16_bits(ts->tv_nsec) & 0x3fff); in lan8841_ptp_settime64()
4691 mutex_unlock(&ptp_priv->ptp_lock); in lan8841_ptp_settime64()
4693 spin_lock_irqsave(&ptp_priv->seconds_lock, flags); in lan8841_ptp_settime64()
4694 ptp_priv->seconds = ts->tv_sec; in lan8841_ptp_settime64()
4695 spin_unlock_irqrestore(&ptp_priv->seconds_lock, flags); in lan8841_ptp_settime64()
4712 struct phy_device *phydev = ptp_priv->phydev; in lan8841_ptp_gettime64()
4716 mutex_lock(&ptp_priv->ptp_lock); in lan8841_ptp_gettime64()
4731 mutex_unlock(&ptp_priv->ptp_lock); in lan8841_ptp_gettime64()
4742 struct phy_device *phydev = ptp_priv->phydev; in lan8841_ptp_getseconds()
4745 mutex_lock(&ptp_priv->ptp_lock); in lan8841_ptp_getseconds()
4756 mutex_unlock(&ptp_priv->ptp_lock); in lan8841_ptp_getseconds()
4771 struct phy_device *phydev = ptp_priv->phydev; in lan8841_ptp_adjtime()
4784 if (delta > 10000000000LL || delta < -10000000000LL) { in lan8841_ptp_adjtime()
4788 ptp->gettime64(ptp, &ts); in lan8841_ptp_adjtime()
4793 ptp->settime64(ptp, &ts); in lan8841_ptp_adjtime()
4797 sec = div_u64_rem(delta < 0 ? -delta : delta, NSEC_PER_SEC, &nsec); in lan8841_ptp_adjtime()
4803 sec--; in lan8841_ptp_adjtime()
4804 nsec = NSEC_PER_SEC - nsec; in lan8841_ptp_adjtime()
4818 nsec -= NSEC_PER_SEC; in lan8841_ptp_adjtime()
4821 mutex_lock(&ptp_priv->ptp_lock); in lan8841_ptp_adjtime()
4838 mutex_unlock(&ptp_priv->ptp_lock); in lan8841_ptp_adjtime()
4841 ptp->gettime64(ptp, &ts); in lan8841_ptp_adjtime()
4842 mutex_lock(&ptp_priv->ptp_lock); in lan8841_ptp_adjtime()
4844 mutex_unlock(&ptp_priv->ptp_lock); in lan8841_ptp_adjtime()
4857 struct phy_device *phydev = ptp_priv->phydev; in lan8841_ptp_adjfine()
4865 scaled_ppm = -scaled_ppm; in lan8841_ptp_adjfine()
4872 mutex_lock(&ptp_priv->ptp_lock); in lan8841_ptp_adjfine()
4877 mutex_unlock(&ptp_priv->ptp_lock); in lan8841_ptp_adjfine()
4891 return -1; in lan8841_ptp_verify()
4904 struct phy_device *phydev = ptp_priv->phydev; in lan8841_ptp_perout_off()
4920 struct phy_device *phydev = ptp_priv->phydev; in lan8841_ptp_perout_on()
4950 struct phy_device *phydev = ptp_priv->phydev; in lan8841_ptp_remove_event()
4955 * pins 0-4 while GPIO_DATA_SEL2 contains GPIO pins 5-9, therefore in lan8841_ptp_remove_event()
4962 tmp = LAN8841_GPIO_DATA_SEL_GPIO_DATA_SEL_EVENT_MASK << (3 * (pin - 5)); in lan8841_ptp_remove_event()
4981 struct phy_device *phydev = ptp_priv->phydev; in lan8841_ptp_enable_event()
5002 * pins 0-4 while GPIO_DATA_SEL2 contains GPIO pins 5-9, therefore in lan8841_ptp_enable_event()
5015 tmp << (3 * (pin - 5))); in lan8841_ptp_enable_event()
5040 struct phy_device *phydev = ptp_priv->phydev; in lan8841_ptp_perout()
5047 if (rq->perout.flags & ~PTP_PEROUT_DUTY_CYCLE) in lan8841_ptp_perout()
5048 return -EOPNOTSUPP; in lan8841_ptp_perout()
5050 pin = ptp_find_pin(ptp_priv->ptp_clock, PTP_PF_PEROUT, rq->perout.index); in lan8841_ptp_perout()
5051 if (pin == -1 || pin >= LAN8841_PTP_GPIO_NUM) in lan8841_ptp_perout()
5052 return -EINVAL; in lan8841_ptp_perout()
5062 ts_on.tv_sec = rq->perout.on.sec; in lan8841_ptp_perout()
5063 ts_on.tv_nsec = rq->perout.on.nsec; in lan8841_ptp_perout()
5066 ts_period.tv_sec = rq->perout.period.sec; in lan8841_ptp_perout()
5067 ts_period.tv_nsec = rq->perout.period.nsec; in lan8841_ptp_perout()
5073 return -EOPNOTSUPP; in lan8841_ptp_perout()
5079 return -EINVAL; in lan8841_ptp_perout()
5132 mutex_lock(&ptp_priv->ptp_lock); in lan8841_ptp_perout()
5133 ret = lan8841_ptp_set_target(ptp_priv, LAN8841_EVENT_A, rq->perout.start.sec, in lan8841_ptp_perout()
5134 rq->perout.start.nsec); in lan8841_ptp_perout()
5135 mutex_unlock(&ptp_priv->ptp_lock); in lan8841_ptp_perout()
5139 ret = lan8841_ptp_set_reload(ptp_priv, LAN8841_EVENT_A, rq->perout.period.sec, in lan8841_ptp_perout()
5140 rq->perout.period.nsec); in lan8841_ptp_perout()
5164 struct phy_device *phydev = ptp_priv->phydev; in lan8841_ptp_extts_on()
5194 struct phy_device *phydev = ptp_priv->phydev; in lan8841_ptp_extts_off()
5229 if (rq->extts.flags & ~(PTP_ENABLE_FEATURE | in lan8841_ptp_extts()
5232 return -EOPNOTSUPP; in lan8841_ptp_extts()
5234 pin = ptp_find_pin(ptp_priv->ptp_clock, PTP_PF_EXTTS, rq->extts.index); in lan8841_ptp_extts()
5235 if (pin == -1 || pin >= LAN8841_PTP_GPIO_NUM) in lan8841_ptp_extts()
5236 return -EINVAL; in lan8841_ptp_extts()
5238 mutex_lock(&ptp_priv->ptp_lock); in lan8841_ptp_extts()
5240 ret = lan8841_ptp_extts_on(ptp_priv, pin, rq->extts.flags); in lan8841_ptp_extts()
5243 mutex_unlock(&ptp_priv->ptp_lock); in lan8841_ptp_extts()
5251 switch (rq->type) { in lan8841_ptp_enable()
5257 return -EOPNOTSUPP; in lan8841_ptp_enable()
5270 lan8841_ptp_getseconds(&ptp_priv->ptp_clock_info, &ts); in lan8841_ptp_do_aux_work()
5272 spin_lock_irqsave(&ptp_priv->seconds_lock, flags); in lan8841_ptp_do_aux_work()
5273 ptp_priv->seconds = ts.tv_sec; in lan8841_ptp_do_aux_work()
5274 spin_unlock_irqrestore(&ptp_priv->seconds_lock, flags); in lan8841_ptp_do_aux_work()
5311 phydev->interface = PHY_INTERFACE_MODE_RGMII_RXID; in lan8841_probe()
5317 priv = phydev->priv; in lan8841_probe()
5318 ptp_priv = &priv->ptp_priv; in lan8841_probe()
5320 ptp_priv->pin_config = devm_kcalloc(&phydev->mdio.dev, in lan8841_probe()
5322 sizeof(*ptp_priv->pin_config), in lan8841_probe()
5324 if (!ptp_priv->pin_config) in lan8841_probe()
5325 return -ENOMEM; in lan8841_probe()
5328 struct ptp_pin_desc *p = &ptp_priv->pin_config[i]; in lan8841_probe()
5330 snprintf(p->name, sizeof(p->name), "pin%d", i); in lan8841_probe()
5331 p->index = i; in lan8841_probe()
5332 p->func = PTP_PF_NONE; in lan8841_probe()
5335 ptp_priv->ptp_clock_info = lan8841_ptp_clock_info; in lan8841_probe()
5336 ptp_priv->ptp_clock_info.pin_config = ptp_priv->pin_config; in lan8841_probe()
5337 ptp_priv->ptp_clock = ptp_clock_register(&ptp_priv->ptp_clock_info, in lan8841_probe()
5338 &phydev->mdio.dev); in lan8841_probe()
5339 if (IS_ERR(ptp_priv->ptp_clock)) { in lan8841_probe()
5341 PTR_ERR(ptp_priv->ptp_clock)); in lan8841_probe()
5342 return -EINVAL; in lan8841_probe()
5345 if (!ptp_priv->ptp_clock) in lan8841_probe()
5349 skb_queue_head_init(&ptp_priv->tx_queue); in lan8841_probe()
5350 ptp_priv->phydev = phydev; in lan8841_probe()
5351 mutex_init(&ptp_priv->ptp_lock); in lan8841_probe()
5352 spin_lock_init(&ptp_priv->seconds_lock); in lan8841_probe()
5354 ptp_priv->mii_ts.rxtstamp = lan8841_rxtstamp; in lan8841_probe()
5355 ptp_priv->mii_ts.txtstamp = lan8814_txtstamp; in lan8841_probe()
5356 ptp_priv->mii_ts.hwtstamp = lan8841_hwtstamp; in lan8841_probe()
5357 ptp_priv->mii_ts.ts_info = lan8841_ts_info; in lan8841_probe()
5359 phydev->mii_ts = &ptp_priv->mii_ts; in lan8841_probe()
5362 phydev->default_timestamp = true; in lan8841_probe()
5384 struct kszphy_priv *priv = phydev->priv; in lan8841_suspend()
5385 struct kszphy_ptp_priv *ptp_priv = &priv->ptp_priv; in lan8841_suspend()
5387 if (ptp_priv->ptp_clock) in lan8841_suspend()
5388 ptp_cancel_worker_sync(ptp_priv->ptp_clock); in lan8841_suspend()