1 // SPDX-License-Identifier: BSD-3-Clause 2 /* 3 * Copyright (c) 2015-2019, Arm Limited and Contributors. All rights reserved. 4 * Copyright (c) 2019, Linaro Limited 5 */ 6 #include <speculation_barrier.h> 7 #include <drivers/scmi-msg.h> 8 #include <drivers/scmi.h> 9 #include <trace.h> 10 11 #include "base.h" 12 #include "clock.h" 13 #include "common.h" 14 #include "reset_domain.h" 15 16 void scmi_status_response(struct scmi_msg *msg, int32_t status) 17 { 18 assert(msg->out && msg->out_size >= sizeof(int32_t)); 19 20 memcpy(msg->out, &status, sizeof(int32_t)); 21 msg->out_size_out = sizeof(int32_t); 22 } 23 24 void scmi_write_response(struct scmi_msg *msg, void *payload, size_t size) 25 { 26 /* 27 * Output payload shall be at least the size of the status 28 * Output buffer shall be at least be the size of the status 29 * Output paylaod shall fit in output buffer 30 */ 31 assert(payload && size >= sizeof(int32_t) && size <= msg->out_size && 32 msg->out && msg->out_size >= sizeof(int32_t)); 33 34 memcpy(msg->out, payload, size); 35 msg->out_size_out = size; 36 } 37 38 void scmi_process_message(struct scmi_msg *msg) 39 { 40 scmi_msg_handler_t handler = NULL; 41 42 switch (msg->protocol_id) { 43 case SCMI_PROTOCOL_ID_BASE: 44 handler = scmi_msg_get_base_handler(msg); 45 break; 46 #ifdef CFG_SCMI_MSG_CLOCK 47 case SCMI_PROTOCOL_ID_CLOCK: 48 handler = scmi_msg_get_clock_handler(msg); 49 break; 50 #endif 51 #ifdef CFG_SCMI_MSG_RESET_DOMAIN 52 case SCMI_PROTOCOL_ID_RESET_DOMAIN: 53 handler = scmi_msg_get_rd_handler(msg); 54 break; 55 #endif 56 default: 57 break; 58 } 59 60 if (handler) { 61 handler(msg); 62 return; 63 } 64 65 DMSG("Agent %u Protocol %#x Message %#x: not supported", 66 msg->agent_id, msg->protocol_id, msg->message_id); 67 68 scmi_status_response(msg, SCMI_NOT_SUPPORTED); 69 } 70