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