Received-SPF: pass (google.com: domain of linux-kernel-owner@vger.kernel.org designates 23.128.96.18 as permitted sender) client-ip=23.128.96.18;
From:   Ioana Ciornei <ioana.ciornei@nxp.com>
To:     leoyang.li@nxp.com
Cc:     youri.querry_1@nxp.com, linux-kernel@vger.kernel.org,
        Diana Craciun <diana.craciun@nxp.com>,
        Ioana Ciornei <ioana.ciornei@nxp.com>
Subject: [PATCH 4/5] soc: fsl: dpio: fix qbman alignment error in the virtualization context
Date:   Mon, 18 Oct 2021 18:10:33 +0300
Message-Id: <20211018151034.137918-5-ioana.ciornei@nxp.com>
In-Reply-To: <20211018151034.137918-1-ioana.ciornei@nxp.com>
References: <20211018151034.137918-1-ioana.ciornei@nxp.com>
Content-Transfer-Encoding: 8bit
Content-Type: text/plain
MIME-Version: 1.0
X-MS-Exchange-AntiSpam-MessageData-ChunkCount: 1
X-MS-Exchange-AntiSpam-MessageData-0: =?us-ascii?Q?QwoUODWpRj9MmfgxQvpmZv+E174qIj/CB89xZQWlqUcjftAnzFb+oazbJ93A?=
 =?us-ascii?Q?ppgkXw1ipommv3Whree8Z5/sk1sd0jYwgl5yt+Gfnv/eLyUGw3VMvX5sTfBl?=
 =?us-ascii?Q?FSObUMp1Y8lYDhyOq0QtKxmyhSdep2XcTHjDlXgOe4FD10SEb71ULJVqJZpl?=
 =?us-ascii?Q?mpH7CFctTc2aoJsAyH+hF8eMykBKmsVYaQTJKEyXJWT4iZRn20iuiI2mjBQw?=
 =?us-ascii?Q?DP0MUTR/fbbF3az4YhMTARPQesLJEG/0M7JUIAD6IH4lqf3wBaW9ESbZRGhO?=
 =?us-ascii?Q?lxqsBLQjW3OtBzaQrpOCrbX4Sfy1PdX2Ni6fXpXaOYeKTyuScYth8Ly3FFY0?=
 =?us-ascii?Q?I28I4+dpqrK+fdK2l19siPt8KmOZLsknf5GqBjrWsAeRUoPaK31y3gq41+iK?=
 =?us-ascii?Q?kQqn9Le73iqM15YN6hEaatxd8T4LP8huuoN5vBrAR6D42+RnyQx9kohDeqoY?=
 =?us-ascii?Q?19GaYOhSr6u6d+0jWNRRMZbLCRmf0yjqhrbeGnSamh0829MFqFMumm9NAXN9?=
 =?us-ascii?Q?RSahDbItLwhymKUVvXz23qhucC+7RR2sv8+w9bdahbeYW/QZu3ExBuB09ShV?=
 =?us-ascii?Q?xg3RvI+wwOQbqdYN31fvdGVncMEzo7DX/ZLyAMh73Qwj8fVd4bjqcM398tOA?=
 =?us-ascii?Q?aMQH5N90o++Z63iyFjN3dOhMa5lp0gqaIYfUGEo1AaR594RRH5vnLPZP1j8u?=
 =?us-ascii?Q?HsI8DPseopQCWUDV7SXl/+/hPv0fRRXC+Sj0wPkdpQqN/iYyBx5EYSIWyYk4?=
 =?us-ascii?Q?n/z/jXovPfRhdEONeP8ogFlEindZNTI98x/mvn5nSWXtVDS+JcEmi9ynz8Rw?=
 =?us-ascii?Q?bfNnBkKDCNd+E4KlTTmLhjoBiZDerxdUMYGIeGgdPWwVtFQTtdZEgjN9sReq?=
 =?us-ascii?Q?vNFmk75laJiK1/cDOdeVMlEwQOX9TsHylPNusFJ94q/31DB0OkmW5PfUS4Kx?=
 =?us-ascii?Q?Z0e9yclxXbCz5E14ibJYE2Bma9+j5UY3WmgOBh3BXiQYKp1Eae/ozWbnRUS+?=
 =?us-ascii?Q?L21l7iUxPNdC/CFlRJNtXR/o5PuWAPCrc0i/g36ZGBR/LhptLV4A3DnqKy5H?=
 =?us-ascii?Q?E2PS1METoC8DKJW0Iiyt/Sy5Z5RbkZNzFEkF5MLOcxBP6hztINnm0bpjMI/r?=
 =?us-ascii?Q?qLAK2WaU4KNX86WYqmra/Y7l2qiBEv4rDyfdMRMUjXDow8lLIPxdCh62sK53?=
 =?us-ascii?Q?+lc4hUIWZmRaAQ+5jvoeBOSpiv40lxS51oliDqf6AP/mIvoYMPLGC1SkzIBN?=
 =?us-ascii?Q?Kho3W9l4iHEnZz4gcCAHB2mz/o9n0g/IxraxYemHe5mclMZE0P7fJKprh7v6?=
 =?us-ascii?Q?dyf32NeN5siaGkOvJ5vG0OCo?=
X-OriginatorOrg: nxp.com
X-MS-Exchange-CrossTenant-Network-Message-Id: 7efe8953-1761-40b2-1e63-08d992497df7
X-MS-Exchange-CrossTenant-AuthSource: AM4PR0401MB2308.eurprd04.prod.outlook.com
X-MS-Exchange-CrossTenant-AuthAs: Internal
X-MS-Exchange-CrossTenant-OriginalArrivalTime: 18 Oct 2021 15:10:59.7689
 (UTC)
X-MS-Exchange-CrossTenant-FromEntityHeader: Hosted
X-MS-Exchange-CrossTenant-Id: 686ea1d3-bc2b-4c6f-a92c-d99c5c301635
X-MS-Exchange-CrossTenant-MailboxType: HOSTED
X-MS-Exchange-CrossTenant-UserPrincipalName: zvPNIkVxbw0raqgUSRMx6/QY51od7HYHgK+X7+kcarar1QjQvbRcaWvokfJmdqBVPYBT+wfGuNg3lXclANXT1g==
X-MS-Exchange-Transport-CrossTenantHeadersStamped: AM8PR04MB7268
Precedence: bulk
List-ID: <linux-kernel.vger.kernel.org>
X-Mailing-List: linux-kernel@vger.kernel.org

From: Diana Craciun <diana.craciun@nxp.com>

When running as a guest, under KVM, the CENA region is mapped as device
memory, so uncacheable. When the memory is mapped as device memory, the
unaligned accesses are not allowed.  Memcpy is optimized to transfer 8
bytes at a time regardless of the start address and might cause
alignment issues.

Signed-off-by: Diana Craciun <diana.craciun@nxp.com>
Signed-off-by: Ioana Ciornei <ioana.ciornei@nxp.com>
---
 drivers/soc/fsl/dpio/qbman-portal.c | 24 ++++++++++++------------
 1 file changed, 12 insertions(+), 12 deletions(-)

diff --git a/drivers/soc/fsl/dpio/qbman-portal.c b/drivers/soc/fsl/dpio/qbman-portal.c
index 3fd54611ed98..ef9cafd12534 100644
--- a/drivers/soc/fsl/dpio/qbman-portal.c
+++ b/drivers/soc/fsl/dpio/qbman-portal.c
@@ -679,9 +679,9 @@ int qbman_swp_enqueue_multiple_direct(struct qbman_swp *s,
 	for (i = 0; i < num_enqueued; i++) {
 		p = (s->addr_cena + QBMAN_CENA_SWP_EQCR(eqcr_pi & half_mask));
 		/* Skip copying the verb */
-		memcpy(&p[1], &cl[1], EQ_DESC_SIZE_WITHOUT_FD - 1);
-		memcpy(&p[EQ_DESC_SIZE_FD_START/sizeof(uint32_t)],
-		       &fd[i], sizeof(*fd));
+		memcpy_toio((__iomem void *)&p[1], &cl[1], EQ_DESC_SIZE_WITHOUT_FD - 1);
+		memcpy_toio((__iomem void *)&p[EQ_DESC_SIZE_FD_START / sizeof(uint32_t)],
+			    &fd[i], sizeof(*fd));
 		eqcr_pi++;
 	}
 
@@ -763,9 +763,9 @@ int qbman_swp_enqueue_multiple_mem_back(struct qbman_swp *s,
 	for (i = 0; i < num_enqueued; i++) {
 		p = (s->addr_cena + QBMAN_CENA_SWP_EQCR(eqcr_pi & half_mask));
 		/* Skip copying the verb */
-		memcpy(&p[1], &cl[1], EQ_DESC_SIZE_WITHOUT_FD - 1);
-		memcpy(&p[EQ_DESC_SIZE_FD_START/sizeof(uint32_t)],
-		       &fd[i], sizeof(*fd));
+		memcpy_toio((__iomem void *)&p[1], &cl[1], EQ_DESC_SIZE_WITHOUT_FD - 1);
+		memcpy_toio((__iomem void *)&p[EQ_DESC_SIZE_FD_START / sizeof(uint32_t)],
+			    &fd[i], sizeof(*fd));
 		eqcr_pi++;
 	}
 
@@ -837,9 +837,9 @@ int qbman_swp_enqueue_multiple_desc_direct(struct qbman_swp *s,
 		p = (s->addr_cena + QBMAN_CENA_SWP_EQCR(eqcr_pi & half_mask));
 		cl = (uint32_t *)(&d[i]);
 		/* Skip copying the verb */
-		memcpy(&p[1], &cl[1], EQ_DESC_SIZE_WITHOUT_FD - 1);
-		memcpy(&p[EQ_DESC_SIZE_FD_START/sizeof(uint32_t)],
-		       &fd[i], sizeof(*fd));
+		memcpy_toio((__iomem void *)&p[1], &cl[1], EQ_DESC_SIZE_WITHOUT_FD - 1);
+		memcpy_toio((__iomem void *)&p[EQ_DESC_SIZE_FD_START / sizeof(uint32_t)],
+			    &fd[i], sizeof(*fd));
 		eqcr_pi++;
 	}
 
@@ -907,9 +907,9 @@ int qbman_swp_enqueue_multiple_desc_mem_back(struct qbman_swp *s,
 		p = (s->addr_cena + QBMAN_CENA_SWP_EQCR(eqcr_pi & half_mask));
 		cl = (uint32_t *)(&d[i]);
 		/* Skip copying the verb */
-		memcpy(&p[1], &cl[1], EQ_DESC_SIZE_WITHOUT_FD - 1);
-		memcpy(&p[EQ_DESC_SIZE_FD_START/sizeof(uint32_t)],
-		       &fd[i], sizeof(*fd));
+		memcpy_toio((__iomem void *)&p[1], &cl[1], EQ_DESC_SIZE_WITHOUT_FD - 1);
+		memcpy_toio((__iomem void *)&p[EQ_DESC_SIZE_FD_START / sizeof(uint32_t)],
+			    &fd[i], sizeof(*fd));
 		eqcr_pi++;
 	}
 
-- 
2.33.1