From nobody Mon Feb 9 20:12:10 2026 Delivered-To: importer@patchew.org Authentication-Results: mx.zohomail.com; dkim=fail; spf=pass (zohomail.com: domain of gnu.org designates 209.51.188.17 as permitted sender) smtp.mailfrom=qemu-devel-bounces+importer=patchew.org@nongnu.org ARC-Seal: i=1; a=rsa-sha256; t=1594729740; cv=none; d=zohomail.com; s=zohoarc; b=AS06QvFOHuSLBYh/U8J1MqColHIwixU5G5+fAjoWe7JYaoPdG1aptExf+DBkNIesJ9UDu34YYpenMI0bx5TAB4mTFrsk9xjjP5TbK/8NZX9K11vNY70VVjocnfA0PEFVl+X3QvGYT6kCmaNEhSeA0vXmdR/Lt2sbr21ln/HN6+s= ARC-Message-Signature: i=1; a=rsa-sha256; c=relaxed/relaxed; d=zohomail.com; s=zohoarc; t=1594729740; h=Content-Transfer-Encoding:Cc:Date:From:In-Reply-To:List-Subscribe:List-Post:List-Id:List-Archive:List-Help:List-Unsubscribe:MIME-Version:Message-ID:References:Sender:Subject:To; bh=FnYWBsooya8skn5xNMdV7GB12h3azv9t0jZCapGnCO4=; b=dp8ZkiJTU7YBbgqidpD1+Ge84q3b/8+Xb5KJqDJogYRGD4mXD5/RFMAefBjBrF55wJzA7BQVI+2CnSpa7LV1C4Elkiox9WUsRhwS0+NM9+aZHD2ENjwAD4AvWX5KbcZIH+OvKquEkSXddYjTfY+tfJDFyfhJbcIM4Cosb3RbSHQ= ARC-Authentication-Results: i=1; mx.zohomail.com; dkim=fail; spf=pass (zohomail.com: domain of gnu.org designates 209.51.188.17 as permitted sender) smtp.mailfrom=qemu-devel-bounces+importer=patchew.org@nongnu.org Return-Path: Received: from lists.gnu.org (lists.gnu.org [209.51.188.17]) by mx.zohomail.com with SMTPS id 1594729740158207.8051606230423; Tue, 14 Jul 2020 05:29:00 -0700 (PDT) Received: from localhost ([::1]:38482 helo=lists1p.gnu.org) by lists.gnu.org with esmtp (Exim 4.90_1) (envelope-from ) id 1jvK3O-0008Es-GM for importer@patchew.org; Tue, 14 Jul 2020 08:28:58 -0400 Received: from eggs.gnu.org ([2001:470:142:3::10]:39036) by lists.gnu.org with esmtps (TLS1.2:ECDHE_RSA_AES_256_GCM_SHA384:256) (Exim 4.90_1) (envelope-from ) id 1jvK1T-0006Sr-4p for qemu-devel@nongnu.org; Tue, 14 Jul 2020 08:26:59 -0400 Received: from mxa2.seznam.cz ([2a02:598:2::90]:51625) by eggs.gnu.org with esmtps (TLS1.2:ECDHE_RSA_AES_256_GCM_SHA384:256) (Exim 4.90_1) (envelope-from ) id 1jvK1Q-0007pP-Ax for qemu-devel@nongnu.org; Tue, 14 Jul 2020 08:26:58 -0400 Received: from email.seznam.cz by email-smtpc14b.ng.seznam.cz (email-smtpc14b.ng.seznam.cz [10.23.14.165]) id 118e4763d331582214fca357; Tue, 14 Jul 2020 14:26:53 +0200 (CEST) Received: from hathi.duckdns.org (2001:718:2:1654:e269:95ff:fec3:1c81 [2001:718:2:1654:e269:95ff:fec3:1c81]) by email-relay20.ng.seznam.cz (Seznam SMTPD 1.3.119) with ESMTP; Tue, 14 Jul 2020 14:26:51 +0200 (CEST) DKIM-Signature: v=1; a=rsa-sha256; c=relaxed/relaxed; d=seznam.cz; s=beta; t=1594729613; bh=FnYWBsooya8skn5xNMdV7GB12h3azv9t0jZCapGnCO4=; h=Received:From:To:Cc:Subject:Date:Message-Id:X-Mailer:In-Reply-To: References:MIME-Version:Content-Transfer-Encoding; b=A7BqwA4TV6ru/4c2p6Upn5WnMIDpWlWYJzASAIS54kLF8weWnEa36ys6BcWHcJH8y a4KQK3kcFbleatZJcRDEpyi8DALvFteeMVf6g1MjUzlXMcpoLPXBgnJJlLobTL8ol8 7eFw1jxzjqyZzAwpMCdTYhKBOgMuf3TqC04xm5V0= From: pisa@cmp.felk.cvut.cz To: qemu-devel@nongnu.org, Paolo Bonzini Subject: [PATCH v1 1/6] net/can: Initial host SocketCan support for CAN FD. Date: Tue, 14 Jul 2020 14:20:14 +0200 Message-Id: X-Mailer: git-send-email 2.20.1 In-Reply-To: References: MIME-Version: 1.0 Content-Transfer-Encoding: quoted-printable Received-SPF: pass (zohomail.com: domain of gnu.org designates 209.51.188.17 as permitted sender) client-ip=209.51.188.17; envelope-from=qemu-devel-bounces+importer=patchew.org@nongnu.org; helo=lists.gnu.org; Received-SPF: pass client-ip=2a02:598:2::90; envelope-from=autobot.majer@seznam.cz; helo=mxa2.seznam.cz X-detected-operating-system: by eggs.gnu.org: No matching host in p0f cache. That's all we know. X-Spam_score_int: -6 X-Spam_score: -0.7 X-Spam_bar: / X-Spam_report: (-0.7 / 5.0 requ) BAYES_00=-1.9, DKIM_SIGNED=0.1, DKIM_VALID=-0.1, DKIM_VALID_EF=-0.1, FREEMAIL_FORGED_FROMDOMAIN=1, FREEMAIL_FROM=0.001, HEADER_FROM_DIFFERENT_DOMAINS=1, RCVD_IN_DNSWL_LOW=-0.7, SPF_HELO_NONE=0.001, SPF_PASS=-0.001, URIBL_BLOCKED=0.001 autolearn=no autolearn_force=no X-Spam_action: no action X-BeenThere: qemu-devel@nongnu.org X-Mailman-Version: 2.1.23 Precedence: list List-Id: List-Unsubscribe: , List-Archive: List-Post: List-Help: List-Subscribe: , Cc: Marek Vasut , Oliver Hartkopp , Jiri Novak , Stefan Hajnoczi , Deniz Eren , Markus Armbruster , Oleksij Rempel , Konrad Frederic , Jan Charvat , Jan Kiszka , Ondrej Ille , Pavel Pisa Errors-To: qemu-devel-bounces+importer=patchew.org@nongnu.org Sender: "Qemu-devel" X-ZohoMail-DKIM: fail (Header signature does not verify) Content-Type: text/plain; charset="utf-8" From: Jan Charvat Signed-off-by: Jan Charvat Signed-off-by: Pavel Pisa --- hw/net/can/can_sja1000.c | 2 ++ include/net/can_emu.h | 8 ++++++- net/can/can_socketcan.c | 47 +++++++++++++++++++++++++++++++++++++--- 3 files changed, 53 insertions(+), 4 deletions(-) diff --git a/hw/net/can/can_sja1000.c b/hw/net/can/can_sja1000.c index ea915a023a..d83c550edc 100644 --- a/hw/net/can/can_sja1000.c +++ b/hw/net/can/can_sja1000.c @@ -268,6 +268,7 @@ static void buff2frame_pel(const uint8_t *buff, qemu_ca= n_frame *frame) { uint8_t i; =20 + frame->flags =3D 0; frame->can_id =3D 0; if (buff[0] & 0x40) { /* RTR */ frame->can_id =3D QEMU_CAN_RTR_FLAG; @@ -303,6 +304,7 @@ static void buff2frame_bas(const uint8_t *buff, qemu_ca= n_frame *frame) { uint8_t i; =20 + frame->flags =3D 0; frame->can_id =3D ((buff[0] << 3) & (0xff << 3)) + ((buff[1] >> 5) & 0= x07); if (buff[1] & 0x10) { /* RTR */ frame->can_id =3D QEMU_CAN_RTR_FLAG; diff --git a/include/net/can_emu.h b/include/net/can_emu.h index fce9770928..c6164dcfb4 100644 --- a/include/net/can_emu.h +++ b/include/net/can_emu.h @@ -46,7 +46,8 @@ typedef uint32_t qemu_canid_t; typedef struct qemu_can_frame { qemu_canid_t can_id; /* 32 bit CAN_ID + EFF/RTR/ERR flags */ uint8_t can_dlc; /* data length code: 0 .. 8 */ - uint8_t data[8] QEMU_ALIGNED(8); + uint8_t flags; + uint8_t data[64] QEMU_ALIGNED(8); } qemu_can_frame; =20 /* Keep defines for QEMU separate from Linux ones for now */ @@ -58,6 +59,10 @@ typedef struct qemu_can_frame { #define QEMU_CAN_SFF_MASK 0x000007FFU /* standard frame format (SFF) */ #define QEMU_CAN_EFF_MASK 0x1FFFFFFFU /* extended frame format (EFF) */ =20 +#define QEMU_CAN_FRMF_BRS 0x01 /* bit rate switch (2nd bitrate for dat= a) */ +#define QEMU_CAN_FRMF_ESI 0x02 /* error state ind. of transmitting nod= e */ +#define QEMU_CAN_FRMF_TYPE_FD 0x10 /* internal bit ind. of CAN FD frame */ + /** * struct qemu_can_filter - CAN ID based filter in can_register(). * @can_id: relevant bits of CAN ID which are not masked out. @@ -97,6 +102,7 @@ struct CanBusClientState { char *model; char *name; void (*destructor)(CanBusClientState *); + bool fd_mode; }; =20 #define TYPE_CAN_BUS "can-bus" diff --git a/net/can/can_socketcan.c b/net/can/can_socketcan.c index b7ef63ec0e..fbc0b62ea4 100644 --- a/net/can/can_socketcan.c +++ b/net/can/can_socketcan.c @@ -103,6 +103,14 @@ static void can_host_socketcan_read(void *opaque) return; } =20 + if (!ch->bus_client.fd_mode) { + c->buf[0].flags =3D 0; + } else { + if (c->bufcnt > CAN_MTU) { + c->buf[0].flags |=3D QEMU_CAN_FRMF_TYPE_FD; + } + } + can_bus_client_send(&ch->bus_client, c->buf, 1); =20 if (DEBUG_CAN) { @@ -121,12 +129,21 @@ static ssize_t can_host_socketcan_receive(CanBusClien= tState *client, CanHostState *ch =3D container_of(client, CanHostState, bus_client); CanHostSocketCAN *c =3D CAN_HOST_SOCKETCAN(ch); =20 - size_t len =3D sizeof(qemu_can_frame); + size_t len; int res; =20 if (c->fd < 0) { return -1; } + if (frames->flags & QEMU_CAN_FRMF_TYPE_FD) { + if (!ch->bus_client.fd_mode) { + return 0; + } + len =3D CANFD_MTU; + } else { + len =3D CAN_MTU; + + } =20 res =3D write(c->fd, frames, len); =20 @@ -172,6 +189,8 @@ static void can_host_socketcan_connect(CanHostState *ch= , Error **errp) { CanHostSocketCAN *c =3D CAN_HOST_SOCKETCAN(ch); int s; /* can raw socket */ + int mtu; + int enable_canfd =3D 1; struct sockaddr_can addr; struct ifreq ifr; =20 @@ -185,13 +204,34 @@ static void can_host_socketcan_connect(CanHostState *= ch, Error **errp) addr.can_family =3D AF_CAN; memset(&ifr.ifr_name, 0, sizeof(ifr.ifr_name)); strcpy(ifr.ifr_name, c->ifname); + /* check if the frame fits into the CAN netdevice */ if (ioctl(s, SIOCGIFINDEX, &ifr) < 0) { error_setg_errno(errp, errno, - "SocketCAN host interface %s not available", c->i= fname); + "SocketCAN host interface %s not available", + c->ifname); goto fail; } addr.can_ifindex =3D ifr.ifr_ifindex; =20 + if (ioctl(s, SIOCGIFMTU, &ifr) < 0) { + error_setg_errno(errp, errno, + "SocketCAN host interface %s SIOCGIFMTU failed", + c->ifname); + goto fail; + } + mtu =3D ifr.ifr_mtu; + + if (mtu >=3D CANFD_MTU) { + /* interface is ok - try to switch the socket into CAN FD mode */ + if (setsockopt(s, SOL_CAN_RAW, CAN_RAW_FD_FRAMES, + &enable_canfd, sizeof(enable_canfd))) { + warn_report("SocketCAN host interface %s enabling CAN FD faile= d", + c->ifname); + } else { + c->parent.bus_client.fd_mode =3D true; + } + } + c->err_mask =3D 0xffffffff; /* Receive error frame. */ setsockopt(s, SOL_CAN_RAW, CAN_RAW_ERR_FILTER, &c->err_mask, sizeof(c->err_mask)); @@ -232,7 +272,8 @@ static char *can_host_socketcan_get_if(Object *obj, Err= or **errp) return g_strdup(c->ifname); } =20 -static void can_host_socketcan_set_if(Object *obj, const char *value, Erro= r **errp) +static void can_host_socketcan_set_if(Object *obj, const char *value, + Error **errp) { CanHostSocketCAN *c =3D CAN_HOST_SOCKETCAN(obj); struct ifreq ifr; --=20 2.20.1