[RFC 5/6] firmware: scmi: add pseudo pinctrl protocol support on sandbox

AKASHI Takahiro takahiro.akashi at linaro.org
Wed Sep 6 04:40:10 CEST 2023


With this patch, sandbox SCMI agent can handle pinctrl protocol.
This feature is used in an unit test for SCMI pinctrl.

Signed-off-by: AKASHI Takahiro <takahiro.akashi at linaro.org>
---
 arch/sandbox/dts/test.dts                  | 115 ++++
 drivers/firmware/scmi/sandbox-scmi_agent.c | 722 +++++++++++++++++++++
 2 files changed, 837 insertions(+)

diff --git a/arch/sandbox/dts/test.dts b/arch/sandbox/dts/test.dts
index dc0bfdfb6e4b..d2ddea801995 100644
--- a/arch/sandbox/dts/test.dts
+++ b/arch/sandbox/dts/test.dts
@@ -723,9 +723,124 @@
 					};
 				};
 			};
+
+			pinctrl_scmi: protocol at 19 {
+				reg = <0x19>;
+
+				pinctrl-names = "default","alternate";
+				pinctrl-0 = <&scmi_pinctrl_gpios>, <&scmi_pinctrl_i2s>;
+				pinctrl-1 = <&scmi_pinctrl_spi>, <&scmi_pinctrl_i2c>;
+
+#if 0
+				scmi_pinctrl_gpio_a: scmi_gpios {
+					gpio-controller;
+					#gpio-cells = <2>;
+					gpio-bank-name = "scmi_gpios";
+					ngpios = <4>;
+					gpio-ranges = <&pinctrl_scmi 0 5 4>,
+						      <&pinctrl_scmi 4 0 0>;
+					gpio-ranges-group-names = "",
+								  "GPIO_B";
+
+					hog_input_1 {
+						gpio-hog;
+						input;
+						gpios = <1 GPIO_ACTIVE_HIGH>;
+					};
+					hog_output_3 {
+						gpio-hog;
+						output-high;
+						output-mode;
+						output-value = <1>;
+						gpios = <3 GPIO_ACTIVE_HIGH>;
+					};
+				};
+#endif
+
+				scmi_pinctrl_gpios: gpios-pins {
+					gpio0 {
+						pins = "P5";
+						function = "GPIO";
+						bias-pull-up;
+						// input-disable;
+						input-mode = <0>;
+					};
+					gpio1 {
+						pins = "P6";
+						function = "GPIO";
+						// output-high;
+						output-mode;
+						output-value = <1>;
+						drive-open-drain;
+					};
+					gpio2 {
+						pinmux = <SANDBOX_PINMUX(7, SANDBOX_PINMUX_GPIO)>;
+						bias-pull-down;
+						// input-enable;
+						input-mode;
+					};
+					gpio3 {
+						pinmux = <SANDBOX_PINMUX(8, SANDBOX_PINMUX_GPIO)>;
+						bias-disable;
+					};
+				};
+
+				scmi_pinctrl_i2c: i2c-pins {
+					groups {
+						groups = "I2C_UART";
+						function = "I2C";
+					};
+
+					pins {
+						pins = "P0", "P1";
+						drive-open-drain;
+					};
+				};
+
+				scmi_pinctrl_i2s: i2s-pins {
+					groups = "SPI_I2S";
+					function = "I2S";
+				};
+
+				scmi_pinctrl_spi: spi-pins {
+					groups = "SPI_I2S";
+					function = "SPI";
+
+					cs {
+						pinmux = <SANDBOX_PINMUX(5, SANDBOX_PINMUX_CS)>,
+							 <SANDBOX_PINMUX(6, SANDBOX_PINMUX_CS)>;
+					};
+				};
+			};
 		};
 	};
 
+#if 1
+	scmi_pinctrl_gpio_a: scmi_gpios {
+		compatible = "arm,scmi-gpio-generic";
+		gpio-controller;
+		#gpio-cells = <2>;
+		gpio-bank-name = "scmi_gpios";
+		gpio-ranges = <&pinctrl_scmi 0 5 4>,
+			      <&pinctrl_scmi 4 0 0>;
+		gpio-ranges-group-names = "",
+					  "GPIO_B";
+
+		hog_input_1 {
+			gpio-hog;
+			input;
+			gpios = <1 GPIO_ACTIVE_HIGH>;
+		};
+		hog_output_3 {
+			gpio-hog;
+			output-high;
+			output-mode;
+			output-value = <1>;
+			gpios = <3 GPIO_ACTIVE_HIGH>;
+		};
+	};
+#endif
+
 	fpga {
 		compatible = "sandbox,fpga";
 	};
