1*91f16700Schasinglulu // SPDX-License-Identifier: BSD-3-Clause 2*91f16700Schasinglulu /* 3*91f16700Schasinglulu * Copyright (c) 2015-2022, Arm Limited and Contributors. All rights reserved. 4*91f16700Schasinglulu * Copyright (c) 2019-2020, Linaro Limited 5*91f16700Schasinglulu */ 6*91f16700Schasinglulu 7*91f16700Schasinglulu #include <assert.h> 8*91f16700Schasinglulu 9*91f16700Schasinglulu #include <drivers/scmi-msg.h> 10*91f16700Schasinglulu #include <drivers/scmi.h> 11*91f16700Schasinglulu 12*91f16700Schasinglulu #include "common.h" 13*91f16700Schasinglulu 14*91f16700Schasinglulu #pragma weak scmi_msg_get_clock_handler 15*91f16700Schasinglulu #pragma weak scmi_msg_get_rstd_handler 16*91f16700Schasinglulu #pragma weak scmi_msg_get_pd_handler 17*91f16700Schasinglulu #pragma weak scmi_msg_get_voltage_handler 18*91f16700Schasinglulu 19*91f16700Schasinglulu scmi_msg_handler_t scmi_msg_get_clock_handler(struct scmi_msg *msg __unused) 20*91f16700Schasinglulu { 21*91f16700Schasinglulu return NULL; 22*91f16700Schasinglulu } 23*91f16700Schasinglulu 24*91f16700Schasinglulu scmi_msg_handler_t scmi_msg_get_rstd_handler(struct scmi_msg *msg __unused) 25*91f16700Schasinglulu { 26*91f16700Schasinglulu return NULL; 27*91f16700Schasinglulu } 28*91f16700Schasinglulu 29*91f16700Schasinglulu scmi_msg_handler_t scmi_msg_get_pd_handler(struct scmi_msg *msg __unused) 30*91f16700Schasinglulu { 31*91f16700Schasinglulu return NULL; 32*91f16700Schasinglulu } 33*91f16700Schasinglulu 34*91f16700Schasinglulu scmi_msg_handler_t scmi_msg_get_voltage_handler(struct scmi_msg *msg __unused) 35*91f16700Schasinglulu { 36*91f16700Schasinglulu return NULL; 37*91f16700Schasinglulu } 38*91f16700Schasinglulu 39*91f16700Schasinglulu void scmi_status_response(struct scmi_msg *msg, int32_t status) 40*91f16700Schasinglulu { 41*91f16700Schasinglulu assert(msg->out && msg->out_size >= sizeof(int32_t)); 42*91f16700Schasinglulu 43*91f16700Schasinglulu memcpy(msg->out, &status, sizeof(int32_t)); 44*91f16700Schasinglulu msg->out_size_out = sizeof(int32_t); 45*91f16700Schasinglulu } 46*91f16700Schasinglulu 47*91f16700Schasinglulu void scmi_write_response(struct scmi_msg *msg, void *payload, size_t size) 48*91f16700Schasinglulu { 49*91f16700Schasinglulu /* 50*91f16700Schasinglulu * Output payload shall be at least the size of the status 51*91f16700Schasinglulu * Output buffer shall be at least be the size of the status 52*91f16700Schasinglulu * Output paylaod shall fit in output buffer 53*91f16700Schasinglulu */ 54*91f16700Schasinglulu assert(payload && size >= sizeof(int32_t) && size <= msg->out_size && 55*91f16700Schasinglulu msg->out && msg->out_size >= sizeof(int32_t)); 56*91f16700Schasinglulu 57*91f16700Schasinglulu memcpy(msg->out, payload, size); 58*91f16700Schasinglulu msg->out_size_out = size; 59*91f16700Schasinglulu } 60*91f16700Schasinglulu 61*91f16700Schasinglulu void scmi_process_message(struct scmi_msg *msg) 62*91f16700Schasinglulu { 63*91f16700Schasinglulu scmi_msg_handler_t handler = NULL; 64*91f16700Schasinglulu 65*91f16700Schasinglulu switch (msg->protocol_id) { 66*91f16700Schasinglulu case SCMI_PROTOCOL_ID_BASE: 67*91f16700Schasinglulu handler = scmi_msg_get_base_handler(msg); 68*91f16700Schasinglulu break; 69*91f16700Schasinglulu case SCMI_PROTOCOL_ID_CLOCK: 70*91f16700Schasinglulu handler = scmi_msg_get_clock_handler(msg); 71*91f16700Schasinglulu break; 72*91f16700Schasinglulu case SCMI_PROTOCOL_ID_RESET_DOMAIN: 73*91f16700Schasinglulu handler = scmi_msg_get_rstd_handler(msg); 74*91f16700Schasinglulu break; 75*91f16700Schasinglulu case SCMI_PROTOCOL_ID_POWER_DOMAIN: 76*91f16700Schasinglulu handler = scmi_msg_get_pd_handler(msg); 77*91f16700Schasinglulu break; 78*91f16700Schasinglulu default: 79*91f16700Schasinglulu break; 80*91f16700Schasinglulu } 81*91f16700Schasinglulu 82*91f16700Schasinglulu if (handler) { 83*91f16700Schasinglulu handler(msg); 84*91f16700Schasinglulu return; 85*91f16700Schasinglulu } 86*91f16700Schasinglulu 87*91f16700Schasinglulu ERROR("Agent %u Protocol 0x%x Message 0x%x: not supported\n", 88*91f16700Schasinglulu msg->agent_id, msg->protocol_id, msg->message_id); 89*91f16700Schasinglulu 90*91f16700Schasinglulu scmi_status_response(msg, SCMI_NOT_SUPPORTED); 91*91f16700Schasinglulu } 92