Commit 38a1bdc9 authored by Punit Agrawal's avatar Punit Agrawal Committed by Sudeep Holla

firmware: arm_scpi: Extend to support sensors

ARM System Control Processor (SCP) provides an API to query and use
the sensors available in the system. Extend the SCPI driver to support
 sensor messages.
Signed-off-by: default avatarPunit Agrawal <punit.agrawal@arm.com>
Acked-by: default avatarSudeep Holla <sudeep.holla@arm.com>
parent d8a44fe7
...@@ -219,6 +219,21 @@ struct dvfs_set { ...@@ -219,6 +219,21 @@ struct dvfs_set {
u8 index; u8 index;
} __packed; } __packed;
struct sensor_capabilities {
__le16 sensors;
} __packed;
struct _scpi_sensor_info {
__le16 sensor_id;
u8 class;
u8 trigger_type;
char name[20];
};
struct sensor_value {
__le32 val;
} __packed;
static struct scpi_drvinfo *scpi_info; static struct scpi_drvinfo *scpi_info;
static int scpi_linux_errmap[SCPI_ERR_MAX] = { static int scpi_linux_errmap[SCPI_ERR_MAX] = {
...@@ -481,6 +496,48 @@ static struct scpi_dvfs_info *scpi_dvfs_get_info(u8 domain) ...@@ -481,6 +496,48 @@ static struct scpi_dvfs_info *scpi_dvfs_get_info(u8 domain)
return info; return info;
} }
static int scpi_sensor_get_capability(u16 *sensors)
{
struct sensor_capabilities cap_buf;
int ret;
ret = scpi_send_message(SCPI_CMD_SENSOR_CAPABILITIES, NULL, 0, &cap_buf,
sizeof(cap_buf));
if (!ret)
*sensors = le16_to_cpu(cap_buf.sensors);
return ret;
}
static int scpi_sensor_get_info(u16 sensor_id, struct scpi_sensor_info *info)
{
__le16 id = cpu_to_le16(sensor_id);
struct _scpi_sensor_info _info;
int ret;
ret = scpi_send_message(SCPI_CMD_SENSOR_INFO, &id, sizeof(id),
&_info, sizeof(_info));
if (!ret) {
memcpy(info, &_info, sizeof(*info));
info->sensor_id = le16_to_cpu(_info.sensor_id);
}
return ret;
}
int scpi_sensor_get_value(u16 sensor, u32 *val)
{
struct sensor_value buf;
int ret;
ret = scpi_send_message(SCPI_CMD_SENSOR_VALUE, &sensor, sizeof(sensor),
&buf, sizeof(buf));
if (!ret)
*val = le32_to_cpu(buf.val);
return ret;
}
static struct scpi_ops scpi_ops = { static struct scpi_ops scpi_ops = {
.get_version = scpi_get_version, .get_version = scpi_get_version,
.clk_get_range = scpi_clk_get_range, .clk_get_range = scpi_clk_get_range,
...@@ -489,6 +546,9 @@ static struct scpi_ops scpi_ops = { ...@@ -489,6 +546,9 @@ static struct scpi_ops scpi_ops = {
.dvfs_get_idx = scpi_dvfs_get_idx, .dvfs_get_idx = scpi_dvfs_get_idx,
.dvfs_set_idx = scpi_dvfs_set_idx, .dvfs_set_idx = scpi_dvfs_set_idx,
.dvfs_get_info = scpi_dvfs_get_info, .dvfs_get_info = scpi_dvfs_get_info,
.sensor_get_capability = scpi_sensor_get_capability,
.sensor_get_info = scpi_sensor_get_info,
.sensor_get_value = scpi_sensor_get_value,
}; };
struct scpi_ops *get_scpi_ops(void) struct scpi_ops *get_scpi_ops(void)
......
...@@ -28,6 +28,20 @@ struct scpi_dvfs_info { ...@@ -28,6 +28,20 @@ struct scpi_dvfs_info {
struct scpi_opp *opps; struct scpi_opp *opps;
}; };
enum scpi_sensor_class {
TEMPERATURE,
VOLTAGE,
CURRENT,
POWER,
};
struct scpi_sensor_info {
u16 sensor_id;
u8 class;
u8 trigger_type;
char name[20];
} __packed;
/** /**
* struct scpi_ops - represents the various operations provided * struct scpi_ops - represents the various operations provided
* by SCP through SCPI message protocol * by SCP through SCPI message protocol
...@@ -52,6 +66,9 @@ struct scpi_ops { ...@@ -52,6 +66,9 @@ struct scpi_ops {
int (*dvfs_get_idx)(u8); int (*dvfs_get_idx)(u8);
int (*dvfs_set_idx)(u8, u8); int (*dvfs_set_idx)(u8, u8);
struct scpi_dvfs_info *(*dvfs_get_info)(u8); struct scpi_dvfs_info *(*dvfs_get_info)(u8);
int (*sensor_get_capability)(u16 *sensors);
int (*sensor_get_info)(u16 sensor_id, struct scpi_sensor_info *);
int (*sensor_get_value)(u16, u32 *);
}; };
#if IS_ENABLED(CONFIG_ARM_SCPI_PROTOCOL) #if IS_ENABLED(CONFIG_ARM_SCPI_PROTOCOL)
......
Markdown is supported
0%
or
You are about to add 0 people to the discussion. Proceed with caution.
Finish editing this message first!
Please register or to comment