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 1060c96f68SEtienne Carriere #include "base.h" 1160c96f68SEtienne Carriere #include "clock.h" 12ae8c8068SEtienne Carriere #include "common.h" 1360c96f68SEtienne Carriere #include "reset_domain.h" 1460c96f68SEtienne Carriere #include "voltage_domain.h" 15ae8c8068SEtienne Carriere 16ae8c8068SEtienne Carriere void scmi_status_response(struct scmi_msg *msg, int32_t status) 17ae8c8068SEtienne Carriere { 18ae8c8068SEtienne Carriere assert(msg->out && msg->out_size >= sizeof(int32_t)); 19ae8c8068SEtienne Carriere 20ae8c8068SEtienne Carriere memcpy(msg->out, &status, sizeof(int32_t)); 21ae8c8068SEtienne Carriere msg->out_size_out = sizeof(int32_t); 22ae8c8068SEtienne Carriere } 23ae8c8068SEtienne Carriere 24ae8c8068SEtienne Carriere void scmi_write_response(struct scmi_msg *msg, void *payload, size_t size) 25ae8c8068SEtienne Carriere { 26ae8c8068SEtienne Carriere /* 27ae8c8068SEtienne Carriere * Output payload shall be at least the size of the status 28ae8c8068SEtienne Carriere * Output buffer shall be at least be the size of the status 29ae8c8068SEtienne Carriere * Output paylaod shall fit in output buffer 30ae8c8068SEtienne Carriere */ 31ae8c8068SEtienne Carriere assert(payload && size >= sizeof(int32_t) && size <= msg->out_size && 32ae8c8068SEtienne Carriere msg->out && msg->out_size >= sizeof(int32_t)); 33ae8c8068SEtienne Carriere 34ae8c8068SEtienne Carriere memcpy(msg->out, payload, size); 35ae8c8068SEtienne Carriere msg->out_size_out = size; 36ae8c8068SEtienne Carriere } 37ae8c8068SEtienne Carriere 38ae8c8068SEtienne Carriere void scmi_process_message(struct scmi_msg *msg) 39ae8c8068SEtienne Carriere { 40ae8c8068SEtienne Carriere scmi_msg_handler_t handler = NULL; 41ae8c8068SEtienne Carriere 42ae8c8068SEtienne Carriere switch (msg->protocol_id) { 43ae8c8068SEtienne Carriere case SCMI_PROTOCOL_ID_BASE: 44ae8c8068SEtienne Carriere handler = scmi_msg_get_base_handler(msg); 45ae8c8068SEtienne Carriere break; 46a7a9e3baSEtienne Carriere case SCMI_PROTOCOL_ID_CLOCK: 47a7a9e3baSEtienne Carriere handler = scmi_msg_get_clock_handler(msg); 48a7a9e3baSEtienne Carriere break; 4956a1f10eSEtienne Carriere case SCMI_PROTOCOL_ID_RESET_DOMAIN: 5056a1f10eSEtienne Carriere handler = scmi_msg_get_rd_handler(msg); 5156a1f10eSEtienne Carriere break; 52006d89b8SEtienne Carriere case SCMI_PROTOCOL_ID_VOLTAGE_DOMAIN: 53006d89b8SEtienne Carriere handler = scmi_msg_get_voltd_handler(msg); 54006d89b8SEtienne Carriere break; 55ae8c8068SEtienne Carriere default: 56ae8c8068SEtienne Carriere break; 57ae8c8068SEtienne Carriere } 58ae8c8068SEtienne Carriere 59ae8c8068SEtienne Carriere if (handler) { 60ae8c8068SEtienne Carriere handler(msg); 61ae8c8068SEtienne Carriere return; 62ae8c8068SEtienne Carriere } 63ae8c8068SEtienne Carriere 64*659a1f88SEtienne Carriere DMSG("Channel %u Protocol %#x Message %#x: not supported", 65*659a1f88SEtienne Carriere msg->channel_id, msg->protocol_id, msg->message_id); 66ae8c8068SEtienne Carriere 67ae8c8068SEtienne Carriere scmi_status_response(msg, SCMI_NOT_SUPPORTED); 68ae8c8068SEtienne Carriere } 69