From mboxrd@z Thu Jan 1 00:00:00 1970 Return-Path: X-Spam-Checker-Version: SpamAssassin 3.4.0 (2014-02-07) on aws-us-west-2-korg-lkml-1.web.codeaurora.org X-Spam-Level: X-Spam-Status: No, score=-16.8 required=3.0 tests=BAYES_00, HEADER_FROM_DIFFERENT_DOMAINS,INCLUDES_CR_TRAILER,INCLUDES_PATCH, MAILING_LIST_MULTI,SPF_HELO_NONE,SPF_PASS,URIBL_BLOCKED,USER_AGENT_GIT autolearn=ham autolearn_force=no version=3.4.0 Received: from mail.kernel.org (mail.kernel.org [198.145.29.99]) by smtp.lore.kernel.org (Postfix) with ESMTP id 05CB5C43460 for ; Fri, 7 May 2021 08:48:02 +0000 (UTC) Received: from vger.kernel.org (vger.kernel.org [23.128.96.18]) by mail.kernel.org (Postfix) with ESMTP id D495E613D8 for ; Fri, 7 May 2021 08:48:01 +0000 (UTC) Received: (majordomo@vger.kernel.org) by vger.kernel.org via listexpand id S236484AbhEGItA (ORCPT ); Fri, 7 May 2021 04:49:00 -0400 Received: from inva020.nxp.com ([92.121.34.13]:59820 "EHLO inva020.nxp.com" rhost-flags-OK-OK-OK-OK) by vger.kernel.org with ESMTP id S236425AbhEGIsv (ORCPT ); Fri, 7 May 2021 04:48:51 -0400 Received: from inva020.nxp.com (localhost [127.0.0.1]) by inva020.eu-rdc02.nxp.com (Postfix) with ESMTP id 3A4FA1A19BA; Fri, 7 May 2021 10:47:51 +0200 (CEST) Received: from invc005.ap-rdc01.nxp.com (invc005.ap-rdc01.nxp.com [165.114.16.14]) by inva020.eu-rdc02.nxp.com (Postfix) with ESMTP id 890DA1A19BB; Fri, 7 May 2021 10:47:48 +0200 (CEST) Received: from localhost.localdomain (mega.ap.freescale.net [10.192.208.232]) by invc005.ap-rdc01.nxp.com (Postfix) with ESMTP id E00294029F; Fri, 7 May 2021 10:47:44 +0200 (CEST) From: Yangbo Lu To: netdev@vger.kernel.org Cc: Yangbo Lu , "David S . Miller" , Richard Cochran , Claudiu Manoil , Jakub Kicinski Subject: [net-next 6/6] enetc: support PTP domain timestamp conversion Date: Fri, 7 May 2021 16:57:56 +0800 Message-Id: <20210507085756.20427-7-yangbo.lu@nxp.com> X-Mailer: git-send-email 2.17.1 In-Reply-To: <20210507085756.20427-1-yangbo.lu@nxp.com> References: <20210507085756.20427-1-yangbo.lu@nxp.com> X-Virus-Scanned: ClamAV using ClamSMTP Precedence: bulk List-ID: X-Mailing-List: netdev@vger.kernel.org Support timestamp conversion to specified PTP domain in PTP packet. Signed-off-by: Yangbo Lu --- drivers/net/ethernet/freescale/enetc/enetc.c | 37 ++++++++++++++++++-- 1 file changed, 34 insertions(+), 3 deletions(-) diff --git a/drivers/net/ethernet/freescale/enetc/enetc.c b/drivers/net/ethernet/freescale/enetc/enetc.c index 3ca93adb9662..e7fb2fae98e0 100644 --- a/drivers/net/ethernet/freescale/enetc/enetc.c +++ b/drivers/net/ethernet/freescale/enetc/enetc.c @@ -7,6 +7,7 @@ #include #include #include +#include #include static int enetc_num_stack_tx_queues(struct enetc_ndev_priv *priv) @@ -472,13 +473,36 @@ static void enetc_get_tx_tstamp(struct enetc_hw *hw, union enetc_tx_bd *txbd, *tstamp = (u64)hi << 32 | tstamp_lo; } -static void enetc_tstamp_tx(struct sk_buff *skb, u64 tstamp) +static int enetc_ptp_parse_domain(struct sk_buff *skb, u8 *domain) +{ + unsigned int ptp_class; + struct ptp_header *hdr; + + ptp_class = ptp_classify_raw(skb); + if (ptp_class == PTP_CLASS_NONE) + return -EINVAL; + + hdr = ptp_parse_header(skb, ptp_class); + if (!hdr) + return -EINVAL; + + *domain = hdr->domain_number; + return 0; +} + +static void enetc_tstamp_tx(struct enetc_ndev_priv *priv, struct sk_buff *skb, + u64 tstamp) { struct skb_shared_hwtstamps shhwtstamps; + u64 ts = tstamp; + u8 domain; if (skb_shinfo(skb)->tx_flags & SKBTX_IN_PROGRESS) { + if (!enetc_ptp_parse_domain(skb, &domain)) + ptp_clock_domain_tstamp(priv->ptp_dev, &ts, domain); + memset(&shhwtstamps, 0, sizeof(shhwtstamps)); - shhwtstamps.hwtstamp = ns_to_ktime(tstamp); + shhwtstamps.hwtstamp = ns_to_ktime(ts); skb_txtime_consumed(skb); skb_tstamp_tx(skb, &shhwtstamps); } @@ -575,7 +599,7 @@ static bool enetc_clean_tx_ring(struct enetc_bdr *tx_ring, int napi_budget) */ schedule_work(&priv->tx_onestep_tstamp); } else if (unlikely(do_twostep_tstamp)) { - enetc_tstamp_tx(skb, tstamp); + enetc_tstamp_tx(priv, skb, tstamp); do_twostep_tstamp = false; } napi_consume_skb(skb, napi_budget); @@ -698,6 +722,7 @@ static void enetc_get_rx_tstamp(struct net_device *ndev, struct enetc_hw *hw = &priv->si->hw; u32 lo, hi, tstamp_lo; u64 tstamp; + u8 domain; if (le16_to_cpu(rxbd->r.flags) & ENETC_RXBD_FLAG_TSTMP) { lo = enetc_rd_reg_hot(hw->reg + ENETC_SICTR0); @@ -708,6 +733,12 @@ static void enetc_get_rx_tstamp(struct net_device *ndev, hi -= 1; tstamp = (u64)hi << 32 | tstamp_lo; + + skb_reset_mac_header(skb); + + if (!enetc_ptp_parse_domain(skb, &domain)) + ptp_clock_domain_tstamp(priv->ptp_dev, &tstamp, domain); + memset(shhwtstamps, 0, sizeof(*shhwtstamps)); shhwtstamps->hwtstamp = ns_to_ktime(tstamp); } -- 2.25.1