132 				   void *handle,  in trusty_fiq_handler()  argument
142 		SMC_RET0(handle);  in trusty_fiq_handler()
147 		SMC_RET0(handle);  in trusty_fiq_handler()
151 	memcpy(&ctx->fiq_gpregs, get_gpregs_ctx(handle), sizeof(ctx->fiq_gpregs));  in trusty_fiq_handler()
152 	ctx->fiq_pc = SMC_GET_EL3(handle, CTX_ELR_EL3);  in trusty_fiq_handler()
153 	ctx->fiq_cpsr = SMC_GET_EL3(handle, CTX_SPSR_EL3);  in trusty_fiq_handler()
154 	ctx->fiq_sp_el1 = read_ctx_reg(get_sysregs_ctx(handle), CTX_SP_EL1);  in trusty_fiq_handler()
156 	write_ctx_reg(get_sysregs_ctx(handle), CTX_SP_EL1, ctx->fiq_handler_sp);  in trusty_fiq_handler()
159 	SMC_RET0(handle);  in trusty_fiq_handler()
162 static uint64_t trusty_set_fiq_handler(void *handle, uint64_t cpu,  in trusty_set_fiq_handler()  argument
174 	ctx->fiq_handler_cpsr = SMC_GET_EL3(handle, CTX_SPSR_EL3);  in trusty_set_fiq_handler()
177 	SMC_RET1(handle, 0);  in trusty_set_fiq_handler()
180 static uint64_t trusty_get_fiq_regs(void *handle)  in trusty_get_fiq_regs()  argument
185 	SMC_RET4(handle, ctx->fiq_pc, ctx->fiq_cpsr, sp_el0, ctx->fiq_sp_el1);  in trusty_get_fiq_regs()
188 static uint64_t trusty_fiq_exit(void *handle, uint64_t x1, uint64_t x2, uint64_t x3)  in trusty_fiq_exit()  argument
195 		SMC_RET1(handle, SM_ERR_INVALID_PARAMETERS);  in trusty_fiq_exit()
201 		       __func__, handle, ret.r0);  in trusty_fiq_exit()
213 	memcpy(get_gpregs_ctx(handle), &ctx->fiq_gpregs, sizeof(ctx->fiq_gpregs));  in trusty_fiq_exit()
215 	write_ctx_reg(get_sysregs_ctx(handle), CTX_SP_EL1, ctx->fiq_sp_el1);  in trusty_fiq_exit()
218 	SMC_RET0(handle);  in trusty_fiq_exit()
227 			 void *handle,  in trusty_smc_handler()  argument
240 		SMC_RET1(handle, 0);  in trusty_smc_handler()
242 		SMC_RET1(handle, SMC_UNK);  in trusty_smc_handler()
248 			SMC_RET8(handle, ret.r0, ret.r1, ret.r2, ret.r3,  in trusty_smc_handler()
253 		     __func__, smc_fid, x1, x2, x3, x4, cookie, handle, flags,  in trusty_smc_handler()
255 		SMC_RET1(handle, SMC_UNK);  in trusty_smc_handler()
259 			return trusty_set_fiq_handler(handle, x1, x2, x3);  in trusty_smc_handler()
261 			return trusty_get_fiq_regs(handle);  in trusty_smc_handler()
263 			return trusty_fiq_exit(handle, x1, x2, x3);  in trusty_smc_handler()
266 				vmid = SMC_GET_GP(handle, CTX_GPREG_X7);  in trusty_smc_handler()
274 				SMC_RET1(handle, SM_ERR_BUSY);  in trusty_smc_handler()
280 			SMC_RET1(handle, ret.r0);  in trusty_smc_handler()