diff --git a/drivers/firmware/scmi/sandbox-scmi_agent.c b/drivers/firmware/scmi/sandbox-scmi_agent.c
index 27d17809be43..d5ff8a2b1c79 100644
--- a/drivers/firmware/scmi/sandbox-scmi_agent.c
+++ b/drivers/firmware/scmi/sandbox-scmi_agent.c
@@ -14,6 +14,7 @@
 #include <asm/io.h>
 #include <asm/scmi_test.h>
 #include <dm/device_compat.h>
+#include <dt-bindings/pinctrl/sandbox-pinmux.h>
 #include <linux/bitfield.h>
 #include <linux/kernel.h>
 
@@ -43,8 +44,11 @@
 #define SANDBOX_SCMI_AGENT_NAME "OSPM"
 #define SANDBOX_SCMI_PLATFORM_NAME "platform"
 
+#define SANDBOX_SCMI_PIN_CONTROL_PROTOCOL_VERSION SCMI_PIN_CONTROL_PROTOCOL_VERSION
+
 static u8 protocols[] = {
 	SCMI_PROTOCOL_ID_CLOCK,
+	SCMI_PROTOCOL_ID_PIN_CONTROL,
 	SCMI_PROTOCOL_ID_RESET_DOMAIN,
 	SCMI_PROTOCOL_ID_VOLTAGE_DOMAIN,
 };
@@ -796,6 +800,696 @@ static int sandbox_scmi_voltd_level_get(struct udevice *dev,
 	return 0;
 }
 
