firmware: arm_scmi: Use {get,put}_unaligned_le{32,64} accessors
Instead of type-casting the {tx,rx}.buf all over the place while accessing them to read/write __le{32,64} from/to the firmware, let's use the existing {get,put}_unaligned_le{32,64} accessors to hide all the type cast ugliness. Suggested-by: Philipp Zabel <p.zabel@pengutronix.de> Reviewed-by: Philipp Zabel <p.zabel@pengutronix.de> Signed-off-by: Sudeep Holla <sudeep.holla@arm.com>alistair/sunxi64-5.4-dsi
parent
2bc06ffa06
commit
aa90ac45bc
|
@ -204,7 +204,7 @@ static int scmi_base_discover_agent_get(const struct scmi_handle *handle,
|
||||||
if (ret)
|
if (ret)
|
||||||
return ret;
|
return ret;
|
||||||
|
|
||||||
*(__le32 *)t->tx.buf = cpu_to_le32(id);
|
put_unaligned_le32(id, t->tx.buf);
|
||||||
|
|
||||||
ret = scmi_do_xfer(handle, t);
|
ret = scmi_do_xfer(handle, t);
|
||||||
if (!ret)
|
if (!ret)
|
||||||
|
|
|
@ -107,7 +107,7 @@ static int scmi_clock_attributes_get(const struct scmi_handle *handle,
|
||||||
if (ret)
|
if (ret)
|
||||||
return ret;
|
return ret;
|
||||||
|
|
||||||
*(__le32 *)t->tx.buf = cpu_to_le32(clk_id);
|
put_unaligned_le32(clk_id, t->tx.buf);
|
||||||
attr = t->rx.buf;
|
attr = t->rx.buf;
|
||||||
|
|
||||||
ret = scmi_do_xfer(handle, t);
|
ret = scmi_do_xfer(handle, t);
|
||||||
|
@ -204,15 +204,11 @@ scmi_clock_rate_get(const struct scmi_handle *handle, u32 clk_id, u64 *value)
|
||||||
if (ret)
|
if (ret)
|
||||||
return ret;
|
return ret;
|
||||||
|
|
||||||
*(__le32 *)t->tx.buf = cpu_to_le32(clk_id);
|
put_unaligned_le32(clk_id, t->tx.buf);
|
||||||
|
|
||||||
ret = scmi_do_xfer(handle, t);
|
ret = scmi_do_xfer(handle, t);
|
||||||
if (!ret) {
|
if (!ret)
|
||||||
__le32 *pval = t->rx.buf;
|
*value = get_unaligned_le64(t->rx.buf);
|
||||||
|
|
||||||
*value = le32_to_cpu(*pval);
|
|
||||||
*value |= (u64)le32_to_cpu(*(pval + 1)) << 32;
|
|
||||||
}
|
|
||||||
|
|
||||||
scmi_xfer_put(handle, t);
|
scmi_xfer_put(handle, t);
|
||||||
return ret;
|
return ret;
|
||||||
|
|
|
@ -15,6 +15,8 @@
|
||||||
#include <linux/scmi_protocol.h>
|
#include <linux/scmi_protocol.h>
|
||||||
#include <linux/types.h>
|
#include <linux/types.h>
|
||||||
|
|
||||||
|
#include <asm/unaligned.h>
|
||||||
|
|
||||||
#define PROTOCOL_REV_MINOR_MASK GENMASK(15, 0)
|
#define PROTOCOL_REV_MINOR_MASK GENMASK(15, 0)
|
||||||
#define PROTOCOL_REV_MAJOR_MASK GENMASK(31, 16)
|
#define PROTOCOL_REV_MAJOR_MASK GENMASK(31, 16)
|
||||||
#define PROTOCOL_REV_MAJOR(x) (u16)(FIELD_GET(PROTOCOL_REV_MAJOR_MASK, (x)))
|
#define PROTOCOL_REV_MAJOR(x) (u16)(FIELD_GET(PROTOCOL_REV_MAJOR_MASK, (x)))
|
||||||
|
|
|
@ -151,7 +151,7 @@ scmi_perf_domain_attributes_get(const struct scmi_handle *handle, u32 domain,
|
||||||
if (ret)
|
if (ret)
|
||||||
return ret;
|
return ret;
|
||||||
|
|
||||||
*(__le32 *)t->tx.buf = cpu_to_le32(domain);
|
put_unaligned_le32(domain, t->tx.buf);
|
||||||
attr = t->rx.buf;
|
attr = t->rx.buf;
|
||||||
|
|
||||||
ret = scmi_do_xfer(handle, t);
|
ret = scmi_do_xfer(handle, t);
|
||||||
|
@ -284,7 +284,7 @@ static int scmi_perf_limits_get(const struct scmi_handle *handle, u32 domain,
|
||||||
if (ret)
|
if (ret)
|
||||||
return ret;
|
return ret;
|
||||||
|
|
||||||
*(__le32 *)t->tx.buf = cpu_to_le32(domain);
|
put_unaligned_le32(domain, t->tx.buf);
|
||||||
|
|
||||||
ret = scmi_do_xfer(handle, t);
|
ret = scmi_do_xfer(handle, t);
|
||||||
if (!ret) {
|
if (!ret) {
|
||||||
|
@ -333,11 +333,11 @@ static int scmi_perf_level_get(const struct scmi_handle *handle, u32 domain,
|
||||||
return ret;
|
return ret;
|
||||||
|
|
||||||
t->hdr.poll_completion = poll;
|
t->hdr.poll_completion = poll;
|
||||||
*(__le32 *)t->tx.buf = cpu_to_le32(domain);
|
put_unaligned_le32(domain, t->tx.buf);
|
||||||
|
|
||||||
ret = scmi_do_xfer(handle, t);
|
ret = scmi_do_xfer(handle, t);
|
||||||
if (!ret)
|
if (!ret)
|
||||||
*level = le32_to_cpu(*(__le32 *)t->rx.buf);
|
*level = get_unaligned_le32(t->rx.buf);
|
||||||
|
|
||||||
scmi_xfer_put(handle, t);
|
scmi_xfer_put(handle, t);
|
||||||
return ret;
|
return ret;
|
||||||
|
|
|
@ -96,7 +96,7 @@ scmi_power_domain_attributes_get(const struct scmi_handle *handle, u32 domain,
|
||||||
if (ret)
|
if (ret)
|
||||||
return ret;
|
return ret;
|
||||||
|
|
||||||
*(__le32 *)t->tx.buf = cpu_to_le32(domain);
|
put_unaligned_le32(domain, t->tx.buf);
|
||||||
attr = t->rx.buf;
|
attr = t->rx.buf;
|
||||||
|
|
||||||
ret = scmi_do_xfer(handle, t);
|
ret = scmi_do_xfer(handle, t);
|
||||||
|
@ -147,11 +147,11 @@ scmi_power_state_get(const struct scmi_handle *handle, u32 domain, u32 *state)
|
||||||
if (ret)
|
if (ret)
|
||||||
return ret;
|
return ret;
|
||||||
|
|
||||||
*(__le32 *)t->tx.buf = cpu_to_le32(domain);
|
put_unaligned_le32(domain, t->tx.buf);
|
||||||
|
|
||||||
ret = scmi_do_xfer(handle, t);
|
ret = scmi_do_xfer(handle, t);
|
||||||
if (!ret)
|
if (!ret)
|
||||||
*state = le32_to_cpu(*(__le32 *)t->rx.buf);
|
*state = get_unaligned_le32(t->rx.buf);
|
||||||
|
|
||||||
scmi_xfer_put(handle, t);
|
scmi_xfer_put(handle, t);
|
||||||
return ret;
|
return ret;
|
||||||
|
|
|
@ -120,7 +120,7 @@ static int scmi_sensor_description_get(const struct scmi_handle *handle,
|
||||||
|
|
||||||
do {
|
do {
|
||||||
/* Set the number of sensors to be skipped/already read */
|
/* Set the number of sensors to be skipped/already read */
|
||||||
*(__le32 *)t->tx.buf = cpu_to_le32(desc_index);
|
put_unaligned_le32(desc_index, t->tx.buf);
|
||||||
|
|
||||||
ret = scmi_do_xfer(handle, t);
|
ret = scmi_do_xfer(handle, t);
|
||||||
if (ret)
|
if (ret)
|
||||||
|
@ -217,7 +217,6 @@ static int scmi_sensor_reading_get(const struct scmi_handle *handle,
|
||||||
u32 sensor_id, u64 *value)
|
u32 sensor_id, u64 *value)
|
||||||
{
|
{
|
||||||
int ret;
|
int ret;
|
||||||
__le32 *pval;
|
|
||||||
struct scmi_xfer *t;
|
struct scmi_xfer *t;
|
||||||
struct scmi_msg_sensor_reading_get *sensor;
|
struct scmi_msg_sensor_reading_get *sensor;
|
||||||
struct sensors_info *si = handle->sensor_priv;
|
struct sensors_info *si = handle->sensor_priv;
|
||||||
|
@ -229,24 +228,20 @@ static int scmi_sensor_reading_get(const struct scmi_handle *handle,
|
||||||
if (ret)
|
if (ret)
|
||||||
return ret;
|
return ret;
|
||||||
|
|
||||||
pval = t->rx.buf;
|
|
||||||
sensor = t->tx.buf;
|
sensor = t->tx.buf;
|
||||||
sensor->id = cpu_to_le32(sensor_id);
|
sensor->id = cpu_to_le32(sensor_id);
|
||||||
|
|
||||||
if (s->async) {
|
if (s->async) {
|
||||||
sensor->flags = cpu_to_le32(SENSOR_READ_ASYNC);
|
sensor->flags = cpu_to_le32(SENSOR_READ_ASYNC);
|
||||||
ret = scmi_do_xfer_with_response(handle, t);
|
ret = scmi_do_xfer_with_response(handle, t);
|
||||||
if (!ret) {
|
if (!ret)
|
||||||
*value = le32_to_cpu(*(pval + 1));
|
*value = get_unaligned_le64((void *)
|
||||||
*value |= (u64)le32_to_cpu(*(pval + 2)) << 32;
|
((__le32 *)t->rx.buf + 1));
|
||||||
}
|
|
||||||
} else {
|
} else {
|
||||||
sensor->flags = cpu_to_le32(0);
|
sensor->flags = cpu_to_le32(0);
|
||||||
ret = scmi_do_xfer(handle, t);
|
ret = scmi_do_xfer(handle, t);
|
||||||
if (!ret) {
|
if (!ret)
|
||||||
*value = le32_to_cpu(*pval);
|
*value = get_unaligned_le64(t->rx.buf);
|
||||||
*value |= (u64)le32_to_cpu(*(pval + 1)) << 32;
|
|
||||||
}
|
|
||||||
}
|
}
|
||||||
|
|
||||||
scmi_xfer_put(handle, t);
|
scmi_xfer_put(handle, t);
|
||||||
|
|
Loading…
Reference in New Issue