From: T Karthik Reddy <t.karthik.reddy@xilinx.com>
Date: Thu, 19 Nov 2020 12:00:36 +0000 (-0700)
Subject: spi: zynqmp_gqspi: Fix unaligned data writes issue
X-Git-Url: http://git.dujemihanovic.xyz/?a=commitdiff_plain;h=90217487a13f73001654e41e152303644736617b;p=u-boot.git

spi: zynqmp_gqspi: Fix unaligned data writes issue

When unaligned 3 bytes data write operation is performed, 3rd byte
is being over written by 1st byte of 3 bytes data. This patch
fixes it.

Signed-off-by: T Karthik Reddy <t.karthik.reddy@xilinx.com>
Signed-off-by: Michal Simek <michal.simek@xilinx.com>
---

diff --git a/drivers/spi/zynqmp_gqspi.c b/drivers/spi/zynqmp_gqspi.c
index e0e6687037..a56e8b2509 100644
--- a/drivers/spi/zynqmp_gqspi.c
+++ b/drivers/spi/zynqmp_gqspi.c
@@ -429,10 +429,8 @@ static int zynqmp_qspi_fill_tx_fifo(struct zynqmp_qspi_priv *priv, u32 size)
 				data |= GENMASK(31, 16);
 				break;
 			case 3:
-				data = *((u16 *)buf);
-				buf += 2;
-				data |= (*((u8 *)buf) << 16);
-				buf += 1;
+				data = *buf;
+				buf += 3;
 				data |= GENMASK(31, 24);
 				break;
 			}