firmware/scmi/sandbox-scmi_agent.c

23  * SCMI protocols embedded in U-Boot. Currently:
61  * struct scmi_channel - Channel instance referenced in SCMI drivers
377 	struct scmi_base_set_device_permissions_in *in = NULL;
380 	if (!msg->in_msg || msg->in_msg_sz < sizeof(*in) ||
384 	in = (struct scmi_base_set_device_permissions_in *)msg->in_msg;
387 	if (in->agent_id != 1 || in->device_id != 0)
389 	else if (in->flags & ~SCMI_BASE_SET_DEVICE_PERMISSIONS_ACCESS)
391 	else if (in->flags & SCMI_BASE_SET_DEVICE_PERMISSIONS_ACCESS)
411 	struct scmi_base_set_protocol_permissions_in *in = NULL;
415 	if (!msg->in_msg || msg->in_msg_sz < sizeof(*in) ||
419 	in = (struct scmi_base_set_protocol_permissions_in *)msg->in_msg;
423 		if (protocols[i] == in->command_id)
425 	if (in->agent_id != 1 || in->device_id != 0 ||
428 	else if (in->flags & ~SCMI_BASE_SET_PROTOCOL_PERMISSIONS_ACCESS)
430 	else if (in->flags & SCMI_BASE_SET_PROTOCOL_PERMISSIONS_ACCESS)
450 	struct scmi_base_reset_agent_configuration_in *in = NULL;
453 	if (!msg->in_msg || msg->in_msg_sz < sizeof(*in) ||
457 	in = (struct scmi_base_reset_agent_configuration_in *)msg->in_msg;
460 	if (in->agent_id != 1)
462 	else if (in->flags & ~SCMI_BASE_RESET_ALL_ACCESS_PERMISSIONS)
606 	struct scmi_pwd_state_set_in *in;
609 	if (!msg->in_msg || msg->in_msg_sz < sizeof(in) ||
613 	in = (struct scmi_pwd_state_set_in *)msg->in_msg;
616 	if (in->domain_id >= ARRAY_SIZE(scmi_pwdom)) {
622 	if ((in->flags & SCMI_PWD_SET_FLAGS_ASYNC) ||
623 	    (in->pstate != SCMI_PWD_PSTATE_TYPE_LOST && in->pstate)) {
629 	scmi_pwdom[in->domain_id].pstate = in->pstate;
721 	struct scmi_clk_attribute_in *in = NULL;
726 	if (!msg->in_msg || msg->in_msg_sz < sizeof(*in) ||
730 	in = (struct scmi_clk_attribute_in *)msg->in_msg;
733 	clk_state = get_scmi_clk_state(in->clock_id);
735 		dev_err(dev, "Unexpected clock ID %u\n", in->clock_id);
745 			       "clk%u", in->clock_id);
756 	struct scmi_clk_rate_set_in *in = NULL;
760 	if (!msg->in_msg || msg->in_msg_sz < sizeof(*in) ||
764 	in = (struct scmi_clk_rate_set_in *)msg->in_msg;
767 	clk_state = get_scmi_clk_state(in->clock_id);
769 		dev_err(dev, "Unexpected clock ID %u\n", in->clock_id);
773 		u64 rate = ((u64)in->rate_msb << 32) + in->rate_lsb;
786 	struct scmi_clk_rate_get_in *in = NULL;
790 	if (!msg->in_msg || msg->in_msg_sz < sizeof(*in) ||
794 	in = (struct scmi_clk_rate_get_in *)msg->in_msg;
797 	clk_state = get_scmi_clk_state(in->clock_id);
799 		dev_err(dev, "Unexpected clock ID %u\n", in->clock_id);
814 	struct scmi_clk_state_in *in = NULL;
818 	if (!msg->in_msg || msg->in_msg_sz < sizeof(*in) ||
822 	in = (struct scmi_clk_state_in *)msg->in_msg;
825 	clk_state = get_scmi_clk_state(in->clock_id);
827 		dev_err(dev, "Unexpected clock ID %u\n", in->clock_id);
830 	} else if (in->attributes > 1) {
833 		clk_state->enabled = in->attributes;
843 	struct scmi_rd_attr_in *in = NULL;
847 	if (!msg->in_msg || msg->in_msg_sz < sizeof(*in) ||
851 	in = (struct scmi_rd_attr_in *)msg->in_msg;
854 	reset_state = get_scmi_reset_state(in->domain_id);
856 		dev_err(dev, "Unexpected reset domain ID %u\n", in->domain_id);
861 		snprintf(out->name, sizeof(out->name), "rd%u", in->domain_id);
871 	struct scmi_rd_reset_in *in = NULL;
875 	if (!msg->in_msg || msg->in_msg_sz < sizeof(*in) ||
879 	in = (struct scmi_rd_reset_in *)msg->in_msg;
882 	reset_state = get_scmi_reset_state(in->domain_id);
884 		dev_err(dev, "Unexpected reset domain ID %u\n", in->domain_id);
887 	} else if (in->reset_state > 1) {
892 		if (in->flags & SCMI_RD_RESET_FLAG_CYCLE) {
893 			if (in->flags & SCMI_RD_RESET_FLAG_ASYNC) {
901 			reset_state->asserted = in->flags &
913 	struct scmi_voltd_attr_in *in = NULL;
917 	if (!msg->in_msg || msg->in_msg_sz < sizeof(*in) ||
921 	in = (struct scmi_voltd_attr_in *)msg->in_msg;
924 	voltd_state = get_scmi_voltd_state(in->domain_id);
926 		dev_err(dev, "Unexpected domain ID %u\n", in->domain_id);
931 		snprintf(out->name, sizeof(out->name), "regu%u", in->domain_id);
942 	struct scmi_voltd_config_set_in *in = NULL;
946 	if (!msg->in_msg || msg->in_msg_sz < sizeof(*in) ||
950 	in = (struct scmi_voltd_config_set_in *)msg->in_msg;
953 	voltd_state = get_scmi_voltd_state(in->domain_id);
955 		dev_err(dev, "Unexpected domain ID %u\n", in->domain_id);
958 	} else if (in->config & ~SCMI_VOLTD_CONFIG_MASK) {
959 		dev_err(dev, "Invalid config value 0x%x\n", in->config);
962 	} else if (in->config != SCMI_VOLTD_CONFIG_ON &&
963 		   in->config != SCMI_VOLTD_CONFIG_OFF) {
964 		dev_err(dev, "Unexpected custom value 0x%x\n", in->config);
968 		voltd_state->enabled = in->config == SCMI_VOLTD_CONFIG_ON;
978 	struct scmi_voltd_config_get_in *in = NULL;
982 	if (!msg->in_msg || msg->in_msg_sz < sizeof(*in) ||
986 	in = (struct scmi_voltd_config_get_in *)msg->in_msg;
989 	voltd_state = get_scmi_voltd_state(in->domain_id);
991 		dev_err(dev, "Unexpected domain ID %u\n", in->domain_id);
1009 	struct scmi_voltd_level_set_in *in = NULL;
1013 	if (!msg->in_msg || msg->in_msg_sz < sizeof(*in) ||
1017 	in = (struct scmi_voltd_level_set_in *)msg->in_msg;
1020 	voltd_state = get_scmi_voltd_state(in->domain_id);
1022 		dev_err(dev, "Unexpected domain ID %u\n", in->domain_id);
1026 		voltd_state->voltage_uv = in->voltage_level;
1036 	struct scmi_voltd_level_get_in *in = NULL;
1040 	if (!msg->in_msg || msg->in_msg_sz < sizeof(*in) ||
1044 	in = (struct scmi_voltd_level_get_in *)msg->in_msg;
1047 	voltd_state = get_scmi_voltd_state(in->domain_id);
1049 		dev_err(dev, "Unexpected domain ID %u\n", in->domain_id);
1066  * Assign a channel for the protocol, @protocol, in @channel,