Patrick Williams | 2194f50 | 2022-10-16 14:26:09 -0500 | [diff] [blame] | 1 | From 47cd54d908380de17d84a852625ef3a1ff92f496 Mon Sep 17 00:00:00 2001 |
Brad Bishop | bec4ebc | 2022-08-03 09:55:16 -0400 | [diff] [blame] | 2 | From: Arunachalam Ganapathy <arunachalam.ganapathy@arm.com> |
| 3 | Date: Fri, 14 Jan 2022 12:23:04 +0000 |
Patrick Williams | 2194f50 | 2022-10-16 14:26:09 -0500 | [diff] [blame] | 4 | Subject: [PATCH 06/40] firmware: arm_ffa: Fix FFA_MEM_SHARE and |
Brad Bishop | bec4ebc | 2022-08-03 09:55:16 -0400 | [diff] [blame] | 5 | FFA_MEM_FRAG_TX |
| 6 | |
| 7 | FFA memory share on success might return FFA_MEM_FRAG_RX. In that case |
| 8 | set handle from w1/w2 from FFA return value. |
| 9 | |
| 10 | FFA_MEM_FRAG_TX call will return FFA_SUCCESS for the last fragment, so |
| 11 | check for this return code. |
| 12 | |
| 13 | Signed-off-by: Arunachalam Ganapathy <arunachalam.ganapathy@arm.com> |
| 14 | Change-Id: I7ef44742d53a9e75d8587d1213be98a1352f16d4 |
Andrew Geissler | 2daf84b | 2023-03-31 09:57:23 -0500 | [diff] [blame^] | 15 | Upstream-Status: Backport [987756f67dee237ec35f3b249ab1ae25260c5340] |
Patrick Williams | 2194f50 | 2022-10-16 14:26:09 -0500 | [diff] [blame] | 16 | Signed-off-by: Rupinderjit Singh <rupinderjit.singh@arm.com> |
Brad Bishop | bec4ebc | 2022-08-03 09:55:16 -0400 | [diff] [blame] | 17 | --- |
| 18 | drivers/firmware/arm_ffa/driver.c | 12 ++++++++---- |
| 19 | 1 file changed, 8 insertions(+), 4 deletions(-) |
| 20 | |
| 21 | diff --git a/drivers/firmware/arm_ffa/driver.c b/drivers/firmware/arm_ffa/driver.c |
Patrick Williams | 2194f50 | 2022-10-16 14:26:09 -0500 | [diff] [blame] | 22 | index d3d53fbd3d29..de6641912768 100644 |
Brad Bishop | bec4ebc | 2022-08-03 09:55:16 -0400 | [diff] [blame] | 23 | --- a/drivers/firmware/arm_ffa/driver.c |
| 24 | +++ b/drivers/firmware/arm_ffa/driver.c |
Patrick Williams | 2194f50 | 2022-10-16 14:26:09 -0500 | [diff] [blame] | 25 | @@ -317,11 +317,15 @@ static int ffa_mem_first_frag(u32 func_id, phys_addr_t buf, u32 buf_sz, |
Brad Bishop | bec4ebc | 2022-08-03 09:55:16 -0400 | [diff] [blame] | 26 | if (ret.a0 == FFA_ERROR) |
| 27 | return ffa_to_linux_errno((int)ret.a2); |
| 28 | |
| 29 | - if (ret.a0 != FFA_SUCCESS) |
| 30 | + if (ret.a0 != FFA_SUCCESS && ret.a0 != FFA_MEM_FRAG_RX) |
| 31 | return -EOPNOTSUPP; |
| 32 | |
| 33 | - if (handle) |
| 34 | - *handle = PACK_HANDLE(ret.a2, ret.a3); |
| 35 | + if (handle) { |
| 36 | + if (ret.a0 == FFA_MEM_FRAG_RX) |
| 37 | + *handle = PACK_HANDLE(ret.a1, ret.a2); |
| 38 | + else |
| 39 | + *handle = PACK_HANDLE(ret.a2, ret.a3); |
| 40 | + } |
| 41 | |
| 42 | return frag_len; |
| 43 | } |
Patrick Williams | 2194f50 | 2022-10-16 14:26:09 -0500 | [diff] [blame] | 44 | @@ -345,7 +349,7 @@ static int ffa_mem_next_frag(u64 handle, u32 frag_len) |
Brad Bishop | bec4ebc | 2022-08-03 09:55:16 -0400 | [diff] [blame] | 45 | if (ret.a0 == FFA_ERROR) |
| 46 | return ffa_to_linux_errno((int)ret.a2); |
| 47 | |
| 48 | - if (ret.a0 != FFA_MEM_FRAG_RX) |
| 49 | + if (ret.a0 != FFA_SUCCESS && ret.a0 != FFA_MEM_FRAG_RX) |
| 50 | return -EOPNOTSUPP; |
| 51 | |
| 52 | return ret.a3; |
| 53 | -- |
Patrick Williams | 2194f50 | 2022-10-16 14:26:09 -0500 | [diff] [blame] | 54 | 2.34.1 |
Brad Bishop | bec4ebc | 2022-08-03 09:55:16 -0400 | [diff] [blame] | 55 | |