From patchwork Thu Dec 14 14:52:47 2017 Content-Type: text/plain; charset="utf-8" MIME-Version: 1.0 Content-Transfer-Encoding: 8bit X-Patchwork-Submitter: Andrey Smirnov X-Patchwork-Id: 10112407 Return-Path: Received: from mail.wl.linuxfoundation.org (pdx-wl-mail.web.codeaurora.org [172.30.200.125]) by pdx-korg-patchwork.web.codeaurora.org (Postfix) with ESMTP id 659F860352 for ; Thu, 14 Dec 2017 15:06:59 +0000 (UTC) Received: from mail.wl.linuxfoundation.org (localhost [127.0.0.1]) by mail.wl.linuxfoundation.org (Postfix) with ESMTP id 55C0929046 for ; Thu, 14 Dec 2017 15:06:59 +0000 (UTC) Received: by mail.wl.linuxfoundation.org (Postfix, from userid 486) id 4ACBF2904A; Thu, 14 Dec 2017 15:06:59 +0000 (UTC) X-Spam-Checker-Version: SpamAssassin 3.3.1 (2010-03-16) on pdx-wl-mail.web.codeaurora.org X-Spam-Level: X-Spam-Status: No, score=-6.8 required=2.0 tests=BAYES_00, DKIM_ADSP_CUSTOM_MED, DKIM_SIGNED, FREEMAIL_FROM, RCVD_IN_DNSWL_HI, T_DKIM_INVALID autolearn=ham version=3.3.1 Received: from lists.gnu.org (lists.gnu.org [208.118.235.17]) (using TLSv1 with cipher AES256-SHA (256/256 bits)) (No client certificate requested) by mail.wl.linuxfoundation.org (Postfix) with ESMTPS id B84FB29046 for ; Thu, 14 Dec 2017 15:06:58 +0000 (UTC) Received: from localhost ([::1]:41470 helo=lists.gnu.org) by lists.gnu.org with esmtp (Exim 4.71) (envelope-from ) id 1ePV69-0003wZ-K0 for patchwork-qemu-devel@patchwork.kernel.org; Thu, 14 Dec 2017 10:06:57 -0500 Received: from eggs.gnu.org ([2001:4830:134:3::10]:55375) by lists.gnu.org with esmtp (Exim 4.71) (envelope-from ) id 1ePUtH-0001Zb-Dl for qemu-devel@nongnu.org; Thu, 14 Dec 2017 09:53:41 -0500 Received: from Debian-exim by eggs.gnu.org with spam-scanned (Exim 4.71) (envelope-from ) id 1ePUtB-0000ZU-IE for qemu-devel@nongnu.org; Thu, 14 Dec 2017 09:53:39 -0500 Received: from mail-pg0-x244.google.com ([2607:f8b0:400e:c05::244]:46612) by eggs.gnu.org with esmtps (TLS1.0:RSA_AES_128_CBC_SHA1:16) (Exim 4.71) (envelope-from ) id 1ePUt8-0000Sd-0k; Thu, 14 Dec 2017 09:53:30 -0500 Received: by mail-pg0-x244.google.com with SMTP id b11so3542002pgu.13; Thu, 14 Dec 2017 06:53:29 -0800 (PST) DKIM-Signature: v=1; a=rsa-sha256; c=relaxed/relaxed; d=gmail.com; s=20161025; h=from:to:cc:subject:date:message-id:in-reply-to:references :mime-version:content-transfer-encoding; bh=E08NgLB+iZxe+FQ8+m6OK1RQdn04+8BR1I1ixtM1hXU=; b=lLCRpikG97b3gKaCARhwPrgytRxH5OCNzTyNiClaEm6wmkp6SJ6tlfIBNYugXDZC26 oL9LzS/34137/UxAFw4wdc+yencF/fkfNQz/q8R/BhYdFRQ/xcQkxNyjwCmAEemtJx4U osdTVCp/S/FcC+zmf2XQhmdkApy9vguqUNUehFAZC7vwRa2ieSwNCU7VUSDrvUFXhZ17 WvDn+AwtIJChIpZhjg6Fm/C9jLt6qzvBOuYhv1KxUCy3tqIXm3zvddL/R6TKW6d6uA4C LdOe7IFlq74lchv8XcU4KtsnZ2AeSjKOYzW+87lbLETB/DxAVTuXMFszAFNiVucpdbgD XGSQ== X-Google-DKIM-Signature: v=1; a=rsa-sha256; c=relaxed/relaxed; d=1e100.net; s=20161025; h=x-gm-message-state:from:to:cc:subject:date:message-id:in-reply-to :references:mime-version:content-transfer-encoding; bh=E08NgLB+iZxe+FQ8+m6OK1RQdn04+8BR1I1ixtM1hXU=; b=Q4hfvFB5HNizNOA2v7oFGs8gx2hAnuHKDmCpK2Q28RbhHNmJ22qDZJgJWlgcgOXEfl y3PDemXU81cEGcpnziDC5z16km/r0BNXq0KfywiCYVuaKPn2FQIjr8He2y/+Ex2lXTJ/ Z/9x2GXf5Hjd1MtFLXwLz5xUtrgR1a4VHzRBbt72mKabrw5rJ2HxwkhwwV2nkbEGwQ7Y jIQ0aW22+BYrYRgwlB1y5LCRzSxjQ7u32jvT/h0H2u3T2jaXOeO0QCClm5UYUsvlTUsq JqDNvJBuf8bM5aeTa8G55h5p9m2Tn+o7AXxY8ywalmQ0bYtLH8+BzB/Z6v/b6HpSi+ZB 8Ylw== X-Gm-Message-State: AKGB3mI3VqDNVU/HkmYIl4zkODifk9eVoIHYy56QOTJeTQOTaDM00TRr x9O67yAKXEjDcGLqsHFVlZnxFiEv X-Google-Smtp-Source: ACJfBosl9F+a3NSy9zq+uAZEj5T7jZub3Afv5zCiRnXij9q4KJRSAlyntn/+38ovZUpdLYF2XLfNow== X-Received: by 10.99.107.197 with SMTP id g188mr8701983pgc.295.1513263208628; Thu, 14 Dec 2017 06:53:28 -0800 (PST) Received: from squirtle.lan (c-24-22-235-96.hsd1.wa.comcast.net. [24.22.235.96]) by smtp.gmail.com with ESMTPSA id e7sm8757439pfj.44.2017.12.14.06.53.27 (version=TLS1_2 cipher=ECDHE-RSA-CHACHA20-POLY1305 bits=256/256); Thu, 14 Dec 2017 06:53:28 -0800 (PST) From: Andrey Smirnov To: qemu-arm@nongnu.org Date: Thu, 14 Dec 2017 06:52:47 -0800 Message-Id: <20171214145255.31545-8-andrew.smirnov@gmail.com> X-Mailer: git-send-email 2.14.3 In-Reply-To: <20171214145255.31545-1-andrew.smirnov@gmail.com> References: <20171214145255.31545-1-andrew.smirnov@gmail.com> MIME-Version: 1.0 X-detected-operating-system: by eggs.gnu.org: Genre and OS details not recognized. X-Received-From: 2607:f8b0:400e:c05::244 Subject: [Qemu-devel] [PATCH v2 07/15] imx_fec: Emulate SHIFT16 in ENETx_RACC X-BeenThere: qemu-devel@nongnu.org X-Mailman-Version: 2.1.21 Precedence: list List-Id: List-Unsubscribe: , List-Archive: List-Post: List-Help: List-Subscribe: , Cc: Peter Maydell , Andrey Smirnov , Jason Wang , =?UTF-8?q?Philippe=20Mathieu-Daud=C3=A9?= , qemu-devel@nongnu.org, yurovsky@gmail.com Errors-To: qemu-devel-bounces+patchwork-qemu-devel=patchwork.kernel.org@nongnu.org Sender: "Qemu-devel" X-Virus-Scanned: ClamAV using ClamSMTP Needed to support latest Linux kernel driver which relies on that functionality. Cc: Peter Maydell Cc: Jason Wang Cc: Philippe Mathieu-Daudé Cc: qemu-devel@nongnu.org Cc: qemu-arm@nongnu.org Cc: yurovsky@gmail.com Reviewed-by: Peter Maydell Signed-off-by: Andrey Smirnov --- hw/net/imx_fec.c | 23 +++++++++++++++++++++++ include/hw/net/imx_fec.h | 2 ++ 2 files changed, 25 insertions(+) diff --git a/hw/net/imx_fec.c b/hw/net/imx_fec.c index 6feda18742..825c879a28 100644 --- a/hw/net/imx_fec.c +++ b/hw/net/imx_fec.c @@ -1037,6 +1037,7 @@ static ssize_t imx_enet_receive(NetClientState *nc, const uint8_t *buf, uint8_t *crc_ptr; unsigned int buf_len; size_t size = len; + bool shift16 = s->regs[ENET_RACC] & ENET_RACC_SHIFT16; FEC_PRINTF("len %d\n", (int)size); @@ -1051,6 +1052,10 @@ static ssize_t imx_enet_receive(NetClientState *nc, const uint8_t *buf, crc = cpu_to_be32(crc32(~0, buf, size)); crc_ptr = (uint8_t *) &crc; + if (shift16) { + size += 2; + } + /* Huge frames are truncted. */ if (size > s->regs[ENET_FTRL]) { size = s->regs[ENET_FTRL]; @@ -1087,6 +1092,24 @@ static ssize_t imx_enet_receive(NetClientState *nc, const uint8_t *buf, buf_len += size - 4; } buf_addr = bd.data; + + if (shift16) { + /* + * If SHIFT16 bit of ENETx_RACC register is set we need to + * align the payload to 4-byte boundary. + */ + const uint8_t zeros[2] = { 0 }; + + dma_memory_write(&address_space_memory, buf_addr, + zeros, sizeof(zeros)); + + buf_addr += sizeof(zeros); + buf_len -= sizeof(zeros); + + /* We only do this once per Ethernet frame */ + shift16 = false; + } + dma_memory_write(&address_space_memory, buf_addr, buf, buf_len); buf += buf_len; if (size < 4) { diff --git a/include/hw/net/imx_fec.h b/include/hw/net/imx_fec.h index a390d704a6..af0840a0fa 100644 --- a/include/hw/net/imx_fec.h +++ b/include/hw/net/imx_fec.h @@ -170,6 +170,8 @@ #define ENET_TWFR_TFWR_LENGTH (6) #define ENET_TWFR_STRFWD (1 << 8) +#define ENET_RACC_SHIFT16 BIT(7) + /* Buffer Descriptor. */ typedef struct { uint16_t length;