Received: by 2002:a05:6358:9144:b0:117:f937:c515 with SMTP id r4csp6013634rwr; Mon, 24 Apr 2023 12:15:57 -0700 (PDT) X-Google-Smtp-Source: AKy350bIVzMH6iubrJ5VUVqn1gbq8E3Xkt7hAuB5WxTSfi6F4dxZEeaWes3an2LZiM2AKJVkmyRI X-Received: by 2002:a17:902:ef8a:b0:1a1:dd2a:fe6c with SMTP id iz10-20020a170902ef8a00b001a1dd2afe6cmr13666362plb.53.1682363757239; Mon, 24 Apr 2023 12:15:57 -0700 (PDT) ARC-Seal: i=1; a=rsa-sha256; t=1682363757; cv=none; d=google.com; s=arc-20160816; b=GNeV5KqMF0GT5USyZgtF2GcYu8AEScPYlUcob81PXbKMdpQazGqmSKOoheDN2HNAEo uzPsdXP6hILWdHPC+YPHG+Y7gs2W8EJ6SZUFzrVgZn6x8ID9lt3pQqH8JQH20ceS64xW VF2desEKI8E+NLkQBYuhOOp/e1a4O9yr7wPwO6teqotd+j6RCL7pNUcgGrtLpnvISmuV LKV8gnNZJjjQjME68deb5f5xR219SwUQWUoxkox3HaGakOnWzrAENf3AW322iWNAZxZz tF+KqrXOtcAjR/KLF93fdLYoUdSEPewU04VPCcS9l3fNtCpVKBZbIeunRcEfvon7Yna7 Lm8w== ARC-Message-Signature: i=1; a=rsa-sha256; c=relaxed/relaxed; d=google.com; s=arc-20160816; h=list-id:precedence:in-reply-to:content-disposition:mime-version :references:message-id:subject:cc:to:from:date; bh=0uu1CiLF9DLwmi8BFxTn+iTLJwNEvqKAH1yv2Ya78WY=; b=TxVSCemaoSlvgWijpISkVGZeM6IZAkSn5bjAtx4Pfe4w69jKTG+yyBhaw8sEFaNY88 gKB9snZ7PtgCdQsTyOJrqyjutUU8MnK4MOCVdghy9Kwlrz233PwGJW8FE+0g+ybudGho LxvTzvoN4SsD4OzwTwVlVAeZUjmb/YFG9ANvEoCEseHxhNZj3u0q7sAD7KAfeCkVO9cc dBNyJLrOFS43JoxI8e1SfEKHSiUdxSS6zAvalsjsG0kOPTat6Rsu+6NdgwVMao6pBTf+ OomPHvhKcTjXZpEaOGJx6eaEq5/+3soSBrjsJUTZ9mOeXcgup2x/rxuxmrpBDTMtffsB BNjQ== ARC-Authentication-Results: i=1; mx.google.com; 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 Return-Path: Received: from out1.vger.email (out1.vger.email. [2620:137:e000::1:20]) by mx.google.com with ESMTP id z5-20020a1709027e8500b001a669006139si11060775pla.248.2023.04.24.12.15.44; Mon, 24 Apr 2023 12:15:57 -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; 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 S232317AbjDXTD3 (ORCPT + 99 others); Mon, 24 Apr 2023 15:03:29 -0400 Received: from lindbergh.monkeyblade.net ([23.128.96.19]:55670 "EHLO lindbergh.monkeyblade.net" rhost-flags-OK-OK-OK-OK) by vger.kernel.org with ESMTP id S231694AbjDXTD2 (ORCPT ); Mon, 24 Apr 2023 15:03:28 -0400 Received: from metis.ext.pengutronix.de (metis.ext.pengutronix.de [IPv6:2001:67c:670:201:290:27ff:fe1d:cc33]) by lindbergh.monkeyblade.net (Postfix) with ESMTPS id 6D6CC4C23 for ; Mon, 24 Apr 2023 12:03:24 -0700 (PDT) Received: from moin.white.stw.pengutronix.de ([2a0a:edc0:0:b01:1d::7b] helo=bjornoya.blackshift.org) by metis.ext.pengutronix.de with esmtps (TLS1.3:ECDHE_RSA_AES_256_GCM_SHA384:256) (Exim 4.92) (envelope-from ) id 1pr1Sq-0000tK-34; Mon, 24 Apr 2023 21:03:04 +0200 Received: from pengutronix.de (unknown [172.20.34.65]) (using TLSv1.3 with cipher TLS_AES_256_GCM_SHA384 (256/256 bits) key-exchange ECDHE (prime256v1) server-signature RSA-PSS (4096 bits) server-digest SHA256) (Client did not present a certificate) (Authenticated sender: mkl-all@blackshift.org) by smtp.blackshift.org (Postfix) with ESMTPSA id 3283F1B6558; Mon, 24 Apr 2023 19:03:00 +0000 (UTC) Date: Mon, 24 Apr 2023 21:02:59 +0200 From: Marc Kleine-Budde To: Mikhail Golubev-Ciuchea Cc: virtio-dev@lists.oasis-open.org, linux-can@vger.kernel.org, netdev@vger.kernel.org, linux-kernel@vger.kernel.org, virtualization@lists.linux-foundation.org, Wolfgang Grandegger , "David S . Miller" , Eric Dumazet , Jakub Kicinski , Paolo Abeni , "Michael S . Tsirkin" , Jason Wang , Harald Mommer Subject: Re: [RFC PATCH v2] can: virtio: Initial virtio CAN driver. Message-ID: <20230424-footwear-daily-9339bd0ec428-mkl@pengutronix.de> References: <20230421145653.12811-1-Mikhail.Golubev-Ciuchea@opensynergy.com> MIME-Version: 1.0 Content-Type: multipart/signed; micalg=pgp-sha512; protocol="application/pgp-signature"; boundary="u3o45odz4bv4dzn6" Content-Disposition: inline In-Reply-To: <20230421145653.12811-1-Mikhail.Golubev-Ciuchea@opensynergy.com> X-SA-Exim-Connect-IP: 2a0a:edc0:0:b01:1d::7b X-SA-Exim-Mail-From: mkl@pengutronix.de X-SA-Exim-Scanned: No (on metis.ext.pengutronix.de); SAEximRunCond expanded to false X-PTX-Original-Recipient: linux-kernel@vger.kernel.org X-Spam-Status: No, score=-4.2 required=5.0 tests=BAYES_00,RCVD_IN_DNSWL_MED, SPF_HELO_NONE,SPF_PASS,T_SCC_BODY_TEXT_LINE 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 --u3o45odz4bv4dzn6 Content-Type: text/plain; charset=utf-8 Content-Disposition: inline Content-Transfer-Encoding: quoted-printable On 21.04.2023 16:56:53, Mikhail Golubev-Ciuchea wrote: > From: Harald Mommer > > - CAN Control > > - "ip link set up can0" starts the virtual CAN controller, > - "ip link set up can0" stops the virtual CAN controller > > - CAN RX > > Receive CAN frames. CAN frames can be standard or extended, classic or > CAN FD. Classic CAN RTR frames are supported. > > - CAN TX > > Send CAN frames. CAN frames can be standard or extended, classic or > CAN FD. Classic CAN RTR frames are supported. > > - CAN BusOff indication > > CAN BusOff is handled now by a bit in the configuration space. > > This is version 3 of the driver after having gotten review comments. > > Signed-off-by: Harald Mommer > Signed-off-by: Mikhail Golubev-Ciuchea Please don't use unicode chars: | WARNING: Message contains suspicious unicode control characters! | Subject: [RFC PATCH v2] can: virtio: Initial virtio CAN driver. | Line: + __le16 length; /* 0..8 CC, 0..64 CANFD, 0..2048 C= ANXL, 12 bits */ | --------------------------------------------^ | Char: SOFT HYPHEN (0xad) Please fix this warning: | drivers/net/can/virtio_can.c:350:35: warning: incorrect type in assignmen= t (different base types) | drivers/net/can/virtio_can.c:350:35: expected restricted __le16 [usert= ype] length | drivers/net/can/virtio_can.c:350:35: | got unsigned int [assigned] [usertype] len For now I've only looked at the xmit function. > --- > > V2: > * Remove the event indication queue and use the config space instead, to > indicate a bus off condition > * Rework RX and TX messages having a length field and some more fields fo= r CAN > EXT > * Fix CAN_EFF_MASK comparison > * Remove MISRA style code (e.g. '! =3D 0u') > * Remove priorities leftovers > * Remove BUGONs > * Based on virtio can spec RFCv3 Can you post a link to the RFC? > * Tested with https://github.com/OpenSynergy/qemu/tree/virtio-can-spec-rf= c-v3 > > MAINTAINERS | 7 + > drivers/net/can/Kconfig | 12 + > drivers/net/can/Makefile | 1 + > drivers/net/can/virtio_can.c | 1060 +++++++++++++++++++++++++++++++ > include/uapi/linux/virtio_can.h | 71 +++ > 5 files changed, 1151 insertions(+) > create mode 100644 drivers/net/can/virtio_can.c > create mode 100644 include/uapi/linux/virtio_can.h > > diff --git a/MAINTAINERS b/MAINTAINERS > index 0e64787aace8..a8b118b344a8 100644 > --- a/MAINTAINERS > +++ b/MAINTAINERS > @@ -22053,6 +22053,13 @@ F: drivers/vhost/scsi.c > F: include/uapi/linux/virtio_blk.h > F: include/uapi/linux/virtio_scsi.h > > +VIRTIO CAN DRIVER > +M: "Harald Mommer" > +L: linux-can@vger.kernel.org > +S: Maintained > +F: drivers/net/can/virtio_can.c > +F: include/uapi/linux/virtio_can.h > + > VIRTIO CONSOLE DRIVER > M: Amit Shah > L: virtualization@lists.linux-foundation.org > diff --git a/drivers/net/can/Kconfig b/drivers/net/can/Kconfig > index cd34e8dc9394..832621f5893f 100644 > --- a/drivers/net/can/Kconfig > +++ b/drivers/net/can/Kconfig > @@ -198,6 +198,18 @@ config CAN_XILINXCAN > Xilinx CAN driver. This driver supports both soft AXI CAN IP and > Zynq CANPS IP. > > +config CAN_VIRTIO_CAN > + depends on VIRTIO > + tristate "Virtio CAN device support" > + default n > + help > + Say Y here if you want to support for Virtio CAN. > + > + To compile this driver as a module, choose M here: the > + module will be called virtio-can. > + > + If unsure, say N. > + Please sort by CONFIG symbols in the Makefile, see below. > source "drivers/net/can/c_can/Kconfig" > source "drivers/net/can/cc770/Kconfig" > source "drivers/net/can/ctucanfd/Kconfig" > diff --git a/drivers/net/can/Makefile b/drivers/net/can/Makefile > index 52b0f6e10668..d31949052acf 100644 > --- a/drivers/net/can/Makefile > +++ b/drivers/net/can/Makefile > @@ -30,5 +30,6 @@ obj-$(CONFIG_CAN_SJA1000) +=3D sja1000/ > obj-$(CONFIG_CAN_SUN4I) +=3D sun4i_can.o > obj-$(CONFIG_CAN_TI_HECC) +=3D ti_hecc.o > obj-$(CONFIG_CAN_XILINXCAN) +=3D xilinx_can.o > +obj-$(CONFIG_CAN_VIRTIO_CAN) +=3D virtio_can.o Please keep this files sorted alphabetically. > > subdir-ccflags-$(CONFIG_CAN_DEBUG_DEVICES) +=3D -DDEBUG > diff --git a/drivers/net/can/virtio_can.c b/drivers/net/can/virtio_can.c > new file mode 100644 > index 000000000000..23f9c1b6446d > --- /dev/null > +++ b/drivers/net/can/virtio_can.c > @@ -0,0 +1,1060 @@ > +// SPDX-License-Identifier: GPL-2.0-only > +/* > + * CAN bus driver for the Virtio CAN controller > + * Copyright (C) 2021-2023 OpenSynergy GmbH > + */ > + > +#include > +#include > +#include > +#include > +#include > +#include > +#include > +#include > +#include > +#include > +#include > +#include > + > +/* CAN device queues */ > +#define VIRTIO_CAN_QUEUE_TX 0 /* Driver side view! The device receives h= ere */ > +#define VIRTIO_CAN_QUEUE_RX 1 /* Driver side view! The device transmits = here */ > +#define VIRTIO_CAN_QUEUE_CONTROL 2 > +#define VIRTIO_CAN_QUEUE_COUNT 3 > + > +#define CAN_KNOWN_FLAGS \ > + (VIRTIO_CAN_FLAGS_EXTENDED |\ > + VIRTIO_CAN_FLAGS_FD |\ > + VIRTIO_CAN_FLAGS_RTR) > + > +/* Max. number of in flight TX messages */ > +#define VIRTIO_CAN_ECHO_SKB_MAX 128 > + > +struct virtio_can_tx { > + struct list_head list; > + int putidx; > + struct virtio_can_tx_out tx_out; > + struct virtio_can_tx_in tx_in; > +}; > + > +/* virtio_can private data structure */ > +struct virtio_can_priv { > + struct can_priv can; /* must be the first member */ > + /* NAPI for RX messages */ > + struct napi_struct napi; > + /* NAPI for TX messages */ > + struct napi_struct napi_tx; > + /* The network device we're associated with */ > + struct net_device *dev; > + /* The virtio device we're associated with */ > + struct virtio_device *vdev; > + /* The virtqueues */ > + struct virtqueue *vqs[VIRTIO_CAN_QUEUE_COUNT]; > + /* I/O callback function pointers for the virtqueues */ > + vq_callback_t *io_callbacks[VIRTIO_CAN_QUEUE_COUNT]; > + /* Lock for TX operations */ > + spinlock_t tx_lock; > + /* Control queue lock. Defensive programming, may be not needed */ > + struct mutex ctrl_lock; > + /* Wait for control queue processing without polling */ > + struct completion ctrl_done; > + /* List of virtio CAN TX message */ > + struct list_head tx_list; > + /* Array of receive queue messages */ > + struct virtio_can_rx rpkt[128]; > + /* Those control queue messages cannot live on the stack! */ > + struct virtio_can_control_out cpkt_out; > + struct virtio_can_control_in cpkt_in; > + /* Data to get and maintain the putidx for local TX echo */ > + struct list_head tx_putidx_free; > + struct list_head *tx_putidx_list; Can you please explain the big picture on tx_putidx_list. The "struct list_head" is supposed to be embedded in some kind of struct, it makes little sense to use them on their own. > + /* In flight TX messages */ > + atomic_t tx_inflight; > + /* Max. In flight TX messages */ > + u16 tx_limit; > + /* BusOff pending. Reset after successful indication to upper layer */ > + bool busoff_pending; > +}; > + > +/* Function copied from virtio_net.c */ > +static void virtqueue_napi_schedule(struct napi_struct *napi, > + struct virtqueue *vq) > +{ > + if (napi_schedule_prep(napi)) { > + virtqueue_disable_cb(vq); > + __napi_schedule(napi); > + } > +} > + > +/* Function copied from virtio_net.c */ > +static void virtqueue_napi_complete(struct napi_struct *napi, > + struct virtqueue *vq, int processed) > +{ > + int opaque; > + > + opaque =3D virtqueue_enable_cb_prepare(vq); > + if (napi_complete_done(napi, processed)) { > + if (unlikely(virtqueue_poll(vq, opaque))) > + virtqueue_napi_schedule(napi, vq); > + } else { > + virtqueue_disable_cb(vq); > + } > +} > + > +static void virtio_can_free_candev(struct net_device *ndev) > +{ > + struct virtio_can_priv *priv =3D netdev_priv(ndev); > + > + kfree(priv->tx_putidx_list); > + free_candev(ndev); > +} > + > +static int virtio_can_alloc_tx_idx(struct virtio_can_priv *priv) > +{ > + struct list_head *entry; > + > + if (atomic_read(&priv->tx_inflight) >=3D priv->can.echo_skb_max) > + return -1; /* Not expected to happen */ Please use proper return values. > + > + atomic_add(1, &priv->tx_inflight); > + > + if (list_empty(&priv->tx_putidx_free)) > + return -1; /* Not expected to happen */ Please use proper return values. > + > + entry =3D priv->tx_putidx_free.next; This looks wrong, you want to use list_first_entry. > + list_del(entry); > + > + return entry - priv->tx_putidx_list; > +} > + > +static void virtio_can_free_tx_idx(struct virtio_can_priv *priv, int idx) > +{ > + if (idx >=3D priv->can.echo_skb_max) { > + WARN_ON(true); /* Not expected to happen */ > + return; > + } > + if (atomic_read(&priv->tx_inflight) =3D=3D 0) { > + WARN_ON(true); /* Not expected to happen */ > + return; > + } > + > + list_add(&priv->tx_putidx_list[idx], &priv->tx_putidx_free); > + atomic_sub(1, &priv->tx_inflight); > +} > + > +/* Create a scatter-gather list representing our input buffer and put > + * it in the queue. > + * > + * Callers should take appropriate locks. > + */ > +static int virtio_can_add_inbuf(struct virtqueue *vq, void *buf, > + unsigned int size) > +{ > + struct scatterlist sg[1]; > + int ret; > + > + sg_init_one(sg, buf, size); > + > + ret =3D virtqueue_add_inbuf(vq, sg, 1, buf, GFP_ATOMIC); > + virtqueue_kick(vq); > + if (ret =3D=3D 0) > + ret =3D vq->num_free; > + return ret; > +} > + > +/* Send a control message with message type either > + * > + * - VIRTIO_CAN_SET_CTRL_MODE_START or > + * - VIRTIO_CAN_SET_CTRL_MODE_STOP. > + * > + * Unlike AUTOSAR CAN Driver Can_SetControllerMode() there is no require= ment > + * for this Linux driver to have an asynchronous implementation of the m= ode > + * setting function so in order to keep things simple the function is > + * implemented as synchronous function. Design pattern is > + * virtio_console.c/__send_control_msg() & virtio_net.c/virtnet_send_com= mand(). > + */ > +static u8 virtio_can_send_ctrl_msg(struct net_device *ndev, u16 msg_type) > +{ > + struct virtio_can_priv *priv =3D netdev_priv(ndev); > + struct device *dev =3D &priv->vdev->dev; > + struct virtqueue *vq =3D priv->vqs[VIRTIO_CAN_QUEUE_CONTROL]; > + struct scatterlist sg_out[1]; > + struct scatterlist sg_in[1]; > + struct scatterlist *sgs[2]; > + int err; > + unsigned int len; > + > + /* The function may be serialized by rtnl lock. Not sure. > + * Better safe than sorry. > + */ > + mutex_lock(&priv->ctrl_lock); > + > + priv->cpkt_out.msg_type =3D cpu_to_le16(msg_type); > + sg_init_one(&sg_out[0], &priv->cpkt_out, sizeof(priv->cpkt_out)); > + sg_init_one(&sg_in[0], &priv->cpkt_in, sizeof(priv->cpkt_in)); > + sgs[0] =3D sg_out; > + sgs[1] =3D sg_in; > + > + err =3D virtqueue_add_sgs(vq, sgs, 1u, 1u, priv, GFP_ATOMIC); > + if (err !=3D 0) { > + /* Not expected to happen */ > + dev_err(dev, "%s(): virtqueue_add_sgs() failed\n", __func__); > + } > + > + if (!virtqueue_kick(vq)) { > + /* Not expected to happen */ > + dev_err(dev, "%s(): Kick failed\n", __func__); > + } > + > + while (!virtqueue_get_buf(vq, &len) && !virtqueue_is_broken(vq)) > + wait_for_completion(&priv->ctrl_done); > + > + mutex_unlock(&priv->ctrl_lock); > + > + return priv->cpkt_in.result; > +} > + > +static void virtio_can_start(struct net_device *ndev) > +{ > + struct virtio_can_priv *priv =3D netdev_priv(ndev); > + u8 result; > + > + result =3D virtio_can_send_ctrl_msg(ndev, VIRTIO_CAN_SET_CTRL_MODE_STAR= T); > + if (result !=3D VIRTIO_CAN_RESULT_OK) { > + /* Not expected to happen */ > + netdev_err(ndev, "CAN controller start failed\n"); > + } > + > + priv->busoff_pending =3D false; > + priv->can.state =3D CAN_STATE_ERROR_ACTIVE; > + > + /* Switch carrier on if device was not connected to the bus */ > + if (!netif_carrier_ok(ndev)) > + netif_carrier_on(ndev); > +} > + > +/* See also m_can.c/m_can_set_mode() > + * > + * It is interesting that not only the M-CAN implementation but also all= other > + * implementations I looked into only support CAN_MODE_START. > + * That CAN_MODE_SLEEP is frequently not found to be supported anywhere = did not > + * come not as surprise but that CAN_MODE_STOP is also never supported w= as one. > + * The function is accessible via the method pointer do_set_mode in > + * struct can_priv. As usual no documentation there. > + * May not play any role as grepping through the code did not reveal any= place > + * from where the method is actually called. > + */ > +static int virtio_can_set_mode(struct net_device *dev, enum can_mode mod= e) > +{ > + switch (mode) { > + case CAN_MODE_START: > + virtio_can_start(dev); > + netif_wake_queue(dev); > + break; > + default: > + return -EOPNOTSUPP; > + } > + > + return 0; > +} > + > +/* Called by issuing "ip link set up can0" */ > +static int virtio_can_open(struct net_device *dev) > +{ > + /* start the virtio_can controller */ > + virtio_can_start(dev); > + > + /* RX and TX napi were already enabled in virtio_can_probe() */ > + netif_start_queue(dev); > + > + return 0; > +} > + > +static void virtio_can_stop(struct net_device *ndev) > +{ > + struct virtio_can_priv *priv =3D netdev_priv(ndev); > + struct device *dev =3D &priv->vdev->dev; > + u8 result; > + > + result =3D virtio_can_send_ctrl_msg(ndev, VIRTIO_CAN_SET_CTRL_MODE_STOP= ); > + if (result !=3D VIRTIO_CAN_RESULT_OK) > + dev_err(dev, "CAN controller stop failed\n"); > + > + priv->busoff_pending =3D false; > + priv->can.state =3D CAN_STATE_STOPPED; > + > + /* Switch carrier off if device was connected to the bus */ > + if (netif_carrier_ok(ndev)) > + netif_carrier_off(ndev); > +} > + > +static int virtio_can_close(struct net_device *dev) > +{ > + netif_stop_queue(dev); > + /* Keep RX napi active to allow dropping of pending RX CAN messages, > + * keep TX napi active to allow processing of cancelled CAN messages > + */ > + virtio_can_stop(dev); > + close_candev(dev); > + > + return 0; > +} > + > +static netdev_tx_t virtio_can_start_xmit(struct sk_buff *skb, > + struct net_device *dev) > +{ > + struct virtio_can_priv *priv =3D netdev_priv(dev); > + struct canfd_frame *cf =3D (struct canfd_frame *)skb->data; > + struct virtio_can_tx *can_tx_msg; > + struct virtqueue *vq =3D priv->vqs[VIRTIO_CAN_QUEUE_TX]; > + struct scatterlist sg_out[1]; > + struct scatterlist sg_in[1]; > + struct scatterlist *sgs[2]; > + unsigned long flags; > + size_t len; > + u32 can_flags; > + int err; > + netdev_tx_t xmit_ret =3D NETDEV_TX_OK; > + const unsigned int hdr_size =3D offsetof(struct virtio_can_tx_out, sdu); > + > + if (can_dropped_invalid_skb(dev, skb)) Use can_dev_dropped_skb() instead, see ae64438be192 "(can: dev: fix skb drop check, 2022-11-02)". > + goto kick; /* No way to return NET_XMIT_DROP here */ > + > + /* Virtio CAN does not support error message frames */ > + if (cf->can_id & CAN_ERR_FLAG) { > + kfree_skb(skb); > + dev->stats.tx_dropped++; > + goto kick; /* No way to return NET_XMIT_DROP here */ > + } It is not checked in any other CAN driver, please remove. We might want to move this into a can_dropped_invalid_skb(). > + > + /* No local check for CAN_RTR_FLAG or FD frame against negotiated > + * features. The device will reject those anyway if not supported. > + */ > + > + can_tx_msg =3D kzalloc(sizeof(*can_tx_msg), GFP_ATOMIC); > + if (!can_tx_msg) > + goto kick; /* No way to return NET_XMIT_DROP here */ > + > + can_tx_msg->tx_out.msg_type =3D cpu_to_le16(VIRTIO_CAN_TX); > + can_flags =3D 0; > + if (cf->can_id & CAN_EFF_FLAG) > + can_flags |=3D VIRTIO_CAN_FLAGS_EXTENDED; > + if (cf->can_id & CAN_RTR_FLAG) > + can_flags |=3D VIRTIO_CAN_FLAGS_RTR; > + if (can_is_canfd_skb(skb)) > + can_flags |=3D VIRTIO_CAN_FLAGS_FD; > + can_tx_msg->tx_out.flags =3D cpu_to_le32(can_flags); > + can_tx_msg->tx_out.can_id =3D cpu_to_le32(cf->can_id & CAN_EFF_MASK); if CAN_EFF_FLAG is set use CAN_EFF_MASK, otherwise use CAN_SFF_MASK. > + len =3D cf->len; > + can_tx_msg->tx_out.length =3D len; =3D cpu_to_le16(len); > + if (len > sizeof(cf->data)) > + len =3D sizeof(cf->data); > + if (len > sizeof(can_tx_msg->tx_out.sdu)) > + len =3D sizeof(can_tx_msg->tx_out.sdu); These checks have already been done by can_dropped_invalid_skb(). > + if (!(can_flags & VIRTIO_CAN_FLAGS_RTR)) { > + /* Copy if not a RTR frame. RTR frames have a DLC but no payload */ > + memcpy(can_tx_msg->tx_out.sdu, cf->data, len); > + } can you move this into the RTR check above? > + > + /* Prepare sending of virtio message */ > + sg_init_one(&sg_out[0], &can_tx_msg->tx_out, hdr_size + len); > + sg_init_one(&sg_in[0], &can_tx_msg->tx_in, sizeof(can_tx_msg->tx_in)); > + sgs[0] =3D sg_out; > + sgs[1] =3D sg_in; > + > + if (atomic_read(&priv->tx_inflight) >=3D priv->tx_limit) { What is.... > + netif_stop_queue(dev); > + kfree(can_tx_msg); > + netdev_dbg(dev, "TX: Stop queue, tx_inflight >=3D tx_limit\n"); > + xmit_ret =3D NETDEV_TX_BUSY; > + goto kick; > + } > + > + /* Normal queue stop when no transmission slots are left */ > + if (atomic_read(&priv->tx_inflight) >=3D priv->tx_limit) { =2E..the difference between these 2 checks? > + netif_stop_queue(dev); > + netdev_dbg(dev, "TX: Normal stop queue\n"); > + } > + > + /* Protect list operations */ > + spin_lock_irqsave(&priv->tx_lock, flags); > + can_tx_msg->putidx =3D virtio_can_alloc_tx_idx(priv); > + list_add_tail(&can_tx_msg->list, &priv->tx_list); > + spin_unlock_irqrestore(&priv->tx_lock, flags); > + > + if (unlikely(can_tx_msg->putidx < 0)) { > + WARN_ON(true); /* Not expected to happen */ > + list_del(&can_tx_msg->list); > + kfree(can_tx_msg); > + xmit_ret =3D NETDEV_TX_OK; > + goto kick; > + } > + > + /* Push loopback echo. Will be looped back on TX interrupt/TX NAPI */ > + can_put_echo_skb(skb, dev, can_tx_msg->putidx, 0); > + > + /* Protect queue and list operations */ > + spin_lock_irqsave(&priv->tx_lock, flags); > + err =3D virtqueue_add_sgs(vq, sgs, 1u, 1u, can_tx_msg, GFP_ATOMIC); > + if (err !=3D 0) { > + list_del(&can_tx_msg->list); > + virtio_can_free_tx_idx(priv, can_tx_msg->putidx); > + spin_unlock_irqrestore(&priv->tx_lock, flags); > + netif_stop_queue(dev); > + kfree(can_tx_msg); > + if (err =3D=3D -ENOSPC) > + netdev_dbg(dev, "TX: Stop queue, no space left\n"); > + else > + netdev_warn(dev, "TX: Stop queue, reason =3D %d\n", err); > + xmit_ret =3D NETDEV_TX_BUSY; > + goto kick; > + } > + spin_unlock_irqrestore(&priv->tx_lock, flags); > + > +kick: > + if (netif_queue_stopped(dev) || !netdev_xmit_more()) { > + if (!virtqueue_kick(vq)) > + netdev_err(dev, "%s(): Kick failed\n", __func__); > + } > + > + return xmit_ret; > +} > + > +static const struct net_device_ops virtio_can_netdev_ops =3D { > + .ndo_open =3D virtio_can_open, > + .ndo_stop =3D virtio_can_close, > + .ndo_start_xmit =3D virtio_can_start_xmit, > + .ndo_change_mtu =3D can_change_mtu, > +}; > + > +static int register_virtio_can_dev(struct net_device *dev) > +{ > + dev->flags |=3D IFF_ECHO; /* we support local echo */ > + dev->netdev_ops =3D &virtio_can_netdev_ops; > + > + return register_candev(dev); > +} > + > +/* Compare with m_can.c/m_can_echo_tx_event() */ > +static int virtio_can_read_tx_queue(struct virtqueue *vq) > +{ > + struct virtio_can_priv *can_priv =3D vq->vdev->priv; > + struct net_device *dev =3D can_priv->dev; > + struct net_device_stats *stats =3D &dev->stats; > + struct virtio_can_tx *can_tx_msg; > + unsigned long flags; > + unsigned int len; > + u8 result; > + > + /* Protect list and virtio queue operations */ > + spin_lock_irqsave(&can_priv->tx_lock, flags); > + > + can_tx_msg =3D virtqueue_get_buf(vq, &len); > + if (!can_tx_msg) { > + spin_unlock_irqrestore(&can_priv->tx_lock, flags); > + return 0; /* No more data */ > + } > + > + if (unlikely(len < sizeof(struct virtio_can_tx_in))) { > + netdev_err(dev, "TX ACK: Device sent no result code\n"); > + result =3D VIRTIO_CAN_RESULT_NOT_OK; /* Keep things going */ > + } else { > + result =3D can_tx_msg->tx_in.result; > + } > + > + if (can_priv->can.state < CAN_STATE_BUS_OFF) { > + /* Here also frames with result !=3D VIRTIO_CAN_RESULT_OK are > + * echoed. Intentional to bring a waiting process in an upper > + * layer to an end. > + * TODO: Any better means to indicate a problem here? > + */ > + if (result !=3D VIRTIO_CAN_RESULT_OK) > + netdev_warn(dev, "TX ACK: Result =3D %u\n", result); > + > + stats->tx_bytes +=3D can_get_echo_skb(dev, can_tx_msg->putidx, > + NULL); > + stats->tx_packets++; > + } else { > + netdev_dbg(dev, "TX ACK: Controller inactive, drop echo\n"); > + can_free_echo_skb(dev, can_tx_msg->putidx, NULL); > + } > + > + list_del(&can_tx_msg->list); > + virtio_can_free_tx_idx(can_priv, can_tx_msg->putidx); > + > + spin_unlock_irqrestore(&can_priv->tx_lock, flags); > + > + kfree(can_tx_msg); > + > + /* Flow control */ > + if (netif_queue_stopped(dev)) { > + netdev_dbg(dev, "TX ACK: Wake up stopped queue\n"); > + netif_wake_queue(dev); > + } > + > + return 1; /* Queue was not empty so there may be more data */ > +} > + > +/* Poll TX used queue for sent CAN messages > + * See https://wiki.linuxfoundation.org/networking/napi function > + * int (*poll)(struct napi_struct *napi, int budget); > + */ > +static int virtio_can_tx_poll(struct napi_struct *napi, int quota) > +{ > + struct net_device *dev =3D napi->dev; > + struct virtio_can_priv *priv =3D netdev_priv(dev); > + struct virtqueue *vq =3D priv->vqs[VIRTIO_CAN_QUEUE_TX]; > + int work_done =3D 0; > + > + while (work_done < quota && virtio_can_read_tx_queue(vq) !=3D 0) > + work_done++; > + > + if (work_done < quota) > + virtqueue_napi_complete(napi, vq, work_done); > + > + return work_done; > +} > + > +static void virtio_can_tx_intr(struct virtqueue *vq) > +{ > + struct virtio_can_priv *can_priv =3D vq->vdev->priv; > + > + virtqueue_disable_cb(vq); > + napi_schedule(&can_priv->napi_tx); > +} > + > +/* This function is the NAPI RX poll function and NAPI guarantees that t= his > + * function is not invoked simultaneously on multiple processors. > + * Read a RX message from the used queue and sends it to the upper layer. > + * (See also m_can.c / m_can_read_fifo()). > + */ > +static int virtio_can_read_rx_queue(struct virtqueue *vq) > +{ > + struct virtio_can_priv *priv =3D vq->vdev->priv; > + struct net_device *dev =3D priv->dev; > + struct net_device_stats *stats =3D &dev->stats; > + struct virtio_can_rx *can_rx; > + struct canfd_frame *cf; > + struct sk_buff *skb; > + unsigned int transport_len; > + unsigned int len; > + const unsigned int header_size =3D offsetof(struct virtio_can_rx, sdu); > + u16 msg_type; > + u32 can_flags; > + u32 can_id; > + > + can_rx =3D virtqueue_get_buf(vq, &transport_len); > + if (!can_rx) > + return 0; /* No more data */ > + > + if (transport_len < header_size) { > + netdev_warn(dev, "RX: Message too small\n"); > + goto putback; > + } > + > + if (priv->can.state >=3D CAN_STATE_ERROR_PASSIVE) { > + netdev_dbg(dev, "%s(): Controller not active\n", __func__); > + goto putback; > + } > + > + msg_type =3D le16_to_cpu(can_rx->msg_type); > + if (msg_type !=3D VIRTIO_CAN_RX) { > + netdev_warn(dev, "RX: Got unknown msg_type %04x\n", msg_type); > + goto putback; > + } > + > + len =3D le16_to_cpu(can_rx->length); > + can_flags =3D le32_to_cpu(can_rx->flags); > + can_id =3D le32_to_cpu(can_rx->can_id); > + > + if (can_flags & ~CAN_KNOWN_FLAGS) { > + stats->rx_dropped++; > + netdev_warn(dev, "RX: CAN Id 0x%08x: Invalid flags 0x%x\n", > + can_id, can_flags); > + goto putback; > + } > + > + if (can_flags & VIRTIO_CAN_FLAGS_EXTENDED) { > + can_id &=3D CAN_EFF_MASK; > + can_id |=3D CAN_EFF_FLAG; > + } else { > + can_id &=3D CAN_SFF_MASK; > + } > + > + if (can_flags & VIRTIO_CAN_FLAGS_RTR) { > + if (!virtio_has_feature(vq->vdev, VIRTIO_CAN_F_RTR_FRAMES)) { > + stats->rx_dropped++; > + netdev_warn(dev, "RX: CAN Id 0x%08x: RTR not negotiated\n", > + can_id); > + goto putback; > + } > + if (can_flags & VIRTIO_CAN_FLAGS_FD) { > + stats->rx_dropped++; > + netdev_warn(dev, "RX: CAN Id 0x%08x: RTR with FD not possible\n", > + can_id); > + goto putback; > + } > + > + if (len > 0xF) { > + stats->rx_dropped++; > + netdev_warn(dev, "RX: CAN Id 0x%08x: RTR with DLC > 0xF\n", > + can_id); > + goto putback; > + } > + > + if (len > 0x8) > + len =3D 0x8; > + > + can_id |=3D CAN_RTR_FLAG; > + } > + > + if (transport_len < header_size + len) { > + netdev_warn(dev, "RX: Message too small for payload\n"); > + goto putback; > + } > + > + if (can_flags & VIRTIO_CAN_FLAGS_FD) { > + if (!virtio_has_feature(vq->vdev, VIRTIO_CAN_F_CAN_FD)) { > + stats->rx_dropped++; > + netdev_warn(dev, "RX: CAN Id 0x%08x: FD not negotiated\n", > + can_id); > + goto putback; > + } > + > + if (len > CANFD_MAX_DLEN) > + len =3D CANFD_MAX_DLEN; > + > + skb =3D alloc_canfd_skb(priv->dev, &cf); > + } else { > + if (!virtio_has_feature(vq->vdev, VIRTIO_CAN_F_CAN_CLASSIC)) { > + stats->rx_dropped++; > + netdev_warn(dev, "RX: CAN Id 0x%08x: classic not negotiated\n", > + can_id); > + goto putback; > + } > + > + if (len > CAN_MAX_DLEN) > + len =3D CAN_MAX_DLEN; > + > + skb =3D alloc_can_skb(priv->dev, (struct can_frame **)&cf); > + } > + if (!skb) { > + stats->rx_dropped++; > + netdev_warn(dev, "RX: No skb available\n"); > + goto putback; > + } > + > + cf->can_id =3D can_id; > + cf->len =3D len; > + if (!(can_flags & VIRTIO_CAN_FLAGS_RTR)) { > + /* RTR frames have a DLC but no payload */ > + memcpy(cf->data, can_rx->sdu, len); > + } > + > + if (netif_receive_skb(skb) =3D=3D NET_RX_SUCCESS) { > + stats->rx_packets++; > + if (!(can_flags & VIRTIO_CAN_FLAGS_RTR)) > + stats->rx_bytes +=3D cf->len; > + } > + > +putback: > + /* Put processed RX buffer back into avail queue */ > + virtio_can_add_inbuf(vq, can_rx, sizeof(struct virtio_can_rx)); > + > + return 1; /* Queue was not empty so there may be more data */ > +} > + > +/* See m_can_poll() / m_can_handle_state_errors() m_can_handle_state_cha= nge() */ > +static int virtio_can_handle_busoff(struct net_device *dev) > +{ > + struct virtio_can_priv *priv =3D netdev_priv(dev); > + struct can_frame *cf; > + struct sk_buff *skb; > + > + if (!priv->busoff_pending) > + return 0; > + > + if (priv->can.state < CAN_STATE_BUS_OFF) { > + netdev_dbg(dev, "entered error bus off state\n"); > + > + /* bus-off state */ > + priv->can.state =3D CAN_STATE_BUS_OFF; > + priv->can.can_stats.bus_off++; > + can_bus_off(dev); > + } > + > + /* propagate the error condition to the CAN stack */ > + skb =3D alloc_can_err_skb(dev, &cf); > + if (unlikely(!skb)) > + return 0; > + > + /* bus-off state */ > + cf->can_id |=3D CAN_ERR_BUSOFF; > + > + /* Ensure that the BusOff indication does not get lost */ > + if (netif_receive_skb(skb) =3D=3D NET_RX_SUCCESS) > + priv->busoff_pending =3D false; > + > + return 1; > +} > + > +/* Poll RX used queue for received CAN messages > + * See https://wiki.linuxfoundation.org/networking/napi function > + * int (*poll)(struct napi_struct *napi, int budget); > + * Important: "The networking subsystem promises that poll() will not be > + * invoked simultaneously (for the same napi_struct) on multiple process= ors" > + */ > +static int virtio_can_rx_poll(struct napi_struct *napi, int quota) > +{ > + struct net_device *dev =3D napi->dev; > + struct virtio_can_priv *priv =3D netdev_priv(dev); > + struct virtqueue *vq =3D priv->vqs[VIRTIO_CAN_QUEUE_RX]; > + int work_done =3D 0; > + > + work_done +=3D virtio_can_handle_busoff(dev); > + > + while (work_done < quota && virtio_can_read_rx_queue(vq) !=3D 0) > + work_done++; > + > + if (work_done < quota) > + virtqueue_napi_complete(napi, vq, work_done); > + > + return work_done; > +} > + > +static void virtio_can_rx_intr(struct virtqueue *vq) > +{ > + struct virtio_can_priv *can_priv =3D vq->vdev->priv; > + > + virtqueue_disable_cb(vq); > + napi_schedule(&can_priv->napi); > +} > + > +static void virtio_can_control_intr(struct virtqueue *vq) > +{ > + struct virtio_can_priv *can_priv =3D vq->vdev->priv; > + > + complete(&can_priv->ctrl_done); > +} > + > +static void virtio_can_config_changed(struct virtio_device *vdev) > +{ > + struct virtio_can_priv *can_priv =3D vdev->priv; > + u16 status; > + > + status =3D virtio_cread16(vdev, offsetof(struct virtio_can_config, > + status)); > + > + if (!(status & VIRTIO_CAN_S_CTRL_BUSOFF)) > + return; > + > + if (!can_priv->busoff_pending && > + can_priv->can.state < CAN_STATE_BUS_OFF) { > + can_priv->busoff_pending =3D true; > + napi_schedule(&can_priv->napi); > + } > +} > + > +static void virtio_can_populate_vqs(struct virtio_device *vdev) > + > +{ > + struct virtio_can_priv *priv =3D vdev->priv; > + struct virtqueue *vq; > + unsigned int idx; > + int ret; > + > + /* Fill RX queue */ > + vq =3D priv->vqs[VIRTIO_CAN_QUEUE_RX]; > + for (idx =3D 0; idx < ARRAY_SIZE(priv->rpkt); idx++) { > + ret =3D virtio_can_add_inbuf(vq, &priv->rpkt[idx], > + sizeof(struct virtio_can_rx)); > + if (ret < 0) { > + dev_dbg(&vdev->dev, "rpkt fill: ret=3D%d, idx=3D%u\n", > + ret, idx); > + break; > + } > + } > + dev_dbg(&vdev->dev, "%u rpkt added\n", idx); > +} > + > +static int virtio_can_find_vqs(struct virtio_can_priv *priv) > +{ > + /* The order of RX and TX is exactly the opposite as in console and > + * network. Does not play any role but is a bad trap. > + */ > + static const char * const io_names[VIRTIO_CAN_QUEUE_COUNT] =3D { > + "can-tx", > + "can-rx", > + "can-state-ctrl" > + }; > + > + priv->io_callbacks[VIRTIO_CAN_QUEUE_TX] =3D virtio_can_tx_intr; > + priv->io_callbacks[VIRTIO_CAN_QUEUE_RX] =3D virtio_can_rx_intr; > + priv->io_callbacks[VIRTIO_CAN_QUEUE_CONTROL] =3D virtio_can_control_int= r; > + > + /* Find the queues. */ > + return virtio_find_vqs(priv->vdev, VIRTIO_CAN_QUEUE_COUNT, priv->vqs, > + priv->io_callbacks, io_names, NULL); > +} > + > +/* Function must not be called before virtio_can_find_vqs() has been run= */ > +static void virtio_can_del_vq(struct virtio_device *vdev) > +{ > + struct virtio_can_priv *priv =3D vdev->priv; > + struct list_head *cursor, *next; > + struct virtqueue *vq; > + > + /* Reset the device */ > + if (vdev->config->reset) > + vdev->config->reset(vdev); > + > + /* From here we have dead silence from the device side so no locks > + * are needed to protect against device side events. > + */ > + > + vq =3D priv->vqs[VIRTIO_CAN_QUEUE_CONTROL]; > + while (virtqueue_detach_unused_buf(vq)) > + ; /* Do nothing, content allocated statically */ > + > + vq =3D priv->vqs[VIRTIO_CAN_QUEUE_RX]; > + while (virtqueue_detach_unused_buf(vq)) > + ; /* Do nothing, content allocated statically */ > + > + vq =3D priv->vqs[VIRTIO_CAN_QUEUE_TX]; > + while (virtqueue_detach_unused_buf(vq)) > + ; /* Do nothing, content to be de-allocated separately */ > + > + /* Is keeping track of allocated elements by an own linked list > + * really necessary or may this be optimized using only > + * virtqueue_detach_unused_buf()? > + */ > + list_for_each_safe(cursor, next, &priv->tx_list) { > + struct virtio_can_tx *can_tx; > + > + can_tx =3D list_entry(cursor, struct virtio_can_tx, list); > + list_del(cursor); > + kfree(can_tx); > + } > + > + if (vdev->config->del_vqs) > + vdev->config->del_vqs(vdev); > +} > + > +/* See virtio_net.c/virtnet_remove() and also m_can.c/m_can_plat_remove(= ) */ > +static void virtio_can_remove(struct virtio_device *vdev) > +{ > + struct virtio_can_priv *priv =3D vdev->priv; > + struct net_device *dev =3D priv->dev; > + > + unregister_candev(dev); > + > + /* No calls of netif_napi_del() needed as free_candev() will do this */ > + > + virtio_can_del_vq(vdev); > + > + virtio_can_free_candev(dev); > +} > + > +static int virtio_can_validate(struct virtio_device *vdev) > +{ > + /* CAN needs always access to the config space. > + * Check that the driver can access the config space > + */ > + if (!vdev->config->get) { > + dev_err(&vdev->dev, "%s failure: config access disabled\n", > + __func__); > + return -EINVAL; > + } > + > + if (!virtio_has_feature(vdev, VIRTIO_F_VERSION_1)) { > + dev_err(&vdev->dev, > + "device does not comply with spec version 1.x\n"); > + return -EINVAL; > + } > + > + return 0; > +} > + > +static int virtio_can_probe(struct virtio_device *vdev) > +{ > + struct net_device *dev; > + struct virtio_can_priv *priv; > + int err; > + unsigned int echo_skb_max; > + unsigned int idx; > + u16 lo_tx =3D VIRTIO_CAN_ECHO_SKB_MAX; > + > + echo_skb_max =3D lo_tx; > + dev =3D alloc_candev(sizeof(struct virtio_can_priv), echo_skb_max); > + if (!dev) > + return -ENOMEM; > + > + priv =3D netdev_priv(dev); > + > + priv->tx_putidx_list =3D > + kcalloc(echo_skb_max, sizeof(struct list_head), GFP_KERNEL); > + if (!priv->tx_putidx_list) { > + free_candev(dev); > + return -ENOMEM; Please use the common goto on_failure here, too. > + } > + > + INIT_LIST_HEAD(&priv->tx_putidx_free); > + for (idx =3D 0; idx < echo_skb_max; idx++) > + list_add_tail(&priv->tx_putidx_list[idx], > + &priv->tx_putidx_free); > + > + netif_napi_add(dev, &priv->napi, virtio_can_rx_poll); > + netif_napi_add(dev, &priv->napi_tx, virtio_can_tx_poll); > + > + SET_NETDEV_DEV(dev, &vdev->dev); > + > + priv->dev =3D dev; > + priv->vdev =3D vdev; > + vdev->priv =3D priv; > + > + priv->can.do_set_mode =3D virtio_can_set_mode; > + priv->can.state =3D CAN_STATE_STOPPED; No need to assign. > + /* Set Virtio CAN supported operations */ > + priv->can.ctrlmode_supported =3D CAN_CTRLMODE_BERR_REPORTING; > + if (virtio_has_feature(vdev, VIRTIO_CAN_F_CAN_FD)) { What does VIRTIO_CAN_F_CAN_FD mean exactly? > + err =3D can_set_static_ctrlmode(dev, CAN_CTRLMODE_FD); > + if (err !=3D 0) > + goto on_failure; > + } > + > + /* Initialize virtqueues */ > + err =3D virtio_can_find_vqs(priv); > + if (err !=3D 0) > + goto on_failure; > + > + /* It is possible to consider the number of TX queue places to > + * introduce a stricter TX flow control. Question is if this should > + * be done permanently this way in the Linux virtio CAN driver. > + */ What is configured here? > + if (true) { > + struct virtqueue *vq =3D priv->vqs[VIRTIO_CAN_QUEUE_TX]; > + unsigned int tx_slots =3D vq->num_free; > + > + if (!virtio_has_feature(vdev, VIRTIO_RING_F_INDIRECT_DESC)) > + tx_slots >>=3D 1; > + if (lo_tx > tx_slots) > + lo_tx =3D tx_slots; > + } > + > + priv->tx_limit =3D lo_tx; > + > + INIT_LIST_HEAD(&priv->tx_list); > + > + spin_lock_init(&priv->tx_lock); > + mutex_init(&priv->ctrl_lock); > + > + init_completion(&priv->ctrl_done); > + > + virtio_can_populate_vqs(vdev); > + > + register_virtio_can_dev(dev); > + > + napi_enable(&priv->napi); > + napi_enable(&priv->napi_tx); > + > + /* Request device going live */ > + virtio_device_ready(vdev); /* Optionally done by virtio_dev_probe() */ > + > + return 0; > + > +on_failure: > + virtio_can_free_candev(dev); > + return err; > +} > + > +#ifdef CONFIG_PM_SLEEP please remove the ifdef and add __maybe_unused instead. > +/* Compare with m_can.c/m_can_suspend(), virtio_net.c/virtnet_freeze() a= nd > + * virtio_card.c/virtsnd_freeze() > + */ > +static int virtio_can_freeze(struct virtio_device *vdev) > +{ > + struct virtio_can_priv *priv =3D vdev->priv; > + struct net_device *ndev =3D priv->dev; > + > + napi_disable(&priv->napi); > + napi_disable(&priv->napi_tx); > + > + if (netif_running(ndev)) { > + netif_stop_queue(ndev); > + netif_device_detach(ndev); > + virtio_can_stop(ndev); > + } > + > + priv->can.state =3D CAN_STATE_SLEEPING; > + > + virtio_can_del_vq(vdev); > + > + return 0; > +} > + > +/* Compare with m_can.c/m_can_resume(), virtio_net.c/virtnet_restore() a= nd > + * virtio_card.c/virtsnd_restore() > + */ > +static int virtio_can_restore(struct virtio_device *vdev) > +{ > + struct virtio_can_priv *priv =3D vdev->priv; > + struct net_device *ndev =3D priv->dev; > + int err; > + > + err =3D virtio_can_find_vqs(priv); > + if (err !=3D 0) > + return err; > + virtio_can_populate_vqs(vdev); > + > + priv->can.state =3D CAN_STATE_ERROR_ACTIVE; > + > + if (netif_running(ndev)) { > + virtio_can_start(ndev); > + netif_device_attach(ndev); > + netif_start_queue(ndev); > + } > + > + napi_enable(&priv->napi); > + napi_enable(&priv->napi_tx); > + > + return 0; > +} > +#endif /* #ifdef CONFIG_PM_SLEEP */ > + > +static struct virtio_device_id virtio_can_id_table[] =3D { > + { VIRTIO_ID_CAN, VIRTIO_DEV_ANY_ID }, > + { 0 }, > +}; > + > +static unsigned int features[] =3D { > + VIRTIO_CAN_F_CAN_CLASSIC, > + VIRTIO_CAN_F_CAN_FD, > + VIRTIO_CAN_F_LATE_TX_ACK, > + VIRTIO_CAN_F_RTR_FRAMES, > +}; > + > +static struct virtio_driver virtio_can_driver =3D { > + .feature_table =3D features, > + .feature_table_size =3D ARRAY_SIZE(features), > + .feature_table_legacy =3D NULL, > + .feature_table_size_legacy =3D 0, Nitpick: Please indent uniformly with a single space after the =3D. > + .driver.name =3D KBUILD_MODNAME, > + .driver.owner =3D THIS_MODULE, > + .id_table =3D virtio_can_id_table, > + .validate =3D virtio_can_validate, > + .probe =3D virtio_can_probe, > + .remove =3D virtio_can_remove, > + .config_changed =3D virtio_can_config_changed, > +#ifdef CONFIG_PM_SLEEP > + .freeze =3D virtio_can_freeze, > + .restore =3D virtio_can_restore, > +#endif > +}; > + > +module_virtio_driver(virtio_can_driver); > +MODULE_DEVICE_TABLE(virtio, virtio_can_id_table); > + > +MODULE_AUTHOR("OpenSynergy GmbH"); > +MODULE_LICENSE("GPL"); > +MODULE_DESCRIPTION("CAN bus driver for Virtio CAN controller"); > diff --git a/include/uapi/linux/virtio_can.h b/include/uapi/linux/virtio_= can.h > new file mode 100644 > index 000000000000..de85918aa7dc > --- /dev/null > +++ b/include/uapi/linux/virtio_can.h > @@ -0,0 +1,71 @@ > +/* SPDX-License-Identifier: BSD-3-Clause */ > +/* > + * Copyright (C) 2021-2023 OpenSynergy GmbH > + */ > +#ifndef _LINUX_VIRTIO_VIRTIO_CAN_H > +#define _LINUX_VIRTIO_VIRTIO_CAN_H > + > +#include > +#include > +#include > +#include > + > +/* Feature bit numbers */ > +#define VIRTIO_CAN_F_CAN_CLASSIC 0 > +#define VIRTIO_CAN_F_CAN_FD 1 > +#define VIRTIO_CAN_F_LATE_TX_ACK 2 > +#define VIRTIO_CAN_F_RTR_FRAMES 3 > + > +/* CAN Result Types */ > +#define VIRTIO_CAN_RESULT_OK 0 > +#define VIRTIO_CAN_RESULT_NOT_OK 1 > + > +/* CAN flags to determine type of CAN Id */ > +#define VIRTIO_CAN_FLAGS_EXTENDED 0x8000 > +#define VIRTIO_CAN_FLAGS_FD 0x4000 > +#define VIRTIO_CAN_FLAGS_RTR 0x2000 > + > +struct virtio_can_config { > +#define VIRTIO_CAN_S_CTRL_BUSOFF (1u << 0) /* Controller BusOff */ > + /* CAN controller status */ > + __le16 status; > +}; > + > +/* TX queue message types */ > +struct virtio_can_tx_out { > +#define VIRTIO_CAN_TX 0x0001 > + __le16 msg_type; > + __le16 length; /* 0..8 CC, 0..64 CAN=C2=ADFD, 0..2048 CAN=C2=ADXL, 12 b= its */ > + __le32 reserved; /* May be needed in part for CAN XL priority */ > + __le32 flags; > + __le32 can_id; > + __u8 sdu[64]; > +}; > + > +struct virtio_can_tx_in { > + __u8 result; > +}; > + > +/* RX queue message types */ > +struct virtio_can_rx { > +#define VIRTIO_CAN_RX 0x0101 > + __le16 msg_type; > + __le16 length; /* 0..8 CC, 0..64 CAN=C2=ADFD, 0..2048 CAN=C2=ADXL, 12 b= its */ > + __le32 reserved; /* May be needed in part for CAN XL priority */ > + __le32 flags; > + __le32 can_id; > + __u8 sdu[64]; > +}; > + > +/* Control queue message types */ > +struct virtio_can_control_out { > +#define VIRTIO_CAN_SET_CTRL_MODE_START 0x0201 > +#define VIRTIO_CAN_SET_CTRL_MODE_STOP 0x0202 > + __le16 msg_type; > +}; > + > +struct virtio_can_control_in { > + __u8 result; > +}; > + > +#endif /* #ifndef _LINUX_VIRTIO_VIRTIO_CAN_H */ > -- > 2.34.1 > > Marc --=20 Pengutronix e.K. | Marc Kleine-Budde | Embedded Linux | https://www.pengutronix.de | Vertretung N=C3=BCrnberg | Phone: +49-5121-206917-129 | Amtsgericht Hildesheim, HRA 2686 | Fax: +49-5121-206917-9 | --u3o45odz4bv4dzn6 Content-Type: application/pgp-signature; name="signature.asc" -----BEGIN PGP SIGNATURE----- iQEzBAABCgAdFiEEDs2BvajyNKlf9TJQvlAcSiqKBOgFAmRG0l8ACgkQvlAcSiqK BOhWdwf/fX0vCtilir/QLvbaV0p6LqEmtmtgWTdMNdkq7WTqnqScxKiTHvqiCkbf NuRqQLIY6JclxyZQS2Bm/uqq9+c82QblGEnk+SgR9YRX/koMUkDTBqgkIxGHa1Am S36MURrYgdBbzX/OLI8zFOlhoY6bQOuICkpoctWw4UBwdkWmMWsVFucx+Rjj1PFO YIMzwmHcYpPm1ziC/BnDhUql8lXqIpwjUSJR+0Qqvkwb2oNkT0GcO6FHAv4shkXW 8Ru6EETiFeFDrn4Acv+NvUa2DzEKMI0hQ16BOQfEkZ8JcxSKprK8lB5TBkxS8TVD mQlf1GuXBSv5IFdh/gwErqojkyaulw== =swxc -----END PGP SIGNATURE----- --u3o45odz4bv4dzn6--