* [net-next 0/3] net: ethernet: adi: adin1110: add PTP support
@ 2023-01-20 9:53 Alexandru Tachici
2023-01-20 9:53 ` [net-next 1/3] net: ethernet: adi: adin1110: add PTP clock support Alexandru Tachici
` (3 more replies)
0 siblings, 4 replies; 9+ messages in thread
From: Alexandru Tachici @ 2023-01-20 9:53 UTC (permalink / raw)
To: linux-kernel
Cc: netdev, davem, edumazet, kuba, pabeni, richardcochran,
yangyingliang, weiyongjun1, robh+dt, krzysztof.kozlowski+dt,
devicetree, lennart
Add control for the PHC inside the ADIN1110/2111.
Device contains a syntonized counter driven by a 120 MHz
clock with 8 ns resolution.
Time is stored in two registers: a 32bit seconds register and
a 32bit nanoseconds register.
For adjusting the clock timing, device uses an addend register.
Can generate an output signal on the TS_TIMER pin.
For reading the timestamp the current tiem is saved by setting the
TS_CAPT pin via gpio in order to snapshot both seconds and nanoseconds
in different registers that the live ones.
Allow use of hardware RX/TX timestamping.
RX frames are automatically timestamped by the device at hardware
level when the feature is enabled. Time of day is the one used by the
MAC device.
When sending a TX frame to the MAC device, driver needs to send
a custom header ahead of the ethernet one where it specifies where
the MAC device should store the timestamp after the frame has
successfully been sent on the MII line. It has 3 timestamp slots that can
be read afterwards. Host will be notified by the TX_RDY IRQ.
root@analog:~# ethtool -T eth1
Time stamping parameters for eth1:
Capabilities:
hardware-transmit
software-transmit
hardware-receive
software-receive
software-system-clock
hardware-raw-clock
PTP Hardware Clock: 0
Hardware Transmit Timestamp Modes:
off
on
Hardware Receive Filter Modes:
none
all
root@analog:~# sudo phc2sys -s eth1 -c CLOCK_REALTIME -O 0 -m
phc2sys[4897.317]: CLOCK_REALTIME phc offset -511696 s0 freq -19464 delay 0
phc2sys[4898.317]: CLOCK_REALTIME phc offset -1023142 s1 freq -530689 delay 0
phc2sys[4899.318]: CLOCK_REALTIME phc offset -663 s2 freq -531352 delay 0
phc2sys[4900.318]: CLOCK_REALTIME phc offset -327 s2 freq -531215 delay 0
phc2sys[4901.318]: CLOCK_REALTIME phc offset -603 s2 freq -531589 delay 0
phc2sys[4902.318]: CLOCK_REALTIME phc offset 288 s2 freq -530879 delay 0
root@analog:~# ptp4l -m -f /etc/ptp_slave.conf
ptp4l[1188.692]: port 1: new foreign master 00800f.fffe.950400-1
ptp4l[1192.329]: selected best master clock 00800f.fffe.950400
ptp4l[1192.329]: foreign master not using PTP timescale
ptp4l[1192.329]: port 1: LISTENING to UNCALIBRATED on RS_SLAVE
ptp4l[1194.129]: master offset 29379149 s0 freq -297035 path delay -810558
ptp4l[1195.929]: master offset 32040450 s1 freq +512000 path delay -810558
ptp4l[1198.058]: master offset 1608389 s2 freq +512000 path delay -810558
ptp4l[1198.058]: port 1: UNCALIBRATED to SLAVE on MASTER_CLOCK_SELECTED
ptp4l[1199.529]: clockcheck: clock jumped forward or running faster than expected!
ptp4l[1199.529]: master offset 2419241 s0 freq +512000 path delay -810558
ptp4l[1199.529]: port 1: SLAVE to UNCALIBRATED on SYNCHRONIZATION_FAULT
ptp4l[1201.329]: master offset 2004645 s0 freq +512000 path delay -810558
ptp4l[1203.130]: master offset 1618970 s1 freq +319234 path delay -810558
ptp4l[1204.930]: master offset -1098742 s2 freq -230137 path delay -810558
ptp4l[1204.930]: port 1: UNCALIBRATED to SLAVE on MASTER_CLOCK_SELECTED
ptp4l[1206.730]: master offset -1689657 s2 freq -512000 path delay -810558
ptp4l[1208.530]: master offset -1692389 s2 freq -512000 path delay -345770
ptp4l[1210.330]: master offset -404021 s2 freq -47588 path delay -166813
ptp4l[1212.130]: master offset 1098174 s2 freq +512000 path delay -104916
ptp4l[1214.061]: master offset 1579741 s2 freq +512000 path delay -60321
ptp4l[1215.730]: master offset 1180121 s2 freq +512000 path delay -60321
ptp4l[1217.531]: master offset -345392 s2 freq -78876 path delay -43020
Above ptp4l run was not the best as I do not have access (to my knowledge)
to an accurate PTP grandmaster. Foreign master here is just my laptop
(with only SW timestamping capabilities) with the
ptp4l service runnning and NTP disabled.
Alexandru Tachici (3):
net: ethernet: adi: adin1110: add PTP clock support
net: ethernet: adi: adin1110: add timestamping support
dt-bindings: net: adin1110: Document ts-capt pin
.../devicetree/bindings/net/adi,adin1110.yaml | 7 +
drivers/net/ethernet/adi/adin1110.c | 811 +++++++++++++++++-
2 files changed, 808 insertions(+), 10 deletions(-)
--
2.34.1
^ permalink raw reply [flat|nested] 9+ messages in thread
* [net-next 1/3] net: ethernet: adi: adin1110: add PTP clock support
2023-01-20 9:53 [net-next 0/3] net: ethernet: adi: adin1110: add PTP support Alexandru Tachici
@ 2023-01-20 9:53 ` Alexandru Tachici
2023-01-21 12:03 ` kernel test robot
2023-01-24 2:08 ` Andrew Lunn
2023-01-20 9:53 ` [net-next 2/3] net: ethernet: adi: adin1110: add timestamping support Alexandru Tachici
` (2 subsequent siblings)
3 siblings, 2 replies; 9+ messages in thread
From: Alexandru Tachici @ 2023-01-20 9:53 UTC (permalink / raw)
To: linux-kernel
Cc: netdev, davem, edumazet, kuba, pabeni, richardcochran,
yangyingliang, weiyongjun1, robh+dt, krzysztof.kozlowski+dt,
devicetree, lennart
Add control for the PHC inside the ADIN1110/2111.
Device contains a syntonized counter driven by a 120 MHz
clock with 8 ns resolution.
Time is stored on two registers: a 32bit seconds register and
a 32bit nanoseconds register.
For adjusting the clock timing, device uses an addend register.
Can generate an output signal on the TS_TIMER pin.
For reading the timestamp the current tiem is saved by setting the
TS_CAPT pin via gpio in order to snapshot both seconds and nanoseconds
in different registers that the live ones.
Signed-off-by: Alexandru Tachici <alexandru.tachici@analog.com>
---
drivers/net/ethernet/adi/adin1110.c | 385 ++++++++++++++++++++++++++++
1 file changed, 385 insertions(+)
diff --git a/drivers/net/ethernet/adi/adin1110.c b/drivers/net/ethernet/adi/adin1110.c
index 0805f249fff2..3c2d58f07a4a 100644
--- a/drivers/net/ethernet/adi/adin1110.c
+++ b/drivers/net/ethernet/adi/adin1110.c
@@ -8,6 +8,7 @@
#include <linux/bitfield.h>
#include <linux/bits.h>
#include <linux/cache.h>
+#include <linux/clocksource.h>
#include <linux/crc8.h>
#include <linux/etherdevice.h>
#include <linux/ethtool.h>
@@ -15,6 +16,7 @@
#include <linux/interrupt.h>
#include <linux/iopoll.h>
#include <linux/gpio.h>
+#include <linux/gpio/consumer.h>
#include <linux/kernel.h>
#include <linux/mii.h>
#include <linux/module.h>
@@ -22,6 +24,7 @@
#include <linux/regulator/consumer.h>
#include <linux/phy.h>
#include <linux/property.h>
+#include <linux/ptp_clock_kernel.h>
#include <linux/spi/spi.h>
#include <net/switchdev.h>
@@ -35,6 +38,8 @@
#define ADIN1110_CONFIG1 0x04
#define ADIN1110_CONFIG1_SYNC BIT(15)
+#define ADIN1110_CONFIG1_FTSE BIT(7)
+#define ADIN1110_CONFIG1_FTSS BIT(6)
#define ADIN1110_CONFIG2 0x06
#define ADIN2111_P2_FWD_UNK2HOST BIT(12)
@@ -78,6 +83,20 @@
#define ADIN1110_MAC_ADDR_MASK_UPR 0x70
#define ADIN1110_MAC_ADDR_MASK_LWR 0x71
+#define ADIN1110_MAC_TS_ADDEND 0x80
+#define ADIN1110_MAC_TS_SEC_CNT 0x82
+#define ADIN1110_MAC_TS_NS_CNT 0x83
+#define ADIN1110_MAC_TS_CFG 0x84
+#define ADIN1110_MAC_TS_CFG_EN BIT(0)
+#define ADIN1110_MAC_TS_CFG_CLR BIT(1)
+#define ADIN1110_MAC_TS_CFG_TIMER_STOP BIT(3)
+#define ADIN1110_MAC_TS_CFG_CAPT_CNT BIT(4)
+#define ADIN1110_MAC_TS_TIMER_HI 0x85
+#define ADIN1110_MAC_TS_TIMER_LO 0x86
+#define ADIN1110_MAC_TS_TIMER_START 0x88
+#define ADIN1110_MAC_TS_CAPT0 0x89
+#define ADIN1110_MAC_TS_CAPT1 0x8A
+
#define ADIN1110_RX_FSIZE 0x90
#define ADIN1110_RX 0x91
@@ -90,6 +109,19 @@
#define ADIN1110_MDIO_OP_WR 0x1
#define ADIN1110_MDIO_OP_RD 0x3
+/* ADIN2111 PHY PINMUX Controls */
+#define ADIN2111_PINMUX_CFG1 0x8C56
+#define ADIN2111_PINMUX_CFG1_DIGIO_TSCAPT GENMASK(5, 4)
+
+#define ADIN2111_PINMUX_CFG1_TSCAPT_TEST_1 BIT(5)
+#define ADIN2111_PINMUX_CFG1_NOT_ASSIGNED GENMASK(5, 4)
+
+/* ADIN2111 PHY LEDs Controls */
+#define ADIN2111_LED_CNTRL 0x8C82
+#define ADIN2111_LED_CNTRL_LED0_FUNCTION GENMASK(4, 0)
+
+#define ADIN2111_LED_CNTRL_TS_TIMER 0x17
+
#define ADIN1110_CD BIT(7)
#define ADIN1110_WRITE BIT(5)
@@ -114,6 +146,11 @@
#define ADIN_MAC_P2_ADDR_SLOT 3
#define ADIN_MAC_FDB_ADDR_SLOT 4
+#define ADIN_MAC_MAX_PTP_PINS 2
+#define ADIN_MAC_MAX_TS_SLOTS 3
+
+#define adin1110_ptp_to_priv(x) container_of(x, struct adin1110_priv, ptp)
+
DECLARE_CRC8_TABLE(adin1110_crc_table);
enum adin1110_chips_id {
@@ -150,6 +187,11 @@ struct adin1110_port_priv {
struct adin1110_priv {
struct mutex lock; /* protect spi */
spinlock_t state_lock; /* protect RX mode */
+ bool ts_rx_append;
+ struct ptp_clock_info ptp;
+ struct ptp_clock *ptp_clock;
+ struct gpio_desc *ts_capt;
+ struct ptp_pin_desc ptp_pins[ADIN_MAC_MAX_PTP_PINS];
struct mii_bus *mii_bus;
struct spi_device *spidev;
bool append_crc;
@@ -1640,6 +1682,343 @@ static int adin1110_probe_netdevs(struct adin1110_priv *priv)
return 0;
}
+/* ADIN1110 has a syntonized counter driven by an internal 120 MHz clock, a 64-bit
+ * counter in which the lower 32 bits represent nanoseconds with 1 LSB = 1 ns.
+ * Frequency is adjusted by modifying the addend register.
+ */
+static int adin1110_ptp_adjfine(struct ptp_clock_info *ptp, long scaled_ppm)
+{
+ struct adin1110_priv *priv = adin1110_ptp_to_priv(ptp);
+ bool negative = false;
+ u64 ts_addend;
+ u64 diff;
+ u32 val;
+ int ret;
+
+ mutex_lock(&priv->lock);
+
+ ret = adin1110_read_reg(priv, ADIN1110_MAC_TS_ADDEND, &val);
+ if (ret < 0)
+ goto out;
+
+ ts_addend = val;
+
+ if (scaled_ppm < 0) {
+ negative = true;
+ scaled_ppm = -scaled_ppm;
+ }
+
+ diff = mul_u64_u64_div_u64(ts_addend, (u64)scaled_ppm, 1000000ULL << 16);
+ if (negative)
+ val = ts_addend - diff;
+ else
+ val = ts_addend + diff;
+
+ ret = adin1110_write_reg(priv, ADIN1110_MAC_TS_ADDEND, val);
+out:
+ mutex_unlock(&priv->lock);
+ return ret;
+}
+
+static int adin1110_ptp_read_ts_capt(struct adin1110_priv *priv,
+ struct timespec64 *ts,
+ struct ptp_system_timestamp *sts,
+ struct ktime_timestamps *snap)
+{
+ u32 val;
+ int ret;
+
+ mutex_lock(&priv->lock);
+
+ if (sts)
+ ptp_read_system_prets(sts);
+
+ if (snap)
+ ktime_get_fast_timestamps(snap);
+
+ gpiod_set_value(priv->ts_capt, 1);
+ fsleep(1);
+ gpiod_set_value(priv->ts_capt, 0);
+
+ ret = adin1110_read_reg(priv, ADIN1110_MAC_TS_CAPT0, &val);
+ if (ret < 0)
+ goto out;
+ /* No TS captured when nsecs == 0 */
+ if (!val) {
+ ret = -EINVAL;
+ goto out;
+ }
+
+ ts->tv_nsec = val;
+
+ ret = adin1110_read_reg(priv, ADIN1110_MAC_TS_CAPT1, &val);
+ if (ret < 0)
+ goto out;
+ if (sts)
+ ptp_read_system_postts(sts);
+
+ ts->tv_sec = val;
+out:
+ mutex_unlock(&priv->lock);
+
+ return ret;
+}
+
+static int adin1110_ptp_settime64(struct ptp_clock_info *ptp,
+ const struct timespec64 *ts)
+{
+ struct adin1110_priv *priv = adin1110_ptp_to_priv(ptp);
+ u32 addend;
+ int ret;
+
+ mutex_lock(&priv->lock);
+
+ ret = adin1110_read_reg(priv, ADIN1110_MAC_TS_ADDEND, &addend);
+ if (ret < 0)
+ goto out;
+
+ ret = adin1110_write_reg(priv, ADIN1110_MAC_TS_ADDEND, 0);
+ if (ret < 0)
+ goto out;
+
+ ret = adin1110_write_reg(priv, ADIN1110_MAC_TS_NS_CNT,
+ ALIGN(ts->tv_nsec, 16));
+ if (ret < 0)
+ goto out;
+
+ ret = adin1110_write_reg(priv, ADIN1110_MAC_TS_SEC_CNT,
+ ts->tv_sec);
+ if (ret < 0)
+ goto out;
+
+ ret = adin1110_write_reg(priv, ADIN1110_MAC_TS_ADDEND, addend);
+out:
+ mutex_unlock(&priv->lock);
+
+ return ret;
+}
+
+static int adin1110_ptp_adjtime(struct ptp_clock_info *ptp, s64 delta)
+{
+ struct adin1110_priv *priv = adin1110_ptp_to_priv(ptp);
+ struct timespec64 ts;
+ u64 dev_time;
+ int ret;
+
+ ret = adin1110_ptp_read_ts_capt(priv, &ts, NULL, NULL);
+ if (ret < 0)
+ return ret;
+
+ dev_time = timespec64_to_ns(&ts);
+ dev_time += delta;
+
+ ts = ns_to_timespec64(dev_time);
+
+ return adin1110_ptp_settime64(ptp, &ts);
+}
+
+static int adin1110_ptp_gettimex64(struct ptp_clock_info *ptp,
+ struct timespec64 *ts,
+ struct ptp_system_timestamp *sts)
+{
+ struct adin1110_priv *priv = adin1110_ptp_to_priv(ptp);
+
+ return adin1110_ptp_read_ts_capt(priv, ts, sts, NULL);
+}
+
+static int adin1110_ptp_getcrosststamp(struct ptp_clock_info *ptp,
+ struct system_device_crosststamp *cts)
+{
+ struct adin1110_priv *priv = adin1110_ptp_to_priv(ptp);
+ struct ktime_timestamps snap;
+ struct timespec64 ts;
+ int ret;
+
+ ret = adin1110_ptp_read_ts_capt(priv, &ts, NULL, &snap);
+ if (ret < 0)
+ return ret;
+
+ cts->device = timespec64_to_ktime(ts);
+ cts->sys_realtime = snap.real;
+ cts->sys_monoraw = snap.mono;
+
+ return 0;
+}
+
+static int adin1110_enable_perout(struct adin1110_priv *priv,
+ struct ptp_perout_request perout,
+ int on)
+{
+ u32 on_nsec;
+ u32 phase;
+ u32 mask;
+ int ret;
+
+ if (priv->cfg->id == ADIN2111_MAC) {
+ ret = phy_clear_bits_mmd(priv->ports[0]->phydev, MDIO_MMD_VEND1,
+ ADIN2111_LED_CNTRL,
+ ADIN2111_LED_CNTRL_LED0_FUNCTION);
+ if (ret < 0)
+ return ret;
+
+ ret = phy_set_bits_mmd(priv->ports[0]->phydev, MDIO_MMD_VEND1,
+ ADIN2111_LED_CNTRL,
+ on ? ADIN2111_LED_CNTRL_TS_TIMER : 0);
+ if (ret < 0)
+ return ret;
+ }
+
+ mutex_lock(&priv->lock);
+
+ ret = adin1110_set_bits(priv, ADIN1110_MAC_TS_CFG,
+ ADIN1110_MAC_TS_CFG_CLR,
+ ADIN1110_MAC_TS_CFG_CLR);
+ if (ret < 0)
+ goto out;
+
+ if (perout.flags & PTP_PEROUT_DUTY_CYCLE)
+ on_nsec = perout.on.nsec;
+ else
+ on_nsec = perout.period.nsec / 2;
+
+ ret = adin1110_write_reg(priv, ADIN1110_MAC_TS_TIMER_HI,
+ ALIGN(on_nsec, 16));
+ if (ret < 0)
+ goto out;
+
+ ret = adin1110_write_reg(priv, ADIN1110_MAC_TS_TIMER_LO,
+ ALIGN((perout.period.nsec - on_nsec), 16));
+ if (ret < 0)
+ goto out;
+
+ if (perout.flags & PTP_PEROUT_PHASE)
+ phase = ALIGN(perout.phase.nsec, 16);
+ else
+ phase = 0;
+
+ /* TS_TIMER_START reg must be written to a value >= 16 because of how
+ * the syntonized counter was implemented.
+ */
+ if (phase < 16)
+ phase = 16;
+
+ if (on) {
+ ret = adin1110_write_reg(priv, ADIN1110_MAC_TS_TIMER_START,
+ phase);
+ if (ret < 0)
+ goto out;
+ }
+
+ mask = ADIN1110_MAC_TS_CFG_EN | ADIN1110_MAC_TS_CFG_TIMER_STOP;
+ ret = adin1110_set_bits(priv, ADIN1110_MAC_TS_CFG, mask,
+ on ? ADIN1110_MAC_TS_CFG_EN : ADIN1110_MAC_TS_CFG_TIMER_STOP);
+ if (ret < 0)
+ goto out;
+
+ ret = adin1110_set_bits(priv, ADIN1110_CONFIG1, ADIN1110_CONFIG1_SYNC,
+ ADIN1110_CONFIG1_SYNC);
+out:
+ mutex_unlock(&priv->lock);
+ return ret;
+}
+
+static int adin1110_enable_extts(struct adin1110_priv *priv,
+ struct ptp_extts_request extts,
+ int on)
+{
+ u32 val;
+ int ret;
+
+ if (extts.index >= priv->ptp.n_ext_ts)
+ return -EINVAL;
+
+ if (priv->cfg->id == ADIN2111_MAC) {
+ ret = phy_clear_bits_mmd(priv->ports[0]->phydev, MDIO_MMD_VEND1,
+ ADIN2111_PINMUX_CFG1,
+ ADIN2111_PINMUX_CFG1_DIGIO_TSCAPT);
+ if (ret < 0)
+ return ret;
+
+ val = on ? ADIN2111_PINMUX_CFG1_TSCAPT_TEST_1 : ADIN2111_PINMUX_CFG1_NOT_ASSIGNED;
+ ret = phy_set_bits_mmd(priv->ports[0]->phydev, MDIO_MMD_VEND1,
+ ADIN2111_PINMUX_CFG1_DIGIO_TSCAPT, val);
+ if (ret < 0)
+ return ret;
+ }
+
+ mutex_lock(&priv->lock);
+ ret = adin1110_set_bits(priv, ADIN1110_MAC_TS_CFG,
+ ADIN1110_MAC_TS_CFG_EN,
+ on ? ADIN1110_MAC_TS_CFG_EN : 0);
+ if (ret < 0)
+ goto out;
+
+ ret = adin1110_set_bits(priv, ADIN1110_CONFIG1,
+ ADIN1110_CONFIG1_SYNC,
+ ADIN1110_CONFIG1_SYNC);
+out:
+ mutex_unlock(&priv->lock);
+ return ret;
+}
+
+static int adin1110_ptp_enable(struct ptp_clock_info *ptp,
+ struct ptp_clock_request *request, int on)
+{
+ struct adin1110_priv *priv = adin1110_ptp_to_priv(ptp);
+
+ switch (request->type) {
+ case PTP_CLK_REQ_EXTTS:
+ return adin1110_enable_extts(priv, request->extts, on);
+ case PTP_CLK_REQ_PEROUT:
+ return adin1110_enable_perout(priv, request->perout, on);
+ case PTP_CLK_REQ_PPS:
+ default:
+ return -EOPNOTSUPP;
+ }
+}
+
+static int adin1110_setup_ptp(struct adin1110_priv *priv)
+{
+ priv->ts_capt = devm_gpiod_get_optional(&priv->spidev->dev, "ts-capt",
+ GPIOD_OUT_LOW);
+ if (!priv->ts_capt)
+ return 0;
+
+ snprintf(priv->ptp_pins[0].name, 64, "%s-%u-ptp-per-out",
+ priv->cfg->name, priv->spidev->chip_select);
+ priv->ptp_pins[0].index = 0;
+ priv->ptp_pins[0].func = PTP_PF_PEROUT;
+ priv->ptp_pins[0].chan = 0;
+
+ snprintf(priv->ptp_pins[1].name, 64, "%s-%u-ptp-ext-ts",
+ priv->cfg->name, priv->spidev->chip_select);
+ priv->ptp_pins[1].index = 1;
+ priv->ptp_pins[1].func = PTP_PF_EXTTS;
+ priv->ptp_pins[1].chan = 0;
+
+ priv->ptp.owner = THIS_MODULE;
+ snprintf(priv->ptp.name, PTP_CLOCK_NAME_LEN, "%s-%u-ptp",
+ priv->cfg->name, priv->spidev->chip_select);
+
+ priv->ptp.max_adj = 512000;
+ priv->ptp.n_ext_ts = 1;
+ priv->ptp.n_per_out = 1;
+ priv->ptp.n_pins = ADIN_MAC_MAX_PTP_PINS;
+ priv->ptp.pin_config = priv->ptp_pins;
+ priv->ptp.adjfine = adin1110_ptp_adjfine;
+ priv->ptp.adjtime = adin1110_ptp_adjtime;
+ priv->ptp.gettimex64 = adin1110_ptp_gettimex64;
+ priv->ptp.getcrosststamp = adin1110_ptp_getcrosststamp;
+ priv->ptp.settime64 = adin1110_ptp_settime64;
+ priv->ptp.enable = adin1110_ptp_enable;
+
+ priv->ptp_clock = ptp_clock_register(&priv->ptp, &priv->spidev->dev);
+ if (IS_ERR(priv->ptp_clock))
+ return PTR_ERR(priv->ptp_clock);
+
+ return 0;
+}
+
static int adin1110_probe(struct spi_device *spi)
{
const struct spi_device_id *dev_id = spi_get_device_id(spi);
@@ -1680,6 +2059,12 @@ static int adin1110_probe(struct spi_device *spi)
return ret;
}
+ ret = adin1110_setup_ptp(priv);
+ if (ret < 0) {
+ dev_err(dev, "Could not register PTP clock %d\n", ret);
+ return ret;
+ }
+
return adin1110_probe_netdevs(priv);
}
--
2.34.1
^ permalink raw reply related [flat|nested] 9+ messages in thread
* [net-next 2/3] net: ethernet: adi: adin1110: add timestamping support
2023-01-20 9:53 [net-next 0/3] net: ethernet: adi: adin1110: add PTP support Alexandru Tachici
2023-01-20 9:53 ` [net-next 1/3] net: ethernet: adi: adin1110: add PTP clock support Alexandru Tachici
@ 2023-01-20 9:53 ` Alexandru Tachici
2023-01-20 9:53 ` [net-next 3/3] dt-bindings: net: adin1110: Document ts-capt pin Alexandru Tachici
2023-01-21 5:55 ` [net-next 0/3] net: ethernet: adi: adin1110: add PTP support Jakub Kicinski
3 siblings, 0 replies; 9+ messages in thread
From: Alexandru Tachici @ 2023-01-20 9:53 UTC (permalink / raw)
To: linux-kernel
Cc: netdev, davem, edumazet, kuba, pabeni, richardcochran,
yangyingliang, weiyongjun1, robh+dt, krzysztof.kozlowski+dt,
devicetree, lennart
Add timestamping support for RX/TX.
RX frames are automatically timestamped by the device at hardware
level when the feature is enabled. Time of day is the one used by the
MAC device.
When sending a TX frame to the MAC device, driver needs to send
a custom header ahead of the ethernet one where it specifies where
the MAC device should store the timestamp after the frame has
successfully been sent on the MII line. It has 3 timestamp slots that can
be read afterwards. Host will be notified by the TX_RDY IRQ.
Signed-off-by: Alexandru Tachici <alexandru.tachici@analog.com>
---
drivers/net/ethernet/adi/adin1110.c | 426 +++++++++++++++++++++++++++-
1 file changed, 416 insertions(+), 10 deletions(-)
diff --git a/drivers/net/ethernet/adi/adin1110.c b/drivers/net/ethernet/adi/adin1110.c
index 3c2d58f07a4a..916972b91308 100644
--- a/drivers/net/ethernet/adi/adin1110.c
+++ b/drivers/net/ethernet/adi/adin1110.c
@@ -48,13 +48,27 @@
#define ADIN1110_FWD_UNK2HOST BIT(2)
#define ADIN1110_STATUS0 0x08
+#define ADIN1110_TTSCAXM_P1(slot) BIT(8 + (slot))
#define ADIN1110_STATUS1 0x09
+#define ADIN1110_TTSCAXM_P2(slot) BIT(20 + (slot))
#define ADIN2111_P2_RX_RDY BIT(17)
#define ADIN1110_SPI_ERR BIT(10)
#define ADIN1110_RX_RDY BIT(4)
+#define ADIN1110_TX_RDY BIT(3)
+
+#define ADIN1110_TTSCAXM_PY(slot, port) ((port) ? \
+ ADIN1110_TTSCAXM_P2(slot) : \
+ ADIN1110_TTSCAXM_P1(slot))
+
+#define ADIN1110_P1_TTSCXH(slot) (0x10 + 2 * (slot))
+#define ADIN1110_P1_TTSCXL(slot) (0x11 + 2 * (slot))
+
+#define ADIN1110_IMASK0 0x0C
+#define ADIN1110_TTSCAXM_P1_IRQ(slot) BIT(8 + (slot))
#define ADIN1110_IMASK1 0x0D
+#define ADIN1110_TTSCAXM_P2_IRQ(slot) BIT(20 + (slot))
#define ADIN2111_RX_RDY_IRQ BIT(17)
#define ADIN1110_SPI_ERR_IRQ BIT(10)
#define ADIN1110_RX_RDY_IRQ BIT(4)
@@ -103,7 +117,19 @@
#define ADIN2111_RX_P2_FSIZE 0xC0
#define ADIN2111_RX_P2 0xC1
+#define ADIN1110_P2_TTSCXH(slot) (0xF0 + 2 * (slot))
+#define ADIN1110_P2_TTSCXL(slot) (0xF1 + 2 * (slot))
+
+#define ADIN1110_PY_TTSCXH(slot, port) ((port) ? \
+ ADIN1110_P2_TTSCXH(slot) : \
+ ADIN1110_P1_TTSCXH(slot))
+
+#define ADIN1110_PY_TTSCXL(slot, port) ((port) ? \
+ ADIN1110_P2_TTSCXL(slot) \
+ : ADIN1110_P1_TTSCXL(slot))
+
#define ADIN1110_CLEAR_STATUS0 0xFFF
+#define ADIN1110_CLEAR_STATUS1 0xFFFFFFFF
/* MDIO_OP codes */
#define ADIN1110_MDIO_OP_WR 0x1
@@ -125,12 +151,18 @@
#define ADIN1110_CD BIT(7)
#define ADIN1110_WRITE BIT(5)
+/* ADIN1110 frame header fields */
+#define ADIN1110_FRAME_HEADER_PORT BIT(0)
+#define ADIN1110_FRAME_HEADER_TS_SLOT GENMASK(7, 6)
+#define ADIN1110_FRAME_HEADER_TS_PRESENT BIT(2)
+
#define ADIN1110_MAX_BUFF 2048
#define ADIN1110_MAX_FRAMES_READ 64
#define ADIN1110_WR_HEADER_LEN 2
#define ADIN1110_FRAME_HEADER_LEN 2
#define ADIN1110_INTERNAL_SIZE_HEADER_LEN 2
#define ADIN1110_RD_HEADER_LEN 3
+#define ADIN1110_TS_LEN 8
#define ADIN1110_REG_LEN 4
#define ADIN1110_FEC_LEN 4
@@ -181,6 +213,9 @@ struct adin1110_port_priv {
struct sk_buff_head txq;
u32 nr;
u32 state;
+ bool ts_rx_en;
+ bool ts_tx_en;
+ struct sk_buff *ts_slots[ADIN_MAC_MAX_TS_SLOTS];
struct adin1110_cfg *cfg;
};
@@ -197,7 +232,6 @@ struct adin1110_priv {
bool append_crc;
struct adin1110_cfg *cfg;
u32 tx_space;
- u32 irq_mask;
bool forwarding;
int irq;
struct adin1110_port_priv *ports[ADIN_MAC_MAX_PORTS];
@@ -332,8 +366,29 @@ static int adin1110_round_len(int len)
return len;
}
+static void adin1110_get_rx_timestamp(struct sk_buff *rxb, int offset)
+{
+ struct skb_shared_hwtstamps *shhwtstamps = skb_hwtstamps(rxb);
+ struct timespec64 ts;
+ u16 frame_header;
+
+ frame_header = get_unaligned_be16(&rxb->data[0]);
+ if (!(frame_header & ADIN1110_FRAME_HEADER_TS_PRESENT))
+ return;
+
+ /* First data after the custom SPI frame header is the timestamp, if
+ * it was signaled by the TS_PRESENT flag.
+ */
+ ts.tv_sec = get_unaligned_be32(&rxb->data[offset]);
+ ts.tv_nsec = get_unaligned_be32(&rxb->data[offset + ADIN1110_REG_LEN]);
+
+ memset(shhwtstamps, 0, sizeof(*shhwtstamps));
+ shhwtstamps->hwtstamp = timespec64_to_ktime(ts);
+}
+
static int adin1110_read_fifo(struct adin1110_port_priv *port_priv)
{
+ u32 frame_header_len = ADIN1110_FRAME_HEADER_LEN;
struct adin1110_priv *priv = port_priv->priv;
u32 header_len = ADIN1110_RD_HEADER_LEN;
struct spi_transfer t;
@@ -356,10 +411,14 @@ static int adin1110_read_fifo(struct adin1110_port_priv *port_priv)
if (ret < 0)
return ret;
- /* The read frame size includes the extra 2 bytes
- * from the ADIN1110 frame header.
+ /* If timestamping is enabled the received data will also have an additional 8 bytes that
+ * make up the seconds + nanoseconds timestamp.
*/
- if (frame_size < ADIN1110_FRAME_HEADER_LEN + ADIN1110_FEC_LEN)
+ if (priv->ts_rx_append)
+ frame_header_len += ADIN1110_TS_LEN;
+
+ /* the read frame size includes the extra 2 bytes from the ADIN1110 frame header */
+ if (frame_size < frame_header_len + ADIN1110_FEC_LEN)
return ret;
round_len = adin1110_round_len(frame_size);
@@ -393,7 +452,11 @@ static int adin1110_read_fifo(struct adin1110_port_priv *port_priv)
return ret;
}
- skb_pull(rxb, header_len + ADIN1110_FRAME_HEADER_LEN);
+ if (priv->ts_rx_append)
+ adin1110_get_rx_timestamp(rxb, header_len + ADIN1110_FRAME_HEADER_LEN);
+
+ skb_pull(rxb, header_len + frame_header_len);
+
rxb->protocol = eth_type_trans(rxb, port_priv->netdev);
if ((port_priv->flags & IFF_ALLMULTI && rxb->pkt_type == PACKET_MULTICAST) ||
@@ -402,7 +465,7 @@ static int adin1110_read_fifo(struct adin1110_port_priv *port_priv)
netif_rx(rxb);
- port_priv->rx_bytes += frame_size - ADIN1110_FRAME_HEADER_LEN;
+ port_priv->rx_bytes += frame_size - frame_header_len;
port_priv->rx_packets++;
return 0;
@@ -417,6 +480,7 @@ static int adin1110_write_fifo(struct adin1110_port_priv *port_priv,
int padding = 0;
int padded_len;
int round_len;
+ u16 val = 0;
int ret;
/* Pad frame to 64 byte length,
@@ -448,7 +512,14 @@ static int adin1110_write_fifo(struct adin1110_port_priv *port_priv,
}
/* mention the port on which to send the frame in the frame header */
- frame_header = cpu_to_be16(port_priv->nr);
+ val = FIELD_PREP(ADIN1110_FRAME_HEADER_PORT, port_priv->nr);
+
+ /* Request TX capture for this frame in previously assign HW slot. */
+ if (port_priv->ts_tx_en && (skb_shinfo(txb)->tx_flags & SKBTX_IN_PROGRESS))
+ val |= FIELD_PREP(ADIN1110_FRAME_HEADER_TS_SLOT,
+ txb->cb[0] + 1);
+
+ frame_header = cpu_to_be16(val);
memcpy(&priv->data[header_len], &frame_header,
ADIN1110_FRAME_HEADER_LEN);
@@ -620,9 +691,72 @@ static void adin1110_wake_queues(struct adin1110_priv *priv)
netif_wake_queue(priv->ports[i]->netdev);
}
+static int adin1110_read_tx_timestamp(struct adin1110_priv *priv,
+ int port, int slot)
+{
+ struct skb_shared_hwtstamps shhwtstamps;
+ struct timespec64 ts;
+ struct sk_buff *skb;
+ u32 val;
+ int ret;
+
+ spin_lock(&priv->state_lock);
+ skb = priv->ports[port]->ts_slots[slot];
+ priv->ports[port]->ts_slots[slot] = NULL;
+ spin_unlock(&priv->state_lock);
+
+ /* Check if a SKB requested a timestamp from this slot. */
+ if (!skb)
+ return 0;
+
+ ret = adin1110_read_reg(priv, ADIN1110_PY_TTSCXH(slot, port), &val);
+ if (ret < 0)
+ goto out;
+
+ ts.tv_sec = val;
+
+ ret = adin1110_read_reg(priv, ADIN1110_PY_TTSCXL(slot, port), &val);
+ if (ret < 0)
+ goto out;
+
+ ts.tv_nsec = val;
+
+ /* Check if there is a timestamp actually saved. */
+ if (!ts.tv_sec && !ts.tv_nsec)
+ return 0;
+
+ shhwtstamps.hwtstamp = timespec64_to_ktime(ts);
+ skb_tstamp_tx(skb, &shhwtstamps);
+out:
+ dev_kfree_skb(skb);
+
+ return ret;
+}
+
+static int adin1110_handle_tx_timestamps(struct adin1110_priv *priv, u32 status)
+{
+ int port;
+ int slot;
+ int ret;
+
+ for (port = 0; port < priv->cfg->ports_nr; port++) {
+ if (!priv->ports[port]->ts_tx_en || !(status & ADIN1110_TX_RDY))
+ continue;
+
+ for (slot = 0; slot < ADIN_MAC_MAX_TS_SLOTS; slot++) {
+ ret = adin1110_read_tx_timestamp(priv, port, slot);
+ if (ret < 0)
+ return ret;
+ }
+ }
+
+ return 0;
+}
+
static irqreturn_t adin1110_irq(int irq, void *p)
{
struct adin1110_priv *priv = p;
+ u32 status0;
u32 status1;
u32 val;
int ret;
@@ -630,6 +764,10 @@ static irqreturn_t adin1110_irq(int irq, void *p)
mutex_lock(&priv->lock);
+ ret = adin1110_read_reg(priv, ADIN1110_STATUS1, &status0);
+ if (ret < 0)
+ goto out;
+
ret = adin1110_read_reg(priv, ADIN1110_STATUS1, &status1);
if (ret < 0)
goto out;
@@ -638,6 +776,10 @@ static irqreturn_t adin1110_irq(int irq, void *p)
dev_warn_ratelimited(&priv->spidev->dev,
"SPI CRC error on write.\n");
+ ret = adin1110_handle_tx_timestamps(priv, status1);
+ if (ret < 0)
+ goto out;
+
ret = adin1110_read_reg(priv, ADIN1110_TX_SPACE, &val);
if (ret < 0)
goto out;
@@ -653,7 +795,7 @@ static irqreturn_t adin1110_irq(int irq, void *p)
/* clear IRQ sources */
adin1110_write_reg(priv, ADIN1110_STATUS0, ADIN1110_CLEAR_STATUS0);
- adin1110_write_reg(priv, ADIN1110_STATUS1, priv->irq_mask);
+ adin1110_write_reg(priv, ADIN1110_STATUS1, ADIN1110_CLEAR_STATUS1);
out:
mutex_unlock(&priv->lock);
@@ -824,11 +966,193 @@ static int adin1110_ndo_set_mac_address(struct net_device *netdev, void *addr)
return adin1110_set_mac_address(netdev, sa->sa_data);
}
+static int adin1110_hw_timestamping(struct adin1110_priv *priv, bool enable)
+{
+ int ret;
+
+ mutex_lock(&priv->lock);
+
+ ret = adin1110_set_bits(priv, ADIN1110_MAC_TS_CFG,
+ ADIN1110_MAC_TS_CFG_EN,
+ enable ? ADIN1110_MAC_TS_CFG_EN : 0);
+ if (ret < 0)
+ goto out;
+
+ ret = adin1110_set_bits(priv, ADIN1110_CONFIG1,
+ ADIN1110_CONFIG1_FTSE,
+ enable ? ADIN1110_CONFIG1_FTSE : 0);
+ if (ret < 0)
+ goto out;
+
+ /* use only 64 bit timestamps */
+ ret = adin1110_set_bits(priv, ADIN1110_CONFIG1, ADIN1110_CONFIG1_FTSS,
+ enable ? ADIN1110_CONFIG1_FTSS : 0);
+ if (ret < 0)
+ goto out;
+
+ /* Even if timestamping is enabled just for TX frames, RX frames
+ * will start showing up with timestamps appended. Need to know
+ * this when receivng frames from the SPI.
+ */
+ priv->ts_rx_append = enable;
+
+ ret = adin1110_set_bits(priv, ADIN1110_CONFIG1, ADIN1110_CONFIG1_SYNC,
+ ADIN1110_CONFIG1_SYNC);
+out:
+ mutex_unlock(&priv->lock);
+
+ return ret;
+}
+
+/* ADIN1110 can track for each port 3 TX frames at a time that are stored
+ * for transfer in the FIFOs. When a TX frame will be sent by the MAC-PHY,
+ * a timestamp will be stored and an IRQ will be trigger, signaling
+ * the capture of the timestamp.
+ */
+static int adin1110_tx_ts_rdy_irq(struct adin1110_port_priv *port_priv,
+ bool enable)
+{
+ struct adin1110_priv *priv = port_priv->priv;
+ int ret;
+ u32 val;
+
+ if (port_priv->nr)
+ val = ADIN1110_TTSCAXM_P2_IRQ(0) | ADIN1110_TTSCAXM_P2_IRQ(1) |
+ ADIN1110_TTSCAXM_P2_IRQ(2);
+ else
+ val = ADIN1110_TTSCAXM_P1_IRQ(0) | ADIN1110_TTSCAXM_P1_IRQ(1) |
+ ADIN1110_TTSCAXM_P1_IRQ(2);
+
+ mutex_lock(&priv->lock);
+ if (port_priv->nr)
+ ret = adin1110_set_bits(priv, ADIN1110_IMASK1, val,
+ enable ? 0 : val);
+ else
+ ret = adin1110_set_bits(priv, ADIN1110_IMASK0, val,
+ enable ? 0 : val);
+ mutex_unlock(&priv->lock);
+ if (ret < 0)
+ return ret;
+
+ return 0;
+}
+
+static int adin1110_hw_tx_timestamp_enable(struct adin1110_port_priv *port_priv)
+{
+ struct adin1110_priv *priv = port_priv->priv;
+ int ret;
+
+ ret = adin1110_tx_ts_rdy_irq(port_priv, true);
+ if (ret < 0)
+ return ret;
+
+ port_priv->ts_tx_en = true;
+
+ return adin1110_hw_timestamping(priv, true);
+}
+
+static int adin1110_hw_tx_timestamp_disable(struct adin1110_port_priv *port_priv)
+{
+ struct adin1110_priv *priv = port_priv->priv;
+ int ret;
+
+ ret = adin1110_tx_ts_rdy_irq(port_priv, false);
+ if (ret < 0)
+ return ret;
+
+ port_priv->ts_tx_en = false;
+
+ return adin1110_hw_timestamping(priv, false);
+}
+
+static int adin1110_hw_rx_timestamp_enable(struct adin1110_port_priv *port_priv)
+{
+ struct adin1110_priv *priv = port_priv->priv;
+
+ port_priv->ts_rx_en = true;
+
+ return adin1110_hw_timestamping(priv, true);
+}
+
+static int adin1110_hw_rx_timestamp_disable(struct adin1110_port_priv *port_priv)
+{
+ struct adin1110_priv *priv = port_priv->priv;
+
+ port_priv->ts_rx_en = false;
+
+ return adin1110_hw_timestamping(priv, false);
+}
+
+static int adin1110_ioctl_hw_timestamp(struct net_device *netdev,
+ struct ifreq *rq)
+{
+ struct adin1110_port_priv *port_priv = netdev_priv(netdev);
+ struct hwtstamp_config config;
+ int ret;
+
+ if (copy_from_user(&config, rq->ifr_data, sizeof(config)))
+ return -EFAULT;
+
+ switch (config.tx_type) {
+ case HWTSTAMP_TX_OFF:
+ ret = adin1110_hw_tx_timestamp_disable(port_priv);
+ break;
+ case HWTSTAMP_TX_ON:
+ ret = adin1110_hw_tx_timestamp_enable(port_priv);
+ break;
+ default:
+ return -ERANGE;
+ }
+
+ if (ret < 0)
+ return ret;
+
+ switch (config.rx_filter) {
+ case HWTSTAMP_FILTER_NONE:
+ ret = adin1110_hw_rx_timestamp_disable(port_priv);
+ break;
+ case HWTSTAMP_FILTER_ALL:
+ case HWTSTAMP_FILTER_SOME:
+ case HWTSTAMP_FILTER_PTP_V1_L4_EVENT:
+ case HWTSTAMP_FILTER_PTP_V1_L4_SYNC:
+ case HWTSTAMP_FILTER_PTP_V1_L4_DELAY_REQ:
+ case HWTSTAMP_FILTER_PTP_V2_L4_EVENT:
+ case HWTSTAMP_FILTER_PTP_V2_L4_SYNC:
+ case HWTSTAMP_FILTER_PTP_V2_L4_DELAY_REQ:
+ case HWTSTAMP_FILTER_PTP_V2_L2_EVENT:
+ case HWTSTAMP_FILTER_PTP_V2_L2_SYNC:
+ case HWTSTAMP_FILTER_PTP_V2_L2_DELAY_REQ:
+ case HWTSTAMP_FILTER_PTP_V2_EVENT:
+ case HWTSTAMP_FILTER_PTP_V2_SYNC:
+ case HWTSTAMP_FILTER_PTP_V2_DELAY_REQ:
+ case HWTSTAMP_FILTER_NTP_ALL:
+ ret = adin1110_hw_rx_timestamp_enable(port_priv);
+ config.rx_filter = HWTSTAMP_FILTER_PTP_V2_L2_EVENT;
+ break;
+ default:
+ return -ERANGE;
+ }
+
+ if (ret < 0)
+ return ret;
+
+ if (copy_to_user(rq->ifr_data, &config, sizeof(config)))
+ return -EFAULT;
+
+ return 0;
+}
+
static int adin1110_ioctl(struct net_device *netdev, struct ifreq *rq, int cmd)
{
+ struct adin1110_port_priv *port_priv = netdev_priv(netdev);
+ struct adin1110_priv *priv = port_priv->priv;
+
if (!netif_running(netdev))
return -EINVAL;
+ if (priv->ptp_clock && cmd == SIOCSHWTSTAMP)
+ return adin1110_ioctl_hw_timestamp(netdev, rq);
+
return phy_do_ioctl(netdev, rq, cmd);
}
@@ -940,7 +1264,6 @@ static int adin1110_net_open(struct net_device *net_dev)
if (priv->cfg->id == ADIN2111_MAC)
val |= ADIN2111_RX_RDY_IRQ;
- priv->irq_mask = val;
ret = adin1110_write_reg(priv, ADIN1110_IMASK1, ~val);
if (ret < 0) {
netdev_err(net_dev, "Failed to enable chip IRQs: %d\n", ret);
@@ -995,6 +1318,14 @@ static int adin1110_net_stop(struct net_device *net_dev)
if (ret < 0)
return ret;
+ ret = adin1110_hw_rx_timestamp_disable(port_priv);
+ if (ret < 0)
+ return ret;
+
+ ret = adin1110_hw_tx_timestamp_disable(port_priv);
+ if (ret < 0)
+ return ret;
+
netif_stop_queue(port_priv->netdev);
flush_work(&port_priv->tx_work);
phy_stop(port_priv->phydev);
@@ -1015,17 +1346,62 @@ static void adin1110_tx_work(struct work_struct *work)
mutex_lock(&priv->lock);
while ((txb = skb_dequeue(&port_priv->txq))) {
+ if (skb_shinfo(txb)->tx_flags & SKBTX_SW_TSTAMP)
+ skb_tx_timestamp(txb);
+
ret = adin1110_write_fifo(port_priv, txb);
if (ret < 0)
dev_err_ratelimited(&priv->spidev->dev,
"Frame write error: %d\n", ret);
- dev_kfree_skb(txb);
+ /* If we do not expect a HW timestamp for the SKB free it here */
+ if (!(skb_shinfo(txb)->tx_flags & SKBTX_IN_PROGRESS))
+ dev_kfree_skb(txb);
}
mutex_unlock(&priv->lock);
}
+static void adin1110_assign_ts_slot(struct adin1110_port_priv *port_priv,
+ struct sk_buff *skb)
+{
+ struct adin1110_priv *priv = port_priv->priv;
+ int i;
+
+ if (!port_priv->ts_tx_en)
+ return;
+
+ spin_lock(&priv->state_lock);
+
+ for (i = 0; i < ADIN_MAC_MAX_TS_SLOTS; i++) {
+ if (!port_priv->ts_slots[i])
+ break;
+ }
+
+ /* This should not happen. Report that an error occurred. */
+ if (i == ADIN_MAC_MAX_TS_SLOTS) {
+ for (i = 0; i < ADIN_MAC_MAX_TS_SLOTS; i++) {
+ dev_kfree_skb(port_priv->ts_slots[i]);
+ port_priv->ts_slots[i] = NULL;
+ }
+
+ dev_warn_ratelimited(&priv->spidev->dev,
+ "Time stamps slots full.\n");
+ i = 0;
+ }
+
+ skb_shinfo(skb)->tx_flags |= SKBTX_IN_PROGRESS;
+
+ /* Need to store the slot number we will be using to return
+ * the TX timestamp. This information will be shared with the device
+ * when frame is sent over SPI.
+ */
+ skb->cb[0] = i;
+ port_priv->ts_slots[i] = skb;
+
+ spin_unlock(&priv->state_lock);
+}
+
static netdev_tx_t adin1110_start_xmit(struct sk_buff *skb, struct net_device *dev)
{
struct adin1110_port_priv *port_priv = netdev_priv(dev);
@@ -1038,6 +1414,9 @@ static netdev_tx_t adin1110_start_xmit(struct sk_buff *skb, struct net_device *d
netif_stop_queue(dev);
netdev_ret = NETDEV_TX_BUSY;
} else {
+ if (skb_shinfo(skb)->tx_flags & SKBTX_HW_TSTAMP)
+ adin1110_assign_ts_slot(port_priv, skb);
+
priv->tx_space -= tx_space_needed;
skb_queue_tail(&port_priv->txq, skb);
}
@@ -1104,9 +1483,36 @@ static void adin1110_get_drvinfo(struct net_device *dev,
strscpy(di->bus_info, dev_name(dev->dev.parent), sizeof(di->bus_info));
}
+static int adin1110_get_ts_info(struct net_device *dev, struct ethtool_ts_info *info)
+{
+ struct adin1110_port_priv *port_priv = netdev_priv(dev);
+ struct adin1110_priv *priv = port_priv->priv;
+
+ info->so_timestamping = SOF_TIMESTAMPING_TX_SOFTWARE |
+ SOF_TIMESTAMPING_RX_SOFTWARE |
+ SOF_TIMESTAMPING_SOFTWARE |
+ SOF_TIMESTAMPING_TX_HARDWARE |
+ SOF_TIMESTAMPING_RX_HARDWARE |
+ SOF_TIMESTAMPING_RAW_HARDWARE;
+
+ info->tx_types = BIT(HWTSTAMP_TX_OFF) |
+ BIT(HWTSTAMP_TX_ON);
+
+ info->rx_filters = BIT(HWTSTAMP_FILTER_NONE) |
+ BIT(HWTSTAMP_FILTER_ALL);
+
+ if (priv->ptp_clock)
+ info->phc_index = ptp_clock_index(priv->ptp_clock);
+ else
+ info->phc_index = -1;
+
+ return 0;
+}
+
static const struct ethtool_ops adin1110_ethtool_ops = {
.get_drvinfo = adin1110_get_drvinfo,
.get_link = ethtool_op_get_link,
+ .get_ts_info = adin1110_get_ts_info,
.get_link_ksettings = phy_ethtool_get_link_ksettings,
.set_link_ksettings = phy_ethtool_set_link_ksettings,
};
--
2.34.1
^ permalink raw reply related [flat|nested] 9+ messages in thread
* [net-next 3/3] dt-bindings: net: adin1110: Document ts-capt pin
2023-01-20 9:53 [net-next 0/3] net: ethernet: adi: adin1110: add PTP support Alexandru Tachici
2023-01-20 9:53 ` [net-next 1/3] net: ethernet: adi: adin1110: add PTP clock support Alexandru Tachici
2023-01-20 9:53 ` [net-next 2/3] net: ethernet: adi: adin1110: add timestamping support Alexandru Tachici
@ 2023-01-20 9:53 ` Alexandru Tachici
2023-01-22 11:59 ` Krzysztof Kozlowski
2023-01-21 5:55 ` [net-next 0/3] net: ethernet: adi: adin1110: add PTP support Jakub Kicinski
3 siblings, 1 reply; 9+ messages in thread
From: Alexandru Tachici @ 2023-01-20 9:53 UTC (permalink / raw)
To: linux-kernel
Cc: netdev, davem, edumazet, kuba, pabeni, richardcochran,
yangyingliang, weiyongjun1, robh+dt, krzysztof.kozlowski+dt,
devicetree, lennart
Add documentation for the use of the timestamp capture pin.
Signed-off-by: Alexandru Tachici <alexandru.tachici@analog.com>
---
Documentation/devicetree/bindings/net/adi,adin1110.yaml | 7 +++++++
1 file changed, 7 insertions(+)
diff --git a/Documentation/devicetree/bindings/net/adi,adin1110.yaml b/Documentation/devicetree/bindings/net/adi,adin1110.yaml
index 9de865295d7a..f2db919c166b 100644
--- a/Documentation/devicetree/bindings/net/adi,adin1110.yaml
+++ b/Documentation/devicetree/bindings/net/adi,adin1110.yaml
@@ -50,6 +50,13 @@ properties:
maxItems: 1
description: GPIO connected to active low reset
+ ts-capt-gpios:
+ maxItems: 1
+ description: |
+ Optional active high GPIO. Connected to the TS_TIMER pin of ADIN1110.
+ When pulled up device will save a timestamp containing both the
+ seconds and nanoseconds part simultaneously.
+
required:
- compatible
- reg
--
2.34.1
^ permalink raw reply related [flat|nested] 9+ messages in thread
* Re: [net-next 0/3] net: ethernet: adi: adin1110: add PTP support
2023-01-20 9:53 [net-next 0/3] net: ethernet: adi: adin1110: add PTP support Alexandru Tachici
` (2 preceding siblings ...)
2023-01-20 9:53 ` [net-next 3/3] dt-bindings: net: adin1110: Document ts-capt pin Alexandru Tachici
@ 2023-01-21 5:55 ` Jakub Kicinski
3 siblings, 0 replies; 9+ messages in thread
From: Jakub Kicinski @ 2023-01-21 5:55 UTC (permalink / raw)
To: Alexandru Tachici
Cc: linux-kernel, netdev, davem, edumazet, pabeni, richardcochran,
yangyingliang, weiyongjun1, robh+dt, krzysztof.kozlowski+dt,
devicetree, lennart
On Fri, 20 Jan 2023 11:53:45 +0200 Alexandru Tachici wrote:
> Add control for the PHC inside the ADIN1110/2111.
> Device contains a syntonized counter driven by a 120 MHz
> clock with 8 ns resolution.
allmodconfig build breaks:
ERROR: modpost: "ktime_get_fast_timestamps" [drivers/net/ethernet/adi/adin1110.ko] undefined!
^ permalink raw reply [flat|nested] 9+ messages in thread
* Re: [net-next 1/3] net: ethernet: adi: adin1110: add PTP clock support
2023-01-20 9:53 ` [net-next 1/3] net: ethernet: adi: adin1110: add PTP clock support Alexandru Tachici
@ 2023-01-21 12:03 ` kernel test robot
2023-01-24 2:08 ` Andrew Lunn
1 sibling, 0 replies; 9+ messages in thread
From: kernel test robot @ 2023-01-21 12:03 UTC (permalink / raw)
To: Alexandru Tachici, linux-kernel
Cc: oe-kbuild-all, netdev, davem, edumazet, kuba, pabeni,
richardcochran, yangyingliang, weiyongjun1, robh+dt,
krzysztof.kozlowski+dt, devicetree, lennart
Hi Alexandru,
I love your patch! Yet something to improve:
[auto build test ERROR on net-next/master]
url: https://github.com/intel-lab-lkp/linux/commits/Alexandru-Tachici/net-ethernet-adi-adin1110-add-PTP-clock-support/20230120-175639
patch link: https://lore.kernel.org/r/20230120095348.26715-2-alexandru.tachici%40analog.com
patch subject: [net-next 1/3] net: ethernet: adi: adin1110: add PTP clock support
config: m68k-allmodconfig (https://download.01.org/0day-ci/archive/20230121/202301211925.PhM4jvZS-lkp@intel.com/config)
compiler: m68k-linux-gcc (GCC) 12.1.0
reproduce (this is a W=1 build):
wget https://raw.githubusercontent.com/intel/lkp-tests/master/sbin/make.cross -O ~/bin/make.cross
chmod +x ~/bin/make.cross
# https://github.com/intel-lab-lkp/linux/commit/8acf61452607f47da6223227b32c6f1e8ec01f62
git remote add linux-review https://github.com/intel-lab-lkp/linux
git fetch --no-tags linux-review Alexandru-Tachici/net-ethernet-adi-adin1110-add-PTP-clock-support/20230120-175639
git checkout 8acf61452607f47da6223227b32c6f1e8ec01f62
# save the config file
mkdir build_dir && cp config build_dir/.config
COMPILER_INSTALL_PATH=$HOME/0day COMPILER=gcc-12.1.0 make.cross W=1 O=build_dir ARCH=m68k olddefconfig
COMPILER_INSTALL_PATH=$HOME/0day COMPILER=gcc-12.1.0 make.cross W=1 O=build_dir ARCH=m68k SHELL=/bin/bash
If you fix the issue, kindly add following tag where applicable
| Reported-by: kernel test robot <lkp@intel.com>
All errors (new ones prefixed by >>, old ones prefixed by <<):
>> ERROR: modpost: "ktime_get_fast_timestamps" [drivers/net/ethernet/adi/adin1110.ko] undefined!
--
0-DAY CI Kernel Test Service
https://github.com/intel/lkp-tests
^ permalink raw reply [flat|nested] 9+ messages in thread
* Re: [net-next 3/3] dt-bindings: net: adin1110: Document ts-capt pin
2023-01-20 9:53 ` [net-next 3/3] dt-bindings: net: adin1110: Document ts-capt pin Alexandru Tachici
@ 2023-01-22 11:59 ` Krzysztof Kozlowski
0 siblings, 0 replies; 9+ messages in thread
From: Krzysztof Kozlowski @ 2023-01-22 11:59 UTC (permalink / raw)
To: Alexandru Tachici, linux-kernel
Cc: netdev, davem, edumazet, kuba, pabeni, richardcochran,
yangyingliang, weiyongjun1, robh+dt, krzysztof.kozlowski+dt,
devicetree, lennart
On 20/01/2023 10:53, Alexandru Tachici wrote:
> Add documentation for the use of the timestamp capture pin.
>
> Signed-off-by: Alexandru Tachici <alexandru.tachici@analog.com>
> ---
Acked-by: Krzysztof Kozlowski <krzysztof.kozlowski@linaro.org>
Best regards,
Krzysztof
^ permalink raw reply [flat|nested] 9+ messages in thread
* Re: [net-next 1/3] net: ethernet: adi: adin1110: add PTP clock support
2023-01-20 9:53 ` [net-next 1/3] net: ethernet: adi: adin1110: add PTP clock support Alexandru Tachici
2023-01-21 12:03 ` kernel test robot
@ 2023-01-24 2:08 ` Andrew Lunn
2023-01-26 9:59 ` Alexandru Tachici
1 sibling, 1 reply; 9+ messages in thread
From: Andrew Lunn @ 2023-01-24 2:08 UTC (permalink / raw)
To: Alexandru Tachici
Cc: linux-kernel, netdev, davem, edumazet, kuba, pabeni,
richardcochran, yangyingliang, weiyongjun1, robh+dt,
krzysztof.kozlowski+dt, devicetree, lennart
> +static int adin1110_enable_perout(struct adin1110_priv *priv,
> + struct ptp_perout_request perout,
> + int on)
> +{
> + u32 on_nsec;
> + u32 phase;
> + u32 mask;
> + int ret;
> +
> + if (priv->cfg->id == ADIN2111_MAC) {
> + ret = phy_clear_bits_mmd(priv->ports[0]->phydev, MDIO_MMD_VEND1,
> + ADIN2111_LED_CNTRL,
> + ADIN2111_LED_CNTRL_LED0_FUNCTION);
> + if (ret < 0)
> + return ret;
> +
> + ret = phy_set_bits_mmd(priv->ports[0]->phydev, MDIO_MMD_VEND1,
> + ADIN2111_LED_CNTRL,
> + on ? ADIN2111_LED_CNTRL_TS_TIMER : 0);
I normally say a MAC driver should not be accessing PHY register...
You have the advantage of knowing it is integrated, so you know
exactly what PHY it is. But you still have a potential race condition
sometime in the future. You are not taking the phydev->lock, which is
something phylib nearly always does before accessing a PHY. If you
ever add control of the LEDs, that lack of locking could get you in
trouble.
Is this functionality always on LED0? It cannot be LED1 or LED2?
Andrew
^ permalink raw reply [flat|nested] 9+ messages in thread
* Re: [net-next 1/3] net: ethernet: adi: adin1110: add PTP clock support
2023-01-24 2:08 ` Andrew Lunn
@ 2023-01-26 9:59 ` Alexandru Tachici
0 siblings, 0 replies; 9+ messages in thread
From: Alexandru Tachici @ 2023-01-26 9:59 UTC (permalink / raw)
To: andrew
Cc: alexandru.tachici, davem, devicetree, edumazet,
krzysztof.kozlowski+dt, kuba, lennart, linux-kernel, netdev,
pabeni, richardcochran, robh+dt, weiyongjun1, yangyingliang
> > +static int adin1110_enable_perout(struct adin1110_priv *priv,
> > + struct ptp_perout_request perout,
> > + int on)
> > +{
> > + u32 on_nsec;
> > + u32 phase;
> > + u32 mask;
> > + int ret;
> > +
> > + if (priv->cfg->id == ADIN2111_MAC) {
> > + ret = phy_clear_bits_mmd(priv->ports[0]->phydev, MDIO_MMD_VEND1,
> > + ADIN2111_LED_CNTRL,
> > + ADIN2111_LED_CNTRL_LED0_FUNCTION);
> > + if (ret < 0)
> > + return ret;
> > +
> > + ret = phy_set_bits_mmd(priv->ports[0]->phydev, MDIO_MMD_VEND1,
> > + ADIN2111_LED_CNTRL,
> > + on ? ADIN2111_LED_CNTRL_TS_TIMER : 0);
>
> I normally say a MAC driver should not be accessing PHY register...
>
> You have the advantage of knowing it is integrated, so you know
> exactly what PHY it is. But you still have a potential race condition
> sometime in the future. You are not taking the phydev->lock, which is
> something phylib nearly always does before accessing a PHY. If you
> ever add control of the LEDs, that lack of locking could get you in
> trouble.
>
> Is this functionality always on LED0? It cannot be LED1 or LED2?
>
> Andrew
Hi Andrew,
Thanks for the insight. Will add the phylib locking. Device only allows
LED0 pin or INTN pin to be converted to timer output. Can't lose IRQ capability
here so only LED0 could possibly be used.
Thanks,
Alexandru
^ permalink raw reply [flat|nested] 9+ messages in thread
end of thread, other threads:[~2023-01-26 10:00 UTC | newest]
Thread overview: 9+ messages (download: mbox.gz / follow: Atom feed)
-- links below jump to the message on this page --
2023-01-20 9:53 [net-next 0/3] net: ethernet: adi: adin1110: add PTP support Alexandru Tachici
2023-01-20 9:53 ` [net-next 1/3] net: ethernet: adi: adin1110: add PTP clock support Alexandru Tachici
2023-01-21 12:03 ` kernel test robot
2023-01-24 2:08 ` Andrew Lunn
2023-01-26 9:59 ` Alexandru Tachici
2023-01-20 9:53 ` [net-next 2/3] net: ethernet: adi: adin1110: add timestamping support Alexandru Tachici
2023-01-20 9:53 ` [net-next 3/3] dt-bindings: net: adin1110: Document ts-capt pin Alexandru Tachici
2023-01-22 11:59 ` Krzysztof Kozlowski
2023-01-21 5:55 ` [net-next 0/3] net: ethernet: adi: adin1110: add PTP support Jakub Kicinski
This is a public inbox, see mirroring instructions
for how to clone and mirror all data and code used for this inbox;
as well as URLs for NNTP newsgroup(s).