From patchwork Wed Mar 15 11:05:44 2023 Content-Type: text/plain; charset="utf-8" MIME-Version: 1.0 Content-Transfer-Encoding: 7bit X-Patchwork-Submitter: Markus Schneider-Pargmann X-Patchwork-Id: 70146 Return-Path: Delivered-To: ouuuleilei@gmail.com Received: by 2002:a5d:5915:0:0:0:0:0 with SMTP id v21csp2268636wrd; Wed, 15 Mar 2023 04:23:49 -0700 (PDT) X-Google-Smtp-Source: AK7set8/75AQsMKIUG6L7J6jc7ziN6PzqRHi6BdcVgIVmq/b0oTFRKWeY51JWqqkwVKJfaotgMQ4 X-Received: by 2002:a05:6a21:998b:b0:ce:8028:e0ac with SMTP id ve11-20020a056a21998b00b000ce8028e0acmr47959064pzb.44.1678879428870; Wed, 15 Mar 2023 04:23:48 -0700 (PDT) ARC-Seal: i=1; a=rsa-sha256; t=1678879428; cv=none; d=google.com; s=arc-20160816; b=RSl69X0o0XWIv71WNOvHrlvUoEtP519LbRFXOzRkbqmXGrfZSDWzx8/5CaOCqgbWv1 UQO+gsiMcQ//Chk4V//7iSMYgl9rzGwLxpMd/g2gvUDC2I82vikcWoZRocpjXN9vv7Z+ VgqsF+tGgR7ZAk1FX3jmUcdlK2kZU5jXG+y5P+AQDDRGSTPl4R+1FSEBurqAKrB6ID8S 6LioTnbN4WHkSZlZaw5+iZkVbKDkNPGNqqasBgWJ64EpXelXNH2/0zOGTwFbuTimRgHB FddUi0l2hY3Pz6RZRCVJSd5XXE2c4D9Q9lo8O+1EHd6uSw3VbLkI/nFjmuIQHUpny9o2 f4Ug== ARC-Message-Signature: i=1; a=rsa-sha256; c=relaxed/relaxed; d=google.com; s=arc-20160816; h=list-id:precedence:content-transfer-encoding:mime-version :references:in-reply-to:message-id:date:subject:cc:to:from :dkim-signature; bh=ypZdWnRNDTGXAnkPh6LVaKjwNg77jYO2dJofBGuM+QE=; b=GTyBx1jn1HXXGnF/b375f/wLvC7tB83ksw87QWV8Hqw7CUrSJ1QfEhaxk4QSxCmDUy QgS8Ol4Rw+19WdtF9uAvsZWXE8rz/5WG6xt6BvwEfkaEjMKoCtdKNCBKiwMXxHfHnC+s uZsaY6gyM3spynd9RtmVbb/Gt7KVoiDiXK22vYqWCq/f6JY2mXil0+zyGGATZAJgAl/T DDdGjTjwRWuMsIEjieeTQJ77JshlTGj5TU+tgoymSQZgHrEiU8fgGO4wS9GHI9xJxm8W gdrc3rXrs502NQQY3ISQDVONLqMb4BjYINdIpIYDi4lisn2KlD58Ej0Vq3jxOJiLYeFg 2M3w== ARC-Authentication-Results: i=1; mx.google.com; dkim=pass header.i=@baylibre-com.20210112.gappssmtp.com header.s=20210112 header.b=huSERv9r; spf=pass (google.com: domain of linux-kernel-owner@vger.kernel.org designates 2620:137:e000::1:20 as permitted sender) smtp.mailfrom=linux-kernel-owner@vger.kernel.org Received: from out1.vger.email (out1.vger.email. [2620:137:e000::1:20]) by mx.google.com with ESMTP id 1-20020a630f41000000b00502f145822bsi4620044pgp.345.2023.03.15.04.23.19; Wed, 15 Mar 2023 04:23:48 -0700 (PDT) Received-SPF: pass (google.com: domain of linux-kernel-owner@vger.kernel.org designates 2620:137:e000::1:20 as permitted sender) client-ip=2620:137:e000::1:20; Authentication-Results: mx.google.com; dkim=pass header.i=@baylibre-com.20210112.gappssmtp.com header.s=20210112 header.b=huSERv9r; spf=pass (google.com: domain of linux-kernel-owner@vger.kernel.org designates 2620:137:e000::1:20 as permitted sender) smtp.mailfrom=linux-kernel-owner@vger.kernel.org Received: (majordomo@vger.kernel.org) by vger.kernel.org via listexpand id S231871AbjCOLHh (ORCPT + 99 others); Wed, 15 Mar 2023 07:07:37 -0400 Received: from lindbergh.monkeyblade.net ([23.128.96.19]:44164 "EHLO lindbergh.monkeyblade.net" rhost-flags-OK-OK-OK-OK) by vger.kernel.org with ESMTP id S231775AbjCOLGr (ORCPT ); Wed, 15 Mar 2023 07:06:47 -0400 Received: from mail-wm1-x333.google.com (mail-wm1-x333.google.com [IPv6:2a00:1450:4864:20::333]) by lindbergh.monkeyblade.net (Postfix) with ESMTPS id 72C4A8092A for ; Wed, 15 Mar 2023 04:06:38 -0700 (PDT) Received: by mail-wm1-x333.google.com with SMTP id c8-20020a05600c0ac800b003ed2f97a63eso820518wmr.3 for ; Wed, 15 Mar 2023 04:06:38 -0700 (PDT) DKIM-Signature: v=1; a=rsa-sha256; c=relaxed/relaxed; d=baylibre-com.20210112.gappssmtp.com; s=20210112; t=1678878397; h=content-transfer-encoding:mime-version:references:in-reply-to :message-id:date:subject:cc:to:from:from:to:cc:subject:date :message-id:reply-to; bh=ypZdWnRNDTGXAnkPh6LVaKjwNg77jYO2dJofBGuM+QE=; b=huSERv9rU/L1D67HT8F+JyU+EjfQBPwOlzECRS42tJwk7EuY0f4UVfiHb6pCDxx6IL qpW1WmSNslFEQPTbN87jNWljG/W5BbwNlYgHCy591VuNKF/ixGEOj00+E3Ax9/k4kpvw SfzTFxH00T4GVbhZMHYLlEpH/t7JddT/QBzZGLjP6ydJfTJxUFPBcCuygRukYq5TA6N6 mkTzlVDQNvKq2kfRbq6ZoF8EP9/8yeW3viA8QkpSQewnnGfAnnXW/Qmh38hbl526ihyX v3N1zt6yadwXVTK21RxfteRtTpNpzsIF3V3Ejn8K3DCx2nlkKHqyAcWYRteQtWlGn/m6 VJJQ== X-Google-DKIM-Signature: v=1; a=rsa-sha256; c=relaxed/relaxed; d=1e100.net; s=20210112; t=1678878397; h=content-transfer-encoding:mime-version:references:in-reply-to :message-id:date:subject:cc:to:from:x-gm-message-state:from:to:cc :subject:date:message-id:reply-to; bh=ypZdWnRNDTGXAnkPh6LVaKjwNg77jYO2dJofBGuM+QE=; b=f5PVnl5psxzEmFWXL5UNgGpSrsgEWHqLYOKFT5/BDfUZunHyceUqRngh5+W9XtNKIY OGUAzKVndQapTLOWLCEylfxyODMZiCkKQ6RjJViIIVh6CM5AzOcAPHnp7WSZKpDE5VHT Uyw3mRAijxs/SwCosQLnYSI3GCVBWNN6uY+KE5n5eiP009zy/AYPiW5ssSuVwzOtYaex UDb3ohS6vrz8+0kamkR9EOqEwPF1c8OLhRjfab6bd783z0neFV9f37zk+hps1IaVeIWf m1QSYy1DJRKaD93KvDVmxC0G9bZyT9RFVtvmfJ/niLlLbRiN51pSWCFlC6D3+vhNFpFk 4IoA== X-Gm-Message-State: AO0yUKUgkXYk7lzXO61JeZkn/oes0bbYk2ItT8BetI98tZ6YLgf5VkiA j0rdlHkUlsAFdfR/Rj+SV67QtQ== X-Received: by 2002:a05:600c:3c9e:b0:3e1:f8af:8772 with SMTP id bg30-20020a05600c3c9e00b003e1f8af8772mr17124880wmb.9.1678878397040; Wed, 15 Mar 2023 04:06:37 -0700 (PDT) Received: from blmsp.fritz.box ([2001:4090:a247:8056:be7d:83e:a6a5:4659]) by smtp.gmail.com with ESMTPSA id l4-20020a7bc444000000b003eafc47eb09sm1460563wmi.43.2023.03.15.04.06.36 (version=TLS1_3 cipher=TLS_AES_256_GCM_SHA384 bits=256/256); Wed, 15 Mar 2023 04:06:36 -0700 (PDT) From: Markus Schneider-Pargmann To: Marc Kleine-Budde , Chandrasekar Ramakrishnan , Wolfgang Grandegger Cc: Vincent MAILHOL , Simon Horman , linux-can@vger.kernel.org, netdev@vger.kernel.org, linux-kernel@vger.kernel.org, Markus Schneider-Pargmann Subject: [PATCH v3 14/16] can: m_can: Use tx_fifo_in_flight for netif_queue control Date: Wed, 15 Mar 2023 12:05:44 +0100 Message-Id: <20230315110546.2518305-15-msp@baylibre.com> X-Mailer: git-send-email 2.39.2 In-Reply-To: <20230315110546.2518305-1-msp@baylibre.com> References: <20230315110546.2518305-1-msp@baylibre.com> MIME-Version: 1.0 X-Spam-Status: No, score=-1.9 required=5.0 tests=BAYES_00,DKIM_SIGNED, DKIM_VALID,RCVD_IN_DNSWL_NONE,SPF_HELO_NONE,SPF_PASS autolearn=unavailable autolearn_force=no version=3.4.6 X-Spam-Checker-Version: SpamAssassin 3.4.6 (2021-04-09) on lindbergh.monkeyblade.net Precedence: bulk List-ID: X-Mailing-List: linux-kernel@vger.kernel.org X-getmail-retrieved-from-mailbox: =?utf-8?q?INBOX?= X-GMAIL-THRID: =?utf-8?q?1760432676063071818?= X-GMAIL-MSGID: =?utf-8?q?1760432676063071818?= The network queue is currently always stopped in start_xmit and continued in the interrupt handler. This is not possible anymore if we want to keep multiple transmits in flight in parallel. Use the previously introduced tx_fifo_in_flight counter to control the network queue instead. This has the benefit of not needing to ask the hardware about fifo status. This patch stops the network queue in start_xmit if the number of transmits in flight reaches the size of the fifo and wakes up the queue from the interrupt handler once the transmits in flight drops below the fifo size. This means any skbs over the limit will be rejected immediately in start_xmit (it shouldn't be possible at all to reach that state anyways). The maximum number of transmits in flight is the size of the fifo. Signed-off-by: Markus Schneider-Pargmann --- drivers/net/can/m_can/m_can.c | 71 +++++++++++++---------------------- 1 file changed, 26 insertions(+), 45 deletions(-) diff --git a/drivers/net/can/m_can/m_can.c b/drivers/net/can/m_can/m_can.c index 4ad8f08f8284..3cb3d01e1a61 100644 --- a/drivers/net/can/m_can/m_can.c +++ b/drivers/net/can/m_can/m_can.c @@ -370,16 +370,6 @@ m_can_txe_fifo_read(struct m_can_classdev *cdev, u32 fgi, u32 offset, u32 *val) return cdev->ops->read_fifo(cdev, addr_offset, val, 1); } -static inline bool _m_can_tx_fifo_full(u32 txfqs) -{ - return !!(txfqs & TXFQS_TFQF); -} - -static inline bool m_can_tx_fifo_full(struct m_can_classdev *cdev) -{ - return _m_can_tx_fifo_full(m_can_read(cdev, M_CAN_TXFQS)); -} - static void m_can_config_endisable(struct m_can_classdev *cdev, bool enable) { u32 cccr = m_can_read(cdev, M_CAN_CCCR); @@ -1033,17 +1023,31 @@ static void m_can_finish_tx(struct m_can_classdev *cdev, int transmitted) unsigned long irqflags; spin_lock_irqsave(&cdev->tx_handling_spinlock, irqflags); + if (cdev->tx_fifo_in_flight >= cdev->tx_fifo_size && transmitted > 0) + netif_wake_queue(cdev->net); cdev->tx_fifo_in_flight -= transmitted; spin_unlock_irqrestore(&cdev->tx_handling_spinlock, irqflags); } -static void m_can_start_tx(struct m_can_classdev *cdev) +static netdev_tx_t m_can_start_tx(struct m_can_classdev *cdev) { unsigned long irqflags; + int tx_fifo_in_flight; spin_lock_irqsave(&cdev->tx_handling_spinlock, irqflags); - ++cdev->tx_fifo_in_flight; + tx_fifo_in_flight = cdev->tx_fifo_in_flight + 1; + if (tx_fifo_in_flight >= cdev->tx_fifo_size) { + netif_stop_queue(cdev->net); + if (tx_fifo_in_flight > cdev->tx_fifo_size) { + netdev_err(cdev->net, "hard_xmit called while TX FIFO full\n"); + spin_unlock_irqrestore(&cdev->tx_handling_spinlock, irqflags); + return NETDEV_TX_BUSY; + } + } + cdev->tx_fifo_in_flight = tx_fifo_in_flight; spin_unlock_irqrestore(&cdev->tx_handling_spinlock, irqflags); + + return NETDEV_TX_OK; } static int m_can_echo_tx_event(struct net_device *dev) @@ -1187,7 +1191,6 @@ static irqreturn_t m_can_isr(int irq, void *dev_id) if (cdev->is_peripheral) timestamp = m_can_get_timestamp(cdev); m_can_tx_update_stats(cdev, 0, timestamp); - netif_wake_queue(dev); m_can_finish_tx(cdev, 1); } } else { @@ -1195,10 +1198,6 @@ static irqreturn_t m_can_isr(int irq, void *dev_id) /* New TX FIFO Element arrived */ if (m_can_echo_tx_event(dev) != 0) goto out_fail; - - if (netif_queue_stopped(dev) && - !m_can_tx_fifo_full(cdev)) - netif_wake_queue(dev); } } @@ -1719,7 +1718,6 @@ static netdev_tx_t m_can_tx_handler(struct m_can_classdev *cdev, struct net_device *dev = cdev->net; struct id_and_dlc fifo_header; u32 cccr, fdflags; - u32 txfqs; int err; int putidx; @@ -1776,24 +1774,6 @@ static netdev_tx_t m_can_tx_handler(struct m_can_classdev *cdev, u8 len_padded = DIV_ROUND_UP(cf->len, 4); /* Transmit routine for version >= v3.1.x */ - txfqs = m_can_read(cdev, M_CAN_TXFQS); - - /* Check if FIFO full */ - if (_m_can_tx_fifo_full(txfqs)) { - /* This shouldn't happen */ - netif_stop_queue(dev); - netdev_warn(dev, - "TX queue active although FIFO is full."); - - if (cdev->is_peripheral) { - kfree_skb(skb); - dev->stats.tx_dropped++; - return NETDEV_TX_OK; - } else { - return NETDEV_TX_BUSY; - } - } - /* get put index for frame */ putidx = cdev->tx_fifo_putidx; @@ -1830,11 +1810,6 @@ static netdev_tx_t m_can_tx_handler(struct m_can_classdev *cdev, m_can_write(cdev, M_CAN_TXBAR, (1 << putidx)); cdev->tx_fifo_putidx = (++cdev->tx_fifo_putidx >= cdev->can.echo_skb_max ? 0 : cdev->tx_fifo_putidx); - - /* stop network queue if fifo full */ - if (m_can_tx_fifo_full(cdev) || - m_can_next_echo_skb_occupied(dev, putidx)) - netif_stop_queue(dev); } return NETDEV_TX_OK; @@ -1868,14 +1843,16 @@ static void m_can_tx_queue_skb(struct m_can_classdev *cdev, struct sk_buff *skb) static netdev_tx_t m_can_start_peripheral_xmit(struct m_can_classdev *cdev, struct sk_buff *skb) { + netdev_tx_t err; + if (cdev->can.state == CAN_STATE_BUS_OFF) { m_can_clean(cdev->net); return NETDEV_TX_OK; } - netif_stop_queue(cdev->net); - - m_can_start_tx(cdev); + err = m_can_start_tx(cdev); + if (err != NETDEV_TX_OK) + return err; m_can_tx_queue_skb(cdev, skb); @@ -1885,7 +1862,11 @@ static netdev_tx_t m_can_start_peripheral_xmit(struct m_can_classdev *cdev, static netdev_tx_t m_can_start_fast_xmit(struct m_can_classdev *cdev, struct sk_buff *skb) { - m_can_start_tx(cdev); + netdev_tx_t err; + + err = m_can_start_tx(cdev); + if (err != NETDEV_TX_OK) + return err; return m_can_tx_handler(cdev, skb); }