[Date Prev][Date Next][Thread Prev][Thread Next][Date Index][Thread Index] Re: [PATCH v2 08/10] xen/arm: ffa: move message function into ffa_msg.c
Hi Bertrand, On Wed, Oct 16, 2024 at 10:32 AM Bertrand Marquis <bertrand.marquis@xxxxxxx> wrote: > > Move the direct message handling function in its own source file and > rename it to have a ffa_ prefix. > This is a preparation to add support for indirect messages which will > go into this newly created source file. > > Signed-off-by: Bertrand Marquis <bertrand.marquis@xxxxxxx> > --- > Changes in v2: > - rebase > --- > xen/arch/arm/tee/Makefile | 1 + > xen/arch/arm/tee/ffa.c | 69 +---------------------------- > xen/arch/arm/tee/ffa_msg.c | 80 ++++++++++++++++++++++++++++++++++ > xen/arch/arm/tee/ffa_private.h | 2 + > 4 files changed, 84 insertions(+), 68 deletions(-) > create mode 100644 xen/arch/arm/tee/ffa_msg.c Looks good. Reviewed-by: Jens Wiklander <jens.wiklander@xxxxxxxxxx> Cheers, Jens > > diff --git a/xen/arch/arm/tee/Makefile b/xen/arch/arm/tee/Makefile > index 7c0f46f7f446..0848c833fec3 100644 > --- a/xen/arch/arm/tee/Makefile > +++ b/xen/arch/arm/tee/Makefile > @@ -3,5 +3,6 @@ obj-$(CONFIG_FFA) += ffa_shm.o > obj-$(CONFIG_FFA) += ffa_partinfo.o > obj-$(CONFIG_FFA) += ffa_rxtx.o > obj-$(CONFIG_FFA) += ffa_notif.o > +obj-$(CONFIG_FFA) += ffa_msg.o > obj-y += tee.o > obj-$(CONFIG_OPTEE) += optee.o > diff --git a/xen/arch/arm/tee/ffa.c b/xen/arch/arm/tee/ffa.c > index 40ea5398fa21..72826b49d2aa 100644 > --- a/xen/arch/arm/tee/ffa.c > +++ b/xen/arch/arm/tee/ffa.c > @@ -167,73 +167,6 @@ static void handle_version(struct cpu_user_regs *regs) > ffa_set_regs(regs, FFA_MY_VERSION, 0, 0, 0, 0, 0, 0, 0); > } > > -static void handle_msg_send_direct_req(struct cpu_user_regs *regs, uint32_t > fid) > -{ > - struct arm_smccc_1_2_regs arg = { .a0 = fid, }; > - struct arm_smccc_1_2_regs resp = { }; > - struct domain *d = current->domain; > - uint32_t src_dst; > - uint64_t mask; > - > - if ( smccc_is_conv_64(fid) ) > - mask = GENMASK_ULL(63, 0); > - else > - mask = GENMASK_ULL(31, 0); > - > - if ( !ffa_fw_supports_fid(fid) ) > - { > - resp.a0 = FFA_ERROR; > - resp.a2 = FFA_RET_NOT_SUPPORTED; > - goto out; > - } > - > - src_dst = get_user_reg(regs, 1); > - if ( (src_dst >> 16) != ffa_get_vm_id(d) ) > - { > - resp.a0 = FFA_ERROR; > - resp.a2 = FFA_RET_INVALID_PARAMETERS; > - goto out; > - } > - > - /* we do not support direct messages to VMs */ > - if ( !FFA_ID_IS_SECURE(src_dst & GENMASK(15,0)) ) > - { > - resp.a0 = FFA_ERROR; > - resp.a2 = FFA_RET_NOT_SUPPORTED; > - goto out; > - } > - > - arg.a1 = src_dst; > - arg.a2 = get_user_reg(regs, 2) & mask; > - arg.a3 = get_user_reg(regs, 3) & mask; > - arg.a4 = get_user_reg(regs, 4) & mask; > - arg.a5 = get_user_reg(regs, 5) & mask; > - arg.a6 = get_user_reg(regs, 6) & mask; > - arg.a7 = get_user_reg(regs, 7) & mask; > - > - arm_smccc_1_2_smc(&arg, &resp); > - switch ( resp.a0 ) > - { > - case FFA_ERROR: > - case FFA_SUCCESS_32: > - case FFA_SUCCESS_64: > - case FFA_MSG_SEND_DIRECT_RESP_32: > - case FFA_MSG_SEND_DIRECT_RESP_64: > - break; > - default: > - /* Bad fid, report back to the caller. */ > - memset(&resp, 0, sizeof(resp)); > - resp.a0 = FFA_ERROR; > - resp.a1 = src_dst; > - resp.a2 = FFA_RET_ABORTED; > - } > - > -out: > - ffa_set_regs(regs, resp.a0, resp.a1 & mask, resp.a2 & mask, resp.a3 & > mask, > - resp.a4 & mask, resp.a5 & mask, resp.a6 & mask, > - resp.a7 & mask); > -} > - > static void handle_features(struct cpu_user_regs *regs) > { > struct domain *d = current->domain; > @@ -351,7 +284,7 @@ static bool ffa_handle_call(struct cpu_user_regs *regs) > break; > case FFA_MSG_SEND_DIRECT_REQ_32: > case FFA_MSG_SEND_DIRECT_REQ_64: > - handle_msg_send_direct_req(regs, fid); > + ffa_handle_msg_send_direct_req(regs, fid); > return true; > case FFA_MEM_SHARE_32: > case FFA_MEM_SHARE_64: > diff --git a/xen/arch/arm/tee/ffa_msg.c b/xen/arch/arm/tee/ffa_msg.c > new file mode 100644 > index 000000000000..ae263e54890e > --- /dev/null > +++ b/xen/arch/arm/tee/ffa_msg.c > @@ -0,0 +1,80 @@ > +/* SPDX-License-Identifier: GPL-2.0-only */ > +/* > + * Copyright (C) 2024 Linaro Limited > + */ > + > +#include <xen/const.h> > +#include <xen/sizes.h> > +#include <xen/types.h> > + > +#include <asm/smccc.h> > +#include <asm/regs.h> > + > +#include "ffa_private.h" > + > +void ffa_handle_msg_send_direct_req(struct cpu_user_regs *regs, uint32_t fid) > +{ > + struct arm_smccc_1_2_regs arg = { .a0 = fid, }; > + struct arm_smccc_1_2_regs resp = { }; > + struct domain *d = current->domain; > + uint32_t src_dst; > + uint64_t mask; > + > + if ( smccc_is_conv_64(fid) ) > + mask = GENMASK_ULL(63, 0); > + else > + mask = GENMASK_ULL(31, 0); > + > + if ( !ffa_fw_supports_fid(fid) ) > + { > + resp.a0 = FFA_ERROR; > + resp.a2 = FFA_RET_NOT_SUPPORTED; > + goto out; > + } > + > + src_dst = get_user_reg(regs, 1); > + if ( (src_dst >> 16) != ffa_get_vm_id(d) ) > + { > + resp.a0 = FFA_ERROR; > + resp.a2 = FFA_RET_INVALID_PARAMETERS; > + goto out; > + } > + > + /* we do not support direct messages to VMs */ > + if ( !FFA_ID_IS_SECURE(src_dst & GENMASK(15,0)) ) > + { > + resp.a0 = FFA_ERROR; > + resp.a2 = FFA_RET_NOT_SUPPORTED; > + goto out; > + } > + > + arg.a1 = src_dst; > + arg.a2 = get_user_reg(regs, 2) & mask; > + arg.a3 = get_user_reg(regs, 3) & mask; > + arg.a4 = get_user_reg(regs, 4) & mask; > + arg.a5 = get_user_reg(regs, 5) & mask; > + arg.a6 = get_user_reg(regs, 6) & mask; > + arg.a7 = get_user_reg(regs, 7) & mask; > + > + arm_smccc_1_2_smc(&arg, &resp); > + switch ( resp.a0 ) > + { > + case FFA_ERROR: > + case FFA_SUCCESS_32: > + case FFA_SUCCESS_64: > + case FFA_MSG_SEND_DIRECT_RESP_32: > + case FFA_MSG_SEND_DIRECT_RESP_64: > + break; > + default: > + /* Bad fid, report back to the caller. */ > + memset(&resp, 0, sizeof(resp)); > + resp.a0 = FFA_ERROR; > + resp.a1 = src_dst; > + resp.a2 = FFA_RET_ABORTED; > + } > + > +out: > + ffa_set_regs(regs, resp.a0, resp.a1 & mask, resp.a2 & mask, resp.a3 & > mask, > + resp.a4 & mask, resp.a5 & mask, resp.a6 & mask, > + resp.a7 & mask); > +} > diff --git a/xen/arch/arm/tee/ffa_private.h b/xen/arch/arm/tee/ffa_private.h > index 9adfe687c3c9..02162e0ee4c7 100644 > --- a/xen/arch/arm/tee/ffa_private.h > +++ b/xen/arch/arm/tee/ffa_private.h > @@ -360,6 +360,8 @@ void ffa_handle_notification_info_get(struct > cpu_user_regs *regs); > void ffa_handle_notification_get(struct cpu_user_regs *regs); > int ffa_handle_notification_set(struct cpu_user_regs *regs); > > +void ffa_handle_msg_send_direct_req(struct cpu_user_regs *regs, uint32_t > fid); > + > static inline uint16_t ffa_get_vm_id(const struct domain *d) > { > /* +1 since 0 is reserved for the hypervisor in FF-A */ > -- > 2.47.0 >
|
Lists.xenproject.org is hosted with RackSpace, monitoring our |