On 7/20/26 10:51, Jorge Ramirez-Ortiz wrote:
The UFS controller requires DMA buffers aligned to ARCH_DMA_MINALIGN,
but the RPMB supplicant may hand the transport an unaligned frame (for
example the status-result frame built on the stack). DMAing from an
unaligned address corrupts the frame and OP-TEE reports the RPMB device
as failed.
Same as previous, I don't see why it's not part of patch 2, and the change is
fine.
Thanks,
Neil
Signed-off-by: Jorge Ramirez-Ortiz <[email protected]>
---
drivers/ufs/ufs-rpmb.c | 22 +++++++++++++++++++++-
1 file changed, 21 insertions(+), 1 deletion(-)
diff --git a/drivers/ufs/ufs-rpmb.c b/drivers/ufs/ufs-rpmb.c
index 1434161682b..6a02803edd9 100644
--- a/drivers/ufs/ufs-rpmb.c
+++ b/drivers/ufs/ufs-rpmb.c
@@ -2,10 +2,12 @@
#include <dm.h>
#include <hexdump.h>
#include <log.h>
+#include <malloc.h>
#include <scsi.h>
#include <ufs.h>
#include <vsprintf.h>
#include <u-boot/blake2.h>
+#include <asm/cache.h>
#include <asm/unaligned.h>
#include <linux/errno.h>
#include <linux/string.h>
@@ -36,9 +38,21 @@ static int ufs_rpmb_secprot(struct udevice *scsi_dev,
unsigned int region,
struct scsi_cmd pccb;
u32 len = nframes * RPMB_FRAME_SIZE;
u16 spsp = (region << 8) | UFS_RPMB_SEC_PROTOCOL_ID;
+ void *dma_buf = buf;
+ void *bounce = NULL;
int retries;
int ret = 0;
+ if (!IS_ALIGNED((uintptr_t)buf, ARCH_DMA_MINALIGN)) {
+ bounce = memalign(ARCH_DMA_MINALIGN,
+ ALIGN(len, ARCH_DMA_MINALIGN));
+ if (!bounce)
+ return -ENOMEM;
+ dma_buf = bounce;
+ if (dir == DMA_TO_DEVICE)
+ memcpy(bounce, buf, len);
+ }
+
memset(&pccb, 0, sizeof(pccb));
pccb.lun = UFS_UPIU_RPMB_WLUN;
pccb.cmd[0] = opcode;
@@ -54,7 +68,7 @@ static int ufs_rpmb_secprot(struct udevice *scsi_dev,
unsigned int region,
pccb.cmd[10] = 0;
pccb.cmd[11] = 0;
pccb.cmdlen = 12;
- pccb.pdata = buf;
+ pccb.pdata = dma_buf;
pccb.datalen = len;
pccb.dma_dir = dir;
@@ -64,6 +78,12 @@ static int ufs_rpmb_secprot(struct udevice *scsi_dev, unsigned int region,
break;
}
+ if (bounce) {
+ if (!ret && dir == DMA_FROM_DEVICE)
+ memcpy(buf, bounce, len);
+ free(bounce);
+ }
+
return ret;
}