firmware/scmi/sandbox-scmi_agent.c

167  * @msg:	SCMI message
172 					      struct scmi_msg *msg)
176 	if (!msg->out_msg || msg->out_msg_sz < sizeof(*out))
179 	out = (struct scmi_protocol_version_out *)msg->out_msg;
189  * @msg:	SCMI message
194 					    struct scmi_msg *msg)
198 	if (!msg->out_msg || msg->out_msg_sz < sizeof(*out))
201 	out = (struct scmi_protocol_attrs_out *)msg->out_msg;
212  * @msg:	SCMI message
217 					   struct scmi_msg *msg)
222 	if (!msg->in_msg || msg->in_msg_sz < sizeof(message_id) ||
223 	    !msg->out_msg || msg->out_msg_sz < sizeof(*out))
226 	message_id = *(u32 *)msg->in_msg;
227 	out = (struct scmi_protocol_msg_attrs_out *)msg->out_msg;
244  * @msg:	SCMI message
249 					     struct scmi_msg *msg)
253 	if (!msg->out_msg || msg->out_msg_sz < sizeof(*out))
256 	out = (struct scmi_base_discover_vendor_out *)msg->out_msg;
267  * @msg:	SCMI message
272 						 struct scmi_msg *msg)
276 	if (!msg->out_msg || msg->out_msg_sz < sizeof(*out))
279 	out = (struct scmi_base_discover_vendor_out *)msg->out_msg;
290  * @msg:	SCMI message
295 						   struct scmi_msg *msg)
299 	if (!msg->out_msg || msg->out_msg_sz < sizeof(*out))
302 	out = (struct scmi_base_discover_impl_version_out *)msg->out_msg;
313  * @msg:	SCMI message
318 						     struct scmi_msg *msg)
322 	if (!msg->out_msg || msg->out_msg_sz < sizeof(*out))
325 	out = (struct scmi_base_discover_list_protocols_out *)msg->out_msg;
336  * @msg:	SCMI message
341 					    struct scmi_msg *msg)
346 	if (!msg->in_msg || msg->in_msg_sz < sizeof(agent_id) ||
347 	    !msg->out_msg || msg->out_msg_sz < sizeof(*out))
350 	agent_id = *(u32 *)msg->in_msg;
351 	out = (struct scmi_base_discover_agent_out *)msg->out_msg;
370  * @msg:	SCMI message
375 						    struct scmi_msg *msg)
380 	if (!msg->in_msg || msg->in_msg_sz < sizeof(*in) ||
381 	    !msg->out_msg || msg->out_msg_sz < sizeof(*status))
384 	in = (struct scmi_base_set_device_permissions_in *)msg->in_msg;
385 	status = (u32 *)msg->out_msg;
404  * @msg:	SCMI message
409 						      struct scmi_msg *msg)
415 	if (!msg->in_msg || msg->in_msg_sz < sizeof(*in) ||
416 	    !msg->out_msg || msg->out_msg_sz < sizeof(*status))
419 	in = (struct scmi_base_set_protocol_permissions_in *)msg->in_msg;
420 	status = (u32 *)msg->out_msg;
443  * @msg:	SCMI message
448 						       struct scmi_msg *msg)
453 	if (!msg->in_msg || msg->in_msg_sz < sizeof(*in) ||
454 	    !msg->out_msg || msg->out_msg_sz < sizeof(*status))
457 	in = (struct scmi_base_reset_agent_configuration_in *)msg->in_msg;
458 	status = (u32 *)msg->out_msg;
475  * @msg:	SCMI message
482 					     struct scmi_msg *msg)
486 	if (!msg->out_msg || msg->out_msg_sz < sizeof(*out))
489 	out = (struct scmi_protocol_version_out *)msg->out_msg;
499  * @msg:	SCMI message
506 					     struct scmi_msg *msg)
510 	if (!msg->out_msg || msg->out_msg_sz < sizeof(*out))
513 	out = (struct scmi_pwd_protocol_attrs_out *)msg->out_msg;
528  * @msg:	SCMI message
535 						 struct scmi_msg *msg)
540 	if (!msg->in_msg || msg->in_msg_sz < sizeof(message_id) ||
541 	    !msg->out_msg || msg->out_msg_sz < sizeof(*out))
544 	message_id = *(u32 *)msg->in_msg;
546 	out = (struct scmi_pwd_protocol_msg_attrs_out *)msg->out_msg;
561  * @msg:	SCMI message
567 static int sandbox_scmi_pwd_attribs(struct udevice *dev, struct scmi_msg *msg)
572 	if (!msg->in_msg || msg->in_msg_sz < sizeof(domain_id) ||
573 	    !msg->out_msg || msg->out_msg_sz < sizeof(*out))
576 	domain_id = *(u32 *)msg->in_msg;
577 	out = (struct scmi_pwd_attrs_out *)msg->out_msg;
598  * @msg:	SCMI message
604 static int sandbox_scmi_pwd_state_set(struct udevice *dev, struct scmi_msg *msg)
609 	if (!msg->in_msg || msg->in_msg_sz < sizeof(in) ||
610 	    !msg->out_msg || msg->out_msg_sz < sizeof(*status))
613 	in = (struct scmi_pwd_state_set_in *)msg->in_msg;
614 	status = (s32 *)msg->out_msg;
638  * @msg:	SCMI message
644 static int sandbox_scmi_pwd_state_get(struct udevice *dev, struct scmi_msg *msg)
649 	if (!msg->in_msg || msg->in_msg_sz < sizeof(domain_id) ||
650 	    !msg->out_msg || msg->out_msg_sz < sizeof(*out))
653 	domain_id = *(u32 *)msg->in_msg;
654 	out = (struct scmi_pwd_state_get_out *)msg->out_msg;
671  * @msg:	SCMI message
677 static int sandbox_scmi_pwd_name_get(struct udevice *dev, struct scmi_msg *msg)
682 	if (!msg->in_msg || msg->in_msg_sz < sizeof(domain_id) ||
683 	    !msg->out_msg || msg->out_msg_sz < sizeof(*out))
686 	domain_id = *(u32 *)msg->in_msg;
687 	out = (struct scmi_pwd_name_get_out *)msg->out_msg;
705 					       struct scmi_msg *msg)
709 	if (!msg->out_msg || msg->out_msg_sz < sizeof(*out))
712 	out = (struct scmi_clk_protocol_attr_out *)msg->out_msg;
719 static int sandbox_scmi_clock_attribs(struct udevice *dev, struct scmi_msg *msg)
726 	if (!msg->in_msg || msg->in_msg_sz < sizeof(*in) ||
727 	    !msg->out_msg || msg->out_msg_sz < sizeof(*out))
730 	in = (struct scmi_clk_attribute_in *)msg->in_msg;
731 	out = (struct scmi_clk_attribute_out *)msg->out_msg;
754 				       struct scmi_msg *msg)
760 	if (!msg->in_msg || msg->in_msg_sz < sizeof(*in) ||
761 	    !msg->out_msg || msg->out_msg_sz < sizeof(*out))
764 	in = (struct scmi_clk_rate_set_in *)msg->in_msg;
765 	out = (struct scmi_clk_rate_set_out *)msg->out_msg;
784 				       struct scmi_msg *msg)
790 	if (!msg->in_msg || msg->in_msg_sz < sizeof(*in) ||
791 	    !msg->out_msg || msg->out_msg_sz < sizeof(*out))
794 	in = (struct scmi_clk_rate_get_in *)msg->in_msg;
795 	out = (struct scmi_clk_rate_get_out *)msg->out_msg;
812 static int sandbox_scmi_clock_gate(struct udevice *dev, struct scmi_msg *msg)
818 	if (!msg->in_msg || msg->in_msg_sz < sizeof(*in) ||
819 	    !msg->out_msg || msg->out_msg_sz < sizeof(*out))
822 	in = (struct scmi_clk_state_in *)msg->in_msg;
823 	out = (struct scmi_clk_state_out *)msg->out_msg;
841 static int sandbox_scmi_rd_attribs(struct udevice *dev, struct scmi_msg *msg)
847 	if (!msg->in_msg || msg->in_msg_sz < sizeof(*in) ||
848 	    !msg->out_msg || msg->out_msg_sz < sizeof(*out))
851 	in = (struct scmi_rd_attr_in *)msg->in_msg;
852 	out = (struct scmi_rd_attr_out *)msg->out_msg;
869 static int sandbox_scmi_rd_reset(struct udevice *dev, struct scmi_msg *msg)
875 	if (!msg->in_msg || msg->in_msg_sz < sizeof(*in) ||
876 	    !msg->out_msg || msg->out_msg_sz < sizeof(*out))
879 	in = (struct scmi_rd_reset_in *)msg->in_msg;
880 	out = (struct scmi_rd_reset_out *)msg->out_msg;
911 static int sandbox_scmi_voltd_attribs(struct udevice *dev, struct scmi_msg *msg)
917 	if (!msg->in_msg || msg->in_msg_sz < sizeof(*in) ||
918 	    !msg->out_msg || msg->out_msg_sz < sizeof(*out))
921 	in = (struct scmi_voltd_attr_in *)msg->in_msg;
922 	out = (struct scmi_voltd_attr_out *)msg->out_msg;
940 					 struct scmi_msg *msg)
946 	if (!msg->in_msg || msg->in_msg_sz < sizeof(*in) ||
947 	    !msg->out_msg || msg->out_msg_sz < sizeof(*out))
950 	in = (struct scmi_voltd_config_set_in *)msg->in_msg;
951 	out = (struct scmi_voltd_config_set_out *)msg->out_msg;
976 					 struct scmi_msg *msg)
982 	if (!msg->in_msg || msg->in_msg_sz < sizeof(*in) ||
983 	    !msg->out_msg || msg->out_msg_sz < sizeof(*out))
986 	in = (struct scmi_voltd_config_get_in *)msg->in_msg;
987 	out = (struct scmi_voltd_config_get_out *)msg->out_msg;
1007 					 struct scmi_msg *msg)
1013 	if (!msg->in_msg || msg->in_msg_sz < sizeof(*in) ||
1014 	    !msg->out_msg || msg->out_msg_sz < sizeof(*out))
1017 	in = (struct scmi_voltd_level_set_in *)msg->in_msg;
1018 	out = (struct scmi_voltd_level_set_out *)msg->out_msg;
1034 					struct scmi_msg *msg)
1040 	if (!msg->in_msg || msg->in_msg_sz < sizeof(*in) ||
1041 	    !msg->out_msg || msg->out_msg_sz < sizeof(*out))
1044 	in = (struct scmi_voltd_level_get_in *)msg->in_msg;
1045 	out = (struct scmi_voltd_level_get_out *)msg->out_msg;
1127 static int sandbox_proto_not_supported(struct scmi_msg *msg)
1129 	*(u32 *)msg->out_msg = SCMI_NOT_SUPPORTED;
1136 					 struct scmi_msg *msg)
1138 	switch (msg->protocol_id) {
1140 		switch (msg->message_id) {
1142 			return sandbox_scmi_base_protocol_version(dev, msg);
1144 			return sandbox_scmi_base_protocol_attrs(dev, msg);
1146 			return sandbox_scmi_base_message_attrs(dev, msg);
1148 			return sandbox_scmi_base_discover_vendor(dev, msg);
1150 			return sandbox_scmi_base_discover_sub_vendor(dev, msg);
1152 			return sandbox_scmi_base_discover_impl_version(dev, msg);
1154 			return sandbox_scmi_base_discover_list_protocols(dev, msg);
1156 			return sandbox_scmi_base_discover_agent(dev, msg);
1160 			return sandbox_scmi_base_set_device_permissions(dev, msg);
1162 			return sandbox_scmi_base_set_protocol_permissions(dev, msg);
1164 			return sandbox_scmi_base_reset_agent_configuration(dev, msg);
1171 			return sandbox_proto_not_supported(msg);
1173 		switch (msg->message_id) {
1175 			return sandbox_scmi_pwd_protocol_version(dev, msg);
1177 			return sandbox_scmi_pwd_protocol_attribs(dev, msg);
1179 			return sandbox_scmi_pwd_protocol_msg_attribs(dev, msg);
1181 			return sandbox_scmi_pwd_attribs(dev, msg);
1183 			return sandbox_scmi_pwd_state_set(dev, msg);
1185 			return sandbox_scmi_pwd_state_get(dev, msg);
1187 			return sandbox_scmi_pwd_name_get(dev, msg);
1194 			return sandbox_proto_not_supported(msg);
1196 		switch (msg->message_id) {
1198 			return sandbox_scmi_clock_protocol_attribs(dev, msg);
1200 			return sandbox_scmi_clock_attribs(dev, msg);
1202 			return sandbox_scmi_clock_rate_set(dev, msg);
1204 			return sandbox_scmi_clock_rate_get(dev, msg);
1206 			return sandbox_scmi_clock_gate(dev, msg);
1213 			return sandbox_proto_not_supported(msg);
1215 		switch (msg->message_id) {
1217 			return sandbox_scmi_rd_attribs(dev, msg);
1219 			return sandbox_scmi_rd_reset(dev, msg);
1226 			return sandbox_proto_not_supported(msg);
1228 		switch (msg->message_id) {
1230 			return sandbox_scmi_voltd_attribs(dev, msg);
1232 			return sandbox_scmi_voltd_config_set(dev, msg);
1234 			return sandbox_scmi_voltd_config_get(dev, msg);
1236 			return sandbox_scmi_voltd_level_set(dev, msg);
1238 			return sandbox_scmi_voltd_level_get(dev, msg);
1246 		return sandbox_proto_not_supported(msg);
1252 		__func__, dev->name, msg->protocol_id, msg->message_id);
1254 	if (msg->out_msg_sz < sizeof(u32))
1258 	*(u32 *)msg->out_msg = SCMI_PROTOCOL_ERROR;