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 <drivers/scmi-msg.h> 7ae8c8068SEtienne Carriere #include <drivers/scmi.h> 8ae8c8068SEtienne Carriere #include <trace.h> 9ae8c8068SEtienne Carriere 10ae8c8068SEtienne Carriere #include "common.h" 11ae8c8068SEtienne Carriere 12ae8c8068SEtienne Carriere void scmi_status_response(struct scmi_msg *msg, int32_t status) 13ae8c8068SEtienne Carriere { 14ae8c8068SEtienne Carriere assert(msg->out && msg->out_size >= sizeof(int32_t)); 15ae8c8068SEtienne Carriere 16ae8c8068SEtienne Carriere memcpy(msg->out, &status, sizeof(int32_t)); 17ae8c8068SEtienne Carriere msg->out_size_out = sizeof(int32_t); 18ae8c8068SEtienne Carriere } 19ae8c8068SEtienne Carriere 20ae8c8068SEtienne Carriere void scmi_write_response(struct scmi_msg *msg, void *payload, size_t size) 21ae8c8068SEtienne Carriere { 22ae8c8068SEtienne Carriere /* 23ae8c8068SEtienne Carriere * Output payload shall be at least the size of the status 24ae8c8068SEtienne Carriere * Output buffer shall be at least be the size of the status 25ae8c8068SEtienne Carriere * Output paylaod shall fit in output buffer 26ae8c8068SEtienne Carriere */ 27ae8c8068SEtienne Carriere assert(payload && size >= sizeof(int32_t) && size <= msg->out_size && 28ae8c8068SEtienne Carriere msg->out && msg->out_size >= sizeof(int32_t)); 29ae8c8068SEtienne Carriere 30ae8c8068SEtienne Carriere memcpy(msg->out, payload, size); 31ae8c8068SEtienne Carriere msg->out_size_out = size; 32ae8c8068SEtienne Carriere } 33ae8c8068SEtienne Carriere 34ae8c8068SEtienne Carriere void scmi_process_message(struct scmi_msg *msg) 35ae8c8068SEtienne Carriere { 36ae8c8068SEtienne Carriere scmi_msg_handler_t handler = NULL; 37ae8c8068SEtienne Carriere 38ae8c8068SEtienne Carriere switch (msg->protocol_id) { 39ae8c8068SEtienne Carriere case SCMI_PROTOCOL_ID_BASE: 40ae8c8068SEtienne Carriere handler = scmi_msg_get_base_handler(msg); 41ae8c8068SEtienne Carriere break; 42a7a9e3baSEtienne Carriere case SCMI_PROTOCOL_ID_CLOCK: 43a7a9e3baSEtienne Carriere handler = scmi_msg_get_clock_handler(msg); 44a7a9e3baSEtienne Carriere break; 4556a1f10eSEtienne Carriere case SCMI_PROTOCOL_ID_RESET_DOMAIN: 4656a1f10eSEtienne Carriere handler = scmi_msg_get_rd_handler(msg); 4756a1f10eSEtienne Carriere break; 48*006d89b8SEtienne Carriere case SCMI_PROTOCOL_ID_VOLTAGE_DOMAIN: 49*006d89b8SEtienne Carriere handler = scmi_msg_get_voltd_handler(msg); 50*006d89b8SEtienne Carriere break; 51ae8c8068SEtienne Carriere default: 52ae8c8068SEtienne Carriere break; 53ae8c8068SEtienne Carriere } 54ae8c8068SEtienne Carriere 55ae8c8068SEtienne Carriere if (handler) { 56ae8c8068SEtienne Carriere handler(msg); 57ae8c8068SEtienne Carriere return; 58ae8c8068SEtienne Carriere } 59ae8c8068SEtienne Carriere 60ae8c8068SEtienne Carriere DMSG("Agent %u Protocol %#x Message %#x: not supported", 61ae8c8068SEtienne Carriere msg->agent_id, msg->protocol_id, msg->message_id); 62ae8c8068SEtienne Carriere 63ae8c8068SEtienne Carriere scmi_status_response(msg, SCMI_NOT_SUPPORTED); 64ae8c8068SEtienne Carriere } 65