+/* Pin control protocol */
+
+/*
+ * This driver emulates a pin controller with the following rules:
+ * - The pinctrl config for each pin must be set individually
+ * - The first two pins (P0-P1) must be muxed as a group
+ * - The next three pins (P2-P4) must be muxed as a group
+ * - The next four pins (P5-P8) must be muxed individually
+ * - The last two pins (P9-P10) must be fixed as a GPIO group only
+
+	P0:  "UART TX",  "I2C SCL"
+	P1:  "UART RX",  "I2C SDA"
+	P2:  "SPI SCLK", "I2S SCK"
+	P3:  "SPI MOSI", "I2S SD"
+	P4:  "SPI MISO", "I2S WS"
+	P5:  "GPIO0",    "SPI CS0"
+	P6:  "GPIO1",    "SPI CS1"
+	P7:  "GPIO2",    "PWM0"
+	P8:  "GPIO3",    "PWM1"
+	P9:  "GPIO_B"
+	P10: "GPIO_B"
+
+ */
+
+static const char * const sandbox_pins[] = {
+#define PIN(x) \
+	[x] = "P" #x
+	PIN(0),
+	PIN(1),
+	PIN(2),
+	PIN(3),
+	PIN(4),
+	PIN(5),
+	PIN(6),
+	PIN(7),
+	PIN(8),
+	PIN(9),
+	PIN(10),
+#undef PIN
+};
+
+static unsigned int sandbox_pin_functions[9];
+static u32 sandbox_pin_states[9][SCMI_PINCTRL_CONFIG_RESERVED];
+
+#define SANDBOX_GROUP_I2C_UART 0
+#define SANDBOX_GROUP_SPI_I2S 1
+#define SANDBOX_GROUP_GPIO_B 2
+
+static const char * const sandbox_groups[] = {
+	/* P0-P1 */
+	[SANDBOX_GROUP_I2C_UART] = "I2C_UART",
+	/* P2-P4 */
+	[SANDBOX_GROUP_SPI_I2S] = "SPI_I2S",
+	/* P9-P10 */
+	[SANDBOX_GROUP_GPIO_B] = "GPIO_B",
+};
+
+static const char * const sandbox_functions[] = {
+#define FUNC(id) \
+	[SANDBOX_PINMUX_##id] = #id
+	FUNC(UART),
+	FUNC(I2C),
+	FUNC(SPI),
+	FUNC(I2S),
+	FUNC(GPIO),
+	FUNC(CS),
+	FUNC(PWM),
+	/* FUNC(GPIO_B) */
+#undef FUNC
+};
+
+static int sandbox_scmi_pinctrl_protocol_version(struct udevice *dev,
+						 struct scmi_msg *msg)
+{
+	struct scmi_protocol_version_out *out = NULL;
+
+	if (!msg->out_msg || msg->out_msg_sz < sizeof(*out))
+		return -EINVAL;
+
+	out = (struct scmi_protocol_version_out *)msg->out_msg;
+	out->version = SANDBOX_SCMI_PIN_CONTROL_PROTOCOL_VERSION;
+	out->status = SCMI_SUCCESS;
+
+	return 0;
+}
+
+static int sandbox_scmi_pinctrl_protocol_attrs(struct udevice *dev,
+					       struct scmi_msg *msg)
+{
+	struct scmi_pinctrl_protocol_attrs_out *out = NULL;
+
+	if (!msg->out_msg || msg->out_msg_sz < sizeof(*out))
+		return -EINVAL;
+
+	out = (struct scmi_pinctrl_protocol_attrs_out *)msg->out_msg;
+	out->attributes_low = (ARRAY_SIZE(sandbox_groups) << 16)
+				+ ARRAY_SIZE(sandbox_pins);
+	out->attributes_high = ARRAY_SIZE(sandbox_functions);
+	out->status = SCMI_SUCCESS;
+
+	return 0;
+}
+
+static int sandbox_scmi_pinctrl_attrs(struct udevice *dev,
+				      struct scmi_msg *msg)
+{
+	struct scmi_pinctrl_attrs_in *in;
+	struct scmi_pinctrl_attrs_out *out;
+
+	if (!msg->in_msg || msg->in_msg_sz < sizeof(*in) ||
+	    !msg->out_msg || msg->out_msg_sz < sizeof(*out))
+		return -EINVAL;
+
+	in = (struct scmi_pinctrl_attrs_in *)msg->in_msg;
+	out = (struct scmi_pinctrl_attrs_out *)msg->out_msg;
+
+	/*
+	 * Currently all pins have a name with less than 16 characters
+	 * (SCMI_PINCTRL_NAME_LENGTH_MAX).
+	 */
+	switch (SCMI_PINCTRL_TYPE(in->flags)) {
+	case SCMI_PINCTRL_TYPE_PIN:
+		if (in->id < ARRAY_SIZE(sandbox_pins)) {
+			strcpy(out->name, sandbox_pins[in->id]);
+			out->attributes = 0;
+		} else {
+			out->status = SCMI_NOT_FOUND;
+			goto err;
+		}
+		break;
+	case SCMI_PINCTRL_TYPE_GROUP:
+		if (in->id < ARRAY_SIZE(sandbox_groups)) {
+			strcpy(out->name, sandbox_groups[in->id]);
+			out->attributes = in->id ? 3 : 2;
+		} else {
+			out->status = SCMI_NOT_FOUND;
+			goto err;
+		}
+		break;
+	case SCMI_PINCTRL_TYPE_FUNCTION:
+		if (in->id < ARRAY_SIZE(sandbox_functions)) {
+			strcpy(out->name, sandbox_functions[in->id]);
+			if (in->id == 4) /* UART */
+				out->attributes = 4;
+			else if (in->id == 5 || in->id == 6) /* CS or PWM */
+				out->attributes = 2;
+			else
+				out->attributes = 1;
+		} else {
+			out->status = SCMI_NOT_FOUND;
+			goto err;
+		}
+		break;
+	default:
+		out->status = SCMI_INVALID_PARAMETERS;
+		goto err;
+	}
+
+	out->status = SCMI_SUCCESS;
+
+err:
+	return 0;
+}
+
+static int sandbox_scmi_pinctrl_list_assocs(struct udevice *dev,
+					    struct scmi_msg *msg)
+{
+	struct scmi_pinctrl_list_assocs_in *in;
+	struct scmi_pinctrl_list_assocs_out *out;
+
+	if (!msg->in_msg || msg->in_msg_sz < sizeof(*in) ||
+	    !msg->out_msg || msg->out_msg_sz < sizeof(*out))
+		return -EINVAL;
+
+	in = (struct scmi_pinctrl_list_assocs_in *)msg->in_msg;
+	out = (struct scmi_pinctrl_list_assocs_out *)msg->out_msg;
+
+	/*
+	 * UART -> GROUP0
+	 * I2C  -> GROUP0
+	 * SPI  -> GROUP1
+	 * I2S  -> GROUP1
+	 * GPIO -> PIN5, 6, 7, 8
+	 * CS   -> PIN5, 6
+	 * PWM  -> PIN7, 8
+	 * (GPIO_B -> GROUP2)
+	 */
+	switch (SCMI_PINCTRL_TYPE(in->flags)) {
+	case SCMI_PINCTRL_TYPE_GROUP:
+		if (in->id == SANDBOX_GROUP_I2C_UART) {
+			if (in->index == 0) {
+				out->array[0] = 0;
+				out->array[1] = 1;
+				out->flags = 2;
+			} else if (in->index == 1) {
+				out->array[0] = 0;
+				out->flags = 1;
+			} else {
+				out->status = SCMI_OUT_OF_RANGE;
+				goto err;
+			}
+		} else if (in->id == SANDBOX_GROUP_SPI_I2S) {
+			if (in->index == 0) {
+				out->array[0] = 2;
+				out->array[1] = 3;
+				out->array[2] = 4;
+				out->flags = 3;
+			} else if (in->index == 1) {
+				out->array[0] = 3;
+				out->array[1] = 4;
+				out->flags = 2;
+			} else if (in->index == 2) {
+				out->array[0] = 4;
+				out->flags = 1;
+			} else {
+				out->status = SCMI_OUT_OF_RANGE;
+				goto err;
+			}
+		} else if (in->id == SANDBOX_GROUP_GPIO_B) {
+			if (in->index == 0) {
+				out->array[0] = 9;
+				out->array[1] = 10;
+				out->flags = 2;
+			} else if (in->index == 1) {
+				out->array[0] = 10;
+				out->flags = 1;
+			} else {
+				out->status = SCMI_OUT_OF_RANGE;
+				goto err;
+			}
+		} else {
+			out->status = SCMI_NOT_FOUND;
+			goto err;
+		}
+		break;
+	case SCMI_PINCTRL_TYPE_FUNCTION:
+		if (in->id == SANDBOX_PINMUX_UART) {
+			if (in->index > 0) {
+				out->status = SCMI_OUT_OF_RANGE;
+				goto err;
+			}
+			out->array[0] = SANDBOX_GROUP_I2C_UART;
+			out->flags = 1;
+		} else if (in->id == SANDBOX_PINMUX_I2C) {
+			if (in->index > 0) {
+				out->status = SCMI_OUT_OF_RANGE;
+				goto err;
+			}
+			out->array[0] = SANDBOX_GROUP_I2C_UART;
+			out->flags = 1;
+		} else if (in->id == SANDBOX_PINMUX_SPI) {
+			if (in->index > 0) {
+				out->status = SCMI_OUT_OF_RANGE;
+				goto err;
+			}
+			out->array[0] = SANDBOX_GROUP_SPI_I2S;
+			out->flags = 1;
+		} else if (in->id == SANDBOX_PINMUX_I2S) {
+			if (in->index > 0) {
+				out->status = SCMI_OUT_OF_RANGE;
+				goto err;
+			}
+			out->array[0] = SANDBOX_GROUP_SPI_I2S;
+			out->flags = 1;
+		} else {
+			out->status = SCMI_NOT_FOUND;
+			goto err;
+		}
+		break;
+	default:
+		out->status = SCMI_INVALID_PARAMETERS;
+		goto err;
+	}
+
+	out->status = SCMI_SUCCESS;
+
+err:
+	return 0;
+}
+
+static void copy_config(struct scmi_pin_entry *configs, u32 selector, int skip,
+			u32 *num, u32 *remaining)
+{
+	int max_num, i;
+
+	if ((skip + SCMI_PINCTRL_CONFIG_ENTRY_MAX)
+			> SCMI_PINCTRL_CONFIG_RESERVED)
+		max_num = SCMI_PINCTRL_CONFIG_RESERVED - skip;
+	else
+		max_num = SCMI_PINCTRL_CONFIG_ENTRY_MAX;
+
+	/* TODO: eliminate disabled properties? */
+	for (i = 0; i < max_num; i++) {
+		configs[i].type = skip + i;
+		configs[i].value = sandbox_pin_states[selector][skip + i];
+	}
+
+	*num = max_num;
+	*remaining = SCMI_PINCTRL_CONFIG_RESERVED - (skip + max_num);
+}
+
+static int sandbox_scmi_pinctrl_config_get(struct udevice *dev,
+					   struct scmi_msg *msg)
+{
+	struct scmi_pinctrl_config_get_in *in;
+	struct scmi_pinctrl_config_get_out *out;
+	u32 type, num, remaining;
+	int all_configs, skip;
+
+	if (!msg->in_msg || msg->in_msg_sz < sizeof(*in) ||
+	    !msg->out_msg || msg->out_msg_sz < sizeof(*out))
+		return -EINVAL;
+
+	in = (struct scmi_pinctrl_config_get_in *)msg->in_msg;
+	out = (struct scmi_pinctrl_config_get_out *)msg->out_msg;
+
+	all_configs = in->attributes & SCMI_PINCTRL_CONFIG_GET_ALL;
+	skip = SCMI_PINCTRL_CONFIG_GET_SKIP(in->attributes);
+	type = SCMI_PINCTRL_CONFIG_GET_TYPE(in->attributes);
+	if (type >= SCMI_PINCTRL_CONFIG_RESERVED) {
+		out->status = SCMI_INVALID_PARAMETERS;
+		goto err;
+	}
+
+	switch (SCMI_PINCTRL_CONFIG_GET_PINCTRL_TYPE(in->attributes)) {
+	case SCMI_PINCTRL_TYPE_PIN:
+		if (in->id < ARRAY_SIZE(sandbox_pins)) {
+			if (all_configs) {
+				if (skip >= SCMI_PINCTRL_CONFIG_RESERVED) {
+					out->status = SCMI_INVALID_PARAMETERS;
+					goto err;
+				}
+				num = 0; /* avoid compiler warning */
+				remaining = 0;
+				copy_config(&out->configs[0], in->id, skip,
+					    &num, &remaining);
+			} else {
+				out->configs[0].type = type;
+				out->configs[0].value =
+					sandbox_pin_states[in->id][type];
+				num = 1;
+				remaining = 0;
+			}
+		} else {
+			out->status = SCMI_NOT_FOUND;
+			goto err;
+		}
+		out->num_configs =
+			SCMI_PINCTRL_CONFIG_GET_NUM_CONFIGS(remaining, num);
+		break;
+	case SCMI_PINCTRL_TYPE_GROUP:
+		if (in->id < ARRAY_SIZE(sandbox_groups)) {
+			/* TODO */;
+		} else {
+			out->status = SCMI_NOT_FOUND;
+			goto err;
+		}
+		break;
+	default:
+		out->status = SCMI_INVALID_PARAMETERS;
+		goto err;
+	}
+
+	out->status = SCMI_SUCCESS;
+
+err:
+	return 0;
+}
+
+static int sandbox_scmi_pinctrl_config_set(struct udevice *dev,
+					   struct scmi_msg *msg)
+{
+	struct scmi_pinctrl_config_set_in *in;
+	u32 *status;
+	int i, num;
+
+	if (!msg->in_msg || msg->in_msg_sz < sizeof(*in) ||
+	    !msg->out_msg || msg->out_msg_sz < sizeof(*status))
+		return -EINVAL;
+
+	in = (struct scmi_pinctrl_config_set_in *)msg->in_msg;
+	status = (u32 *)msg->out_msg;
+
+	num = SCMI_PINCTRL_CONFIG_SET_NUM_CONFIGS(in->attributes);
+	if (num > SCMI_PINCTRL_CONFIG_ENTRY_MAX) {
+		*status = SCMI_PROTOCOL_ERROR;
+		goto err;
+	}
+
+	switch (SCMI_PINCTRL_CONFIG_SET_PINCTRL_TYPE(in->attributes)) {
+	case SCMI_PINCTRL_TYPE_PIN:
+		if (in->id < ARRAY_SIZE(sandbox_pins)) {
+			/* TODO: check value range */
+			for (i = 0; i < num; i++)
+				sandbox_pin_states[in->id][in->configs[i].type]
+					= in->configs[i].value;
+		} else {
+			*status = SCMI_NOT_FOUND;
+			goto err;
+		}
+		break;
+	case SCMI_PINCTRL_TYPE_GROUP:
+		/* TODO: check value range */
+		if (!in->id) {
+			for (i = 0; i < num; i++) {
+				sandbox_pin_states[0][in->configs[i].type] =
+					in->configs[i].value;
+				sandbox_pin_states[1][in->configs[i].type] =
+					in->configs[i].value;
+			}
+		} else if (in->id == 1) {
+			for (i = 0; i < num; i++) {
+				sandbox_pin_states[2][in->configs[i].type] =
+					in->configs[i].value;
+				sandbox_pin_states[3][in->configs[i].type] =
+					in->configs[i].value;
+				sandbox_pin_states[4][in->configs[i].type] =
+					in->configs[i].value;
+			}
+		} else if (in->id == 2) {
+			for (i = 0; i < num; i++) {
+				sandbox_pin_states[9][in->configs[i].type] =
+					in->configs[i].value;
+				sandbox_pin_states[10][in->configs[i].type] =
+					in->configs[i].value;
+			}
+		} else {
+			*status = SCMI_NOT_FOUND;
+			goto err;
+		}
+		break;
+	default:
+		*status = SCMI_INVALID_PARAMETERS;
+		goto err;
+	}
+
+	*status = SCMI_SUCCESS;
+err:
+	return 0;
+}
+
+static int sandbox_scmi_pinctrl_function_select(struct udevice *dev,
+						struct scmi_msg *msg)
+{
+	struct scmi_pinctrl_function_select_in *in;
+	u32 *status;
+
+	if (!msg->in_msg || msg->in_msg_sz < sizeof(*in) ||
+	    !msg->out_msg || msg->out_msg_sz < sizeof(*status))
+		return -EINVAL;
+
+	in = (struct scmi_pinctrl_function_select_in *)msg->in_msg;
+	status = (u32 *)msg->out_msg;
+
+	switch (SCMI_PINCTRL_TYPE(in->flags)) {
+	case SCMI_PINCTRL_TYPE_PIN:
+		if (in->id == 5 || in->id == 6) {
+			if (in->function_id == SANDBOX_PINMUX_GPIO ||
+			    in->function_id == SANDBOX_PINMUX_CS) {
+				sandbox_pin_functions[in->id] = in->function_id;
+				*status = SCMI_SUCCESS;
+			} else {
+				*status = SCMI_NOT_SUPPORTED;
+			}
+		} else if (in->id == 7 || in->id == 8) {
+			if (in->function_id == SANDBOX_PINMUX_GPIO ||
+			    in->function_id == SANDBOX_PINMUX_PWM) {
+				sandbox_pin_functions[in->id] = in->function_id;
+				*status = SCMI_SUCCESS;
+			} else {
+				*status = SCMI_NOT_SUPPORTED;
+			}
+		}
+		break;
+	case SCMI_PINCTRL_TYPE_GROUP:
+		if (in->id == SANDBOX_GROUP_I2C_UART) {
+			if (in->function_id == SANDBOX_PINMUX_UART ||
+			    in->function_id == SANDBOX_PINMUX_I2C) {
+				sandbox_pin_functions[0] = in->function_id;
+				sandbox_pin_functions[1] = in->function_id;
+				*status = SCMI_SUCCESS;
+			} else {
+				*status = SCMI_NOT_SUPPORTED;
+			}
+		} else if (in->id == SANDBOX_GROUP_SPI_I2S) {
+			if (in->function_id == SANDBOX_PINMUX_SPI ||
+			    in->function_id == SANDBOX_PINMUX_I2S) {
+				sandbox_pin_functions[2] = in->function_id;
+				sandbox_pin_functions[3] = in->function_id;
+				sandbox_pin_functions[4] = in->function_id;
+				*status = SCMI_SUCCESS;
+			} else {
+				*status = SCMI_NOT_SUPPORTED;
+			}
+		}
+		break;
+	default:
+		*status = SCMI_INVALID_PARAMETERS;
+		goto err;
+	}
+
+	*status = SCMI_SUCCESS;
+err:
+	return 0;
+}
+
+static int sandbox_scmi_pinctrl_request(struct udevice *dev,
+					struct scmi_msg *msg)
+{
+	struct scmi_pinctrl_request_in *in;
+	u32 *status;
+
+	if (!msg->in_msg || msg->in_msg_sz < sizeof(*in) ||
+	    !msg->out_msg || msg->out_msg_sz < sizeof(*status))
+		return -EINVAL;
+
+	in = (struct scmi_pinctrl_request_in *)msg->in_msg;
+	status = (u32 *)msg->out_msg;
+
+	/*
+	 * No other agent, so always accept the request
+	 */
+	switch (SCMI_PINCTRL_TYPE(in->flags)) {
+	case SCMI_PINCTRL_TYPE_PIN:
+		if (in->id >= ARRAY_SIZE(sandbox_pins)) {
+			*status = SCMI_NOT_FOUND;
+			goto err;
+		}
+		break;
+	case SCMI_PINCTRL_TYPE_GROUP:
+		if (in->id >= ARRAY_SIZE(sandbox_groups)) {
+			*status = SCMI_NOT_FOUND;
+			goto err;
+		}
+		break;
+	default:
+		*status = SCMI_INVALID_PARAMETERS;
+		goto err;
+	}
+
+	*status = SCMI_SUCCESS;
+err:
+	return 0;
+}
+
+static int sandbox_scmi_pinctrl_release(struct udevice *dev,
+					struct scmi_msg *msg)
+{
+	struct scmi_pinctrl_release_in *in;
+	u32 *status;
+
+	if (!msg->in_msg || msg->in_msg_sz < sizeof(*in) ||
+	    !msg->out_msg || msg->out_msg_sz < sizeof(*status))
+		return -EINVAL;
+
+	in = (struct scmi_pinctrl_release_in *)msg->in_msg;
+	status = (u32 *)msg->out_msg;
+
+	/*
+	 * No other agent, so always accept the release
+	 */
+	switch (SCMI_PINCTRL_TYPE(in->flags)) {
+	case SCMI_PINCTRL_TYPE_PIN:
+		if (in->id >= ARRAY_SIZE(sandbox_pins)) {
+			*status = SCMI_NOT_FOUND;
+			goto err;
+		}
+		break;
+	case SCMI_PINCTRL_TYPE_GROUP:
+		if (in->id >= ARRAY_SIZE(sandbox_groups)) {
+			*status = SCMI_NOT_FOUND;
+			goto err;
+		}
+		break;
+	default:
+		*status = SCMI_INVALID_PARAMETERS;
+		goto err;
+	}
+
+	*status = SCMI_SUCCESS;
+err:
+	return 0;
+}
+
+static int sandbox_scmi_pinctrl_name_get(struct udevice *dev,
+					 struct scmi_msg *msg)
+{
+	struct scmi_pinctrl_name_get_in *in;
+	struct scmi_pinctrl_name_get_out *out;
+
+	if (!msg->in_msg || msg->in_msg_sz < sizeof(*in) ||
+	    !msg->out_msg || msg->out_msg_sz < sizeof(*out))
+		return -EINVAL;
+
+	in = (struct scmi_pinctrl_name_get_in *)msg->in_msg;
+	out = (struct scmi_pinctrl_name_get_out *)msg->out_msg;
+
+	/*
+	 * Currently all pins have a name with less than 64 characters
+	 */
+	switch (SCMI_PINCTRL_TYPE(in->flags)) {
+	case SCMI_PINCTRL_TYPE_PIN:
+		if (in->id < ARRAY_SIZE(sandbox_pins)) {
+			strcpy(out->name, sandbox_pins[in->id]);
+		} else {
+			out->status = SCMI_NOT_FOUND;
+			goto err;
+		}
+		break;
+	case SCMI_PINCTRL_TYPE_GROUP:
+		if (in->id < ARRAY_SIZE(sandbox_groups)) {
+			strcpy(out->name, sandbox_groups[in->id]);
+		} else {
+			out->status = SCMI_NOT_FOUND;
+			goto err;
+		}
+		break;
+	case SCMI_PINCTRL_TYPE_FUNCTION:
+		if (in->id < ARRAY_SIZE(sandbox_functions)) {
+			strcpy(out->name, sandbox_functions[in->id]);
+		} else {
+			out->status = SCMI_NOT_FOUND;
+			goto err;
+		}
+		break;
+	default:
+		out->status = SCMI_INVALID_PARAMETERS;
+		goto err;
+	}
+
+	out->flags = 0;
+	out->status = SCMI_SUCCESS;
+
+err:
+	return 0;
+}
+
+static int sandbox_scmi_pinctrl_set_permissions(struct udevice *dev,
+						struct scmi_msg *msg)
+{
+	struct scmi_pinctrl_set_permissions_in *in;
+	u32 *status;
+
+	if (!msg->in_msg || msg->in_msg_sz < sizeof(*in) ||
+	    !msg->out_msg || msg->out_msg_sz < sizeof(*status))
+		return -EINVAL;
+
+	in = (struct scmi_pinctrl_set_permissions_in *)msg->in_msg;
+	status = (u32 *)msg->out_msg;
+
+	if (in->agent_id != 1) {
+		*status = SCMI_NOT_FOUND;
+		goto err;
+	}
+
+	switch (SCMI_PINCTRL_TYPE(in->flags)) {
+	case SCMI_PINCTRL_TYPE_PIN:
+		if (in->id < ARRAY_SIZE(sandbox_pins)) {
+			if (in->flags & SCMI_PINCTRL_PERMISSION)
+				*status = SCMI_SUCCESS;
+			else
+				/* unset not allowed */
+				*status = SCMI_DENIED;
+		} else {
+			*status = SCMI_NOT_FOUND;
+			goto err;
+		}
+		break;
+	case SCMI_PINCTRL_TYPE_GROUP:
+		if (in->id < ARRAY_SIZE(sandbox_groups)) {
+			if (in->flags & SCMI_PINCTRL_PERMISSION)
+				*status = SCMI_SUCCESS;
+			else
+				/* unset not allowed */
+				*status = SCMI_DENIED;
+		} else {
+			*status = SCMI_NOT_FOUND;
+			goto err;
+		}
+		break;
+	default:
+		*status = SCMI_INVALID_PARAMETERS;
+		goto err;
+	}
+
+	*status = SCMI_SUCCESS;
+err:
+	return 0;
+}
+
 static int sandbox_scmi_test_process_msg(struct udevice *dev,
 					 struct scmi_channel *channel,
 					 struct scmi_msg *msg)
@@ -847,6 +1541,34 @@ static int sandbox_scmi_test_process_msg(struct udevice *dev,
 			break;
 		}
 		break;
+	case SCMI_PROTOCOL_ID_PIN_CONTROL:
+		switch (msg->message_id) {
+		case SCMI_PROTOCOL_VERSION:
+			return sandbox_scmi_pinctrl_protocol_version(dev, msg);
+		case SCMI_PROTOCOL_ATTRIBUTES:
+			return sandbox_scmi_pinctrl_protocol_attrs(dev, msg);
+		case SCMI_PINCTRL_ATTRIBUTES:
+			return sandbox_scmi_pinctrl_attrs(dev, msg);
+		case SCMI_PINCTRL_LIST_ASSOCIATIONS:
+			return sandbox_scmi_pinctrl_list_assocs(dev, msg);
+		case SCMI_PINCTRL_CONFIG_GET:
+			return sandbox_scmi_pinctrl_config_get(dev, msg);
+		case SCMI_PINCTRL_CONFIG_SET:
+			return sandbox_scmi_pinctrl_config_set(dev, msg);
+		case SCMI_PINCTRL_FUNCTION_SELECT:
+			return sandbox_scmi_pinctrl_function_select(dev, msg);
+		case SCMI_PINCTRL_REQUEST:
+			return sandbox_scmi_pinctrl_request(dev, msg);
+		case SCMI_PINCTRL_RELEASE:
+			return sandbox_scmi_pinctrl_release(dev, msg);
+		case SCMI_PINCTRL_NAME_GET:
+			return sandbox_scmi_pinctrl_name_get(dev, msg);
+		case SCMI_PINCTRL_SET_PERMISSIONS:
+			return sandbox_scmi_pinctrl_set_permissions(dev, msg);
+		default:
+			break;
+		}
+		break;
 	case SCMI_PROTOCOL_ID_RESET_DOMAIN:
 		switch (msg->message_id) {
 		case SCMI_RESET_DOMAIN_ATTRIBUTES:
-- 
2.34.1



More information about the U-Boot mailing list