15179c523SSudeep Holla // SPDX-License-Identifier: GPL-2.0 25179c523SSudeep Holla /* 35179c523SSudeep Holla * System Control and Management Interface (SCMI) Sensor Protocol 45179c523SSudeep Holla * 523136bffSCristian Marussi * Copyright (C) 2018-2022 ARM Ltd. 65179c523SSudeep Holla */ 75179c523SSudeep Holla 8128e3e93SCristian Marussi #define pr_fmt(fmt) "SCMI Notifications SENSOR - " fmt 9128e3e93SCristian Marussi 101fe00b8bSCristian Marussi #include <linux/bitfield.h> 11f5800e0bSCristian Marussi #include <linux/module.h> 12128e3e93SCristian Marussi #include <linux/scmi_protocol.h> 13128e3e93SCristian Marussi 1423136bffSCristian Marussi #include "protocols.h" 15128e3e93SCristian Marussi #include "notify.h" 165179c523SSudeep Holla 17b5efc28aSCristian Marussi /* Updated only after ALL the mandatory features for that version are merged */ 18*be9f0865SCristian Marussi #define SCMI_PROTOCOL_SUPPORTED_VERSION 0x30001 19b5efc28aSCristian Marussi 201fe00b8bSCristian Marussi #define SCMI_MAX_NUM_SENSOR_AXIS 63 211fe00b8bSCristian Marussi #define SCMIv2_SENSOR_PROTOCOL 0x10000 221fe00b8bSCristian Marussi 235179c523SSudeep Holla enum scmi_sensor_protocol_cmd { 245179c523SSudeep Holla SENSOR_DESCRIPTION_GET = 0x3, 259eefa43aSSudeep Holla SENSOR_TRIP_POINT_NOTIFY = 0x4, 269eefa43aSSudeep Holla SENSOR_TRIP_POINT_CONFIG = 0x5, 275179c523SSudeep Holla SENSOR_READING_GET = 0x6, 281fe00b8bSCristian Marussi SENSOR_AXIS_DESCRIPTION_GET = 0x7, 291fe00b8bSCristian Marussi SENSOR_LIST_UPDATE_INTERVALS = 0x8, 307b83c5f4SCristian Marussi SENSOR_CONFIG_GET = 0x9, 317b83c5f4SCristian Marussi SENSOR_CONFIG_SET = 0xA, 32e3811190SCristian Marussi SENSOR_CONTINUOUS_UPDATE_NOTIFY = 0xB, 33b260fccaSCristian Marussi SENSOR_NAME_GET = 0xC, 34802b0bedSCristian Marussi SENSOR_AXIS_NAME_GET = 0xD, 355179c523SSudeep Holla }; 365179c523SSudeep Holla 375179c523SSudeep Holla struct scmi_msg_resp_sensor_attributes { 385179c523SSudeep Holla __le16 num_sensors; 395179c523SSudeep Holla u8 max_requests; 405179c523SSudeep Holla u8 reserved; 415179c523SSudeep Holla __le32 reg_addr_low; 425179c523SSudeep Holla __le32 reg_addr_high; 435179c523SSudeep Holla __le32 reg_size; 445179c523SSudeep Holla }; 455179c523SSudeep Holla 461fe00b8bSCristian Marussi /* v3 attributes_low macros */ 471fe00b8bSCristian Marussi #define SUPPORTS_UPDATE_NOTIFY(x) FIELD_GET(BIT(30), (x)) 481fe00b8bSCristian Marussi #define SENSOR_TSTAMP_EXP(x) FIELD_GET(GENMASK(14, 10), (x)) 491fe00b8bSCristian Marussi #define SUPPORTS_TIMESTAMP(x) FIELD_GET(BIT(9), (x)) 501fe00b8bSCristian Marussi #define SUPPORTS_EXTEND_ATTRS(x) FIELD_GET(BIT(8), (x)) 511fe00b8bSCristian Marussi 521fe00b8bSCristian Marussi /* v2 attributes_high macros */ 531fe00b8bSCristian Marussi #define SENSOR_UPDATE_BASE(x) FIELD_GET(GENMASK(31, 27), (x)) 541fe00b8bSCristian Marussi #define SENSOR_UPDATE_SCALE(x) FIELD_GET(GENMASK(26, 22), (x)) 551fe00b8bSCristian Marussi 561fe00b8bSCristian Marussi /* v3 attributes_high macros */ 571fe00b8bSCristian Marussi #define SENSOR_AXIS_NUMBER(x) FIELD_GET(GENMASK(21, 16), (x)) 581fe00b8bSCristian Marussi #define SUPPORTS_AXIS(x) FIELD_GET(BIT(8), (x)) 591fe00b8bSCristian Marussi 601fe00b8bSCristian Marussi /* v3 resolution macros */ 611fe00b8bSCristian Marussi #define SENSOR_RES(x) FIELD_GET(GENMASK(26, 0), (x)) 621fe00b8bSCristian Marussi #define SENSOR_RES_EXP(x) FIELD_GET(GENMASK(31, 27), (x)) 631fe00b8bSCristian Marussi 641fe00b8bSCristian Marussi struct scmi_msg_resp_attrs { 651fe00b8bSCristian Marussi __le32 min_range_low; 661fe00b8bSCristian Marussi __le32 min_range_high; 671fe00b8bSCristian Marussi __le32 max_range_low; 681fe00b8bSCristian Marussi __le32 max_range_high; 691fe00b8bSCristian Marussi }; 701fe00b8bSCristian Marussi 717cab5377SCristian Marussi struct scmi_msg_sensor_description { 727cab5377SCristian Marussi __le32 desc_index; 737cab5377SCristian Marussi }; 747cab5377SCristian Marussi 755179c523SSudeep Holla struct scmi_msg_resp_sensor_description { 765179c523SSudeep Holla __le16 num_returned; 775179c523SSudeep Holla __le16 num_remaining; 781fe00b8bSCristian Marussi struct scmi_sensor_descriptor { 795179c523SSudeep Holla __le32 id; 805179c523SSudeep Holla __le32 attributes_low; 811fe00b8bSCristian Marussi /* Common attributes_low macros */ 821fe00b8bSCristian Marussi #define SUPPORTS_ASYNC_READ(x) FIELD_GET(BIT(31), (x)) 83b260fccaSCristian Marussi #define SUPPORTS_EXTENDED_NAMES(x) FIELD_GET(BIT(29), (x)) 841fe00b8bSCristian Marussi #define NUM_TRIP_POINTS(x) FIELD_GET(GENMASK(7, 0), (x)) 855179c523SSudeep Holla __le32 attributes_high; 861fe00b8bSCristian Marussi /* Common attributes_high macros */ 871fe00b8bSCristian Marussi #define SENSOR_SCALE(x) FIELD_GET(GENMASK(15, 11), (x)) 880b673b64SFlorian Fainelli #define SENSOR_SCALE_SIGN BIT(4) 891fe00b8bSCristian Marussi #define SENSOR_SCALE_EXTEND GENMASK(31, 5) 901fe00b8bSCristian Marussi #define SENSOR_TYPE(x) FIELD_GET(GENMASK(7, 0), (x)) 91b260fccaSCristian Marussi u8 name[SCMI_SHORT_NAME_MAX_SIZE]; 921fe00b8bSCristian Marussi /* only for version > 2.0 */ 931fe00b8bSCristian Marussi __le32 power; 941fe00b8bSCristian Marussi __le32 resolution; 951fe00b8bSCristian Marussi struct scmi_msg_resp_attrs scalar_attrs; 961fe00b8bSCristian Marussi } desc[]; 971fe00b8bSCristian Marussi }; 981fe00b8bSCristian Marussi 991fe00b8bSCristian Marussi /* Base scmi_sensor_descriptor size excluding extended attrs after name */ 1001fe00b8bSCristian Marussi #define SCMI_MSG_RESP_SENS_DESCR_BASE_SZ 28 1011fe00b8bSCristian Marussi 1021fe00b8bSCristian Marussi /* Sign extend to a full s32 */ 1031fe00b8bSCristian Marussi #define S32_EXT(v) \ 1041fe00b8bSCristian Marussi ({ \ 1051fe00b8bSCristian Marussi int __v = (v); \ 1061fe00b8bSCristian Marussi \ 1071fe00b8bSCristian Marussi if (__v & SENSOR_SCALE_SIGN) \ 1081fe00b8bSCristian Marussi __v |= SENSOR_SCALE_EXTEND; \ 1091fe00b8bSCristian Marussi __v; \ 1101fe00b8bSCristian Marussi }) 1111fe00b8bSCristian Marussi 1121fe00b8bSCristian Marussi struct scmi_msg_sensor_axis_description_get { 1131fe00b8bSCristian Marussi __le32 id; 1141fe00b8bSCristian Marussi __le32 axis_desc_index; 1151fe00b8bSCristian Marussi }; 1161fe00b8bSCristian Marussi 1171fe00b8bSCristian Marussi struct scmi_msg_resp_sensor_axis_description { 1181fe00b8bSCristian Marussi __le32 num_axis_flags; 1191fe00b8bSCristian Marussi #define NUM_AXIS_RETURNED(x) FIELD_GET(GENMASK(5, 0), (x)) 1201fe00b8bSCristian Marussi #define NUM_AXIS_REMAINING(x) FIELD_GET(GENMASK(31, 26), (x)) 1211fe00b8bSCristian Marussi struct scmi_axis_descriptor { 1221fe00b8bSCristian Marussi __le32 id; 1231fe00b8bSCristian Marussi __le32 attributes_low; 124802b0bedSCristian Marussi #define SUPPORTS_EXTENDED_AXIS_NAMES(x) FIELD_GET(BIT(9), (x)) 1251fe00b8bSCristian Marussi __le32 attributes_high; 126802b0bedSCristian Marussi u8 name[SCMI_SHORT_NAME_MAX_SIZE]; 1271fe00b8bSCristian Marussi __le32 resolution; 1281fe00b8bSCristian Marussi struct scmi_msg_resp_attrs attrs; 1291fe00b8bSCristian Marussi } desc[]; 1301fe00b8bSCristian Marussi }; 1311fe00b8bSCristian Marussi 132802b0bedSCristian Marussi struct scmi_msg_resp_sensor_axis_names_description { 133802b0bedSCristian Marussi __le32 num_axis_flags; 134802b0bedSCristian Marussi struct scmi_sensor_axis_name_descriptor { 135802b0bedSCristian Marussi __le32 axis_id; 136802b0bedSCristian Marussi u8 name[SCMI_MAX_STR_SIZE]; 137802b0bedSCristian Marussi } desc[]; 138802b0bedSCristian Marussi }; 139802b0bedSCristian Marussi 1401fe00b8bSCristian Marussi /* Base scmi_axis_descriptor size excluding extended attrs after name */ 1411fe00b8bSCristian Marussi #define SCMI_MSG_RESP_AXIS_DESCR_BASE_SZ 28 1421fe00b8bSCristian Marussi 1431fe00b8bSCristian Marussi struct scmi_msg_sensor_list_update_intervals { 1441fe00b8bSCristian Marussi __le32 id; 1451fe00b8bSCristian Marussi __le32 index; 1461fe00b8bSCristian Marussi }; 1471fe00b8bSCristian Marussi 1481fe00b8bSCristian Marussi struct scmi_msg_resp_sensor_list_update_intervals { 1491fe00b8bSCristian Marussi __le32 num_intervals_flags; 1501fe00b8bSCristian Marussi #define NUM_INTERVALS_RETURNED(x) FIELD_GET(GENMASK(11, 0), (x)) 1511fe00b8bSCristian Marussi #define SEGMENTED_INTVL_FORMAT(x) FIELD_GET(BIT(12), (x)) 1521fe00b8bSCristian Marussi #define NUM_INTERVALS_REMAINING(x) FIELD_GET(GENMASK(31, 16), (x)) 1531fe00b8bSCristian Marussi __le32 intervals[]; 1545179c523SSudeep Holla }; 1555179c523SSudeep Holla 156e3811190SCristian Marussi struct scmi_msg_sensor_request_notify { 1575179c523SSudeep Holla __le32 id; 1585179c523SSudeep Holla __le32 event_control; 159e3811190SCristian Marussi #define SENSOR_NOTIFY_ALL BIT(0) 1605179c523SSudeep Holla }; 1615179c523SSudeep Holla 1625179c523SSudeep Holla struct scmi_msg_set_sensor_trip_point { 1635179c523SSudeep Holla __le32 id; 1645179c523SSudeep Holla __le32 event_control; 1655179c523SSudeep Holla #define SENSOR_TP_EVENT_MASK (0x3) 1665179c523SSudeep Holla #define SENSOR_TP_DISABLED 0x0 1675179c523SSudeep Holla #define SENSOR_TP_POSITIVE 0x1 1685179c523SSudeep Holla #define SENSOR_TP_NEGATIVE 0x2 1695179c523SSudeep Holla #define SENSOR_TP_BOTH 0x3 1705179c523SSudeep Holla #define SENSOR_TP_ID(x) (((x) & 0xff) << 4) 1715179c523SSudeep Holla __le32 value_low; 1725179c523SSudeep Holla __le32 value_high; 1735179c523SSudeep Holla }; 1745179c523SSudeep Holla 1757b83c5f4SCristian Marussi struct scmi_msg_sensor_config_set { 1767b83c5f4SCristian Marussi __le32 id; 1777b83c5f4SCristian Marussi __le32 sensor_config; 1787b83c5f4SCristian Marussi }; 1797b83c5f4SCristian Marussi 1805179c523SSudeep Holla struct scmi_msg_sensor_reading_get { 1815179c523SSudeep Holla __le32 id; 1825179c523SSudeep Holla __le32 flags; 1835179c523SSudeep Holla #define SENSOR_READ_ASYNC BIT(0) 1845179c523SSudeep Holla }; 1855179c523SSudeep Holla 186e2083d36SCristian Marussi struct scmi_resp_sensor_reading_complete { 187e2083d36SCristian Marussi __le32 id; 188187a002bSCristian Marussi __le32 readings_low; 189187a002bSCristian Marussi __le32 readings_high; 190e2083d36SCristian Marussi }; 191e2083d36SCristian Marussi 192e945927dSCristian Marussi struct scmi_sensor_reading_resp { 193e2083d36SCristian Marussi __le32 sensor_value_low; 194e2083d36SCristian Marussi __le32 sensor_value_high; 195e2083d36SCristian Marussi __le32 timestamp_low; 196e2083d36SCristian Marussi __le32 timestamp_high; 197e2083d36SCristian Marussi }; 198e2083d36SCristian Marussi 199e2083d36SCristian Marussi struct scmi_resp_sensor_reading_complete_v3 { 200e2083d36SCristian Marussi __le32 id; 201e945927dSCristian Marussi struct scmi_sensor_reading_resp readings[]; 202e2083d36SCristian Marussi }; 203e2083d36SCristian Marussi 204128e3e93SCristian Marussi struct scmi_sensor_trip_notify_payld { 205128e3e93SCristian Marussi __le32 agent_id; 206128e3e93SCristian Marussi __le32 sensor_id; 207128e3e93SCristian Marussi __le32 trip_point_desc; 208128e3e93SCristian Marussi }; 209128e3e93SCristian Marussi 210e3811190SCristian Marussi struct scmi_sensor_update_notify_payld { 211e3811190SCristian Marussi __le32 agent_id; 212e3811190SCristian Marussi __le32 sensor_id; 213e945927dSCristian Marussi struct scmi_sensor_reading_resp readings[]; 214e3811190SCristian Marussi }; 215e3811190SCristian Marussi 2165179c523SSudeep Holla struct sensors_info { 217b55b06b7SSudeep Holla u32 version; 2187ac7932dSCristian Marussi bool notify_trip_point_cmd; 2197ac7932dSCristian Marussi bool notify_continuos_update_cmd; 2205179c523SSudeep Holla int num_sensors; 2215179c523SSudeep Holla int max_requests; 2225179c523SSudeep Holla u64 reg_addr; 2235179c523SSudeep Holla u32 reg_size; 2245179c523SSudeep Holla struct scmi_sensor_info *sensors; 2255179c523SSudeep Holla }; 2265179c523SSudeep Holla 2279694a7f6SCristian Marussi static int scmi_sensor_attributes_get(const struct scmi_protocol_handle *ph, 2285179c523SSudeep Holla struct sensors_info *si) 2295179c523SSudeep Holla { 2305179c523SSudeep Holla int ret; 2315179c523SSudeep Holla struct scmi_xfer *t; 2325179c523SSudeep Holla struct scmi_msg_resp_sensor_attributes *attr; 2335179c523SSudeep Holla 2349694a7f6SCristian Marussi ret = ph->xops->xfer_get_init(ph, PROTOCOL_ATTRIBUTES, 2359694a7f6SCristian Marussi 0, sizeof(*attr), &t); 2365179c523SSudeep Holla if (ret) 2375179c523SSudeep Holla return ret; 2385179c523SSudeep Holla 2395179c523SSudeep Holla attr = t->rx.buf; 2405179c523SSudeep Holla 2419694a7f6SCristian Marussi ret = ph->xops->do_xfer(ph, t); 2425179c523SSudeep Holla if (!ret) { 2435179c523SSudeep Holla si->num_sensors = le16_to_cpu(attr->num_sensors); 2445179c523SSudeep Holla si->max_requests = attr->max_requests; 2455179c523SSudeep Holla si->reg_addr = le32_to_cpu(attr->reg_addr_low) | 2465179c523SSudeep Holla (u64)le32_to_cpu(attr->reg_addr_high) << 32; 2475179c523SSudeep Holla si->reg_size = le32_to_cpu(attr->reg_size); 2485179c523SSudeep Holla } 2495179c523SSudeep Holla 2509694a7f6SCristian Marussi ph->xops->xfer_put(ph, t); 2517ac7932dSCristian Marussi 2527ac7932dSCristian Marussi if (!ret) { 2537ac7932dSCristian Marussi if (!ph->hops->protocol_msg_check(ph, 2547ac7932dSCristian Marussi SENSOR_TRIP_POINT_NOTIFY, NULL)) 2557ac7932dSCristian Marussi si->notify_trip_point_cmd = true; 2567ac7932dSCristian Marussi 2577ac7932dSCristian Marussi if (!ph->hops->protocol_msg_check(ph, 2587ac7932dSCristian Marussi SENSOR_CONTINUOUS_UPDATE_NOTIFY, 2597ac7932dSCristian Marussi NULL)) 2607ac7932dSCristian Marussi si->notify_continuos_update_cmd = true; 2617ac7932dSCristian Marussi } 2627ac7932dSCristian Marussi 2635179c523SSudeep Holla return ret; 2645179c523SSudeep Holla } 2655179c523SSudeep Holla 2661fe00b8bSCristian Marussi static inline void scmi_parse_range_attrs(struct scmi_range_attrs *out, 2677cab5377SCristian Marussi const struct scmi_msg_resp_attrs *in) 2681fe00b8bSCristian Marussi { 2691fe00b8bSCristian Marussi out->min_range = get_unaligned_le64((void *)&in->min_range_low); 2701fe00b8bSCristian Marussi out->max_range = get_unaligned_le64((void *)&in->max_range_low); 2711fe00b8bSCristian Marussi } 2721fe00b8bSCristian Marussi 2737cab5377SCristian Marussi struct scmi_sens_ipriv { 2747cab5377SCristian Marussi void *priv; 2757cab5377SCristian Marussi struct device *dev; 2767cab5377SCristian Marussi }; 2777cab5377SCristian Marussi 2787cab5377SCristian Marussi static void iter_intervals_prepare_message(void *message, 2797cab5377SCristian Marussi unsigned int desc_index, 2807cab5377SCristian Marussi const void *p) 2811fe00b8bSCristian Marussi { 2827cab5377SCristian Marussi struct scmi_msg_sensor_list_update_intervals *msg = message; 2837cab5377SCristian Marussi const struct scmi_sensor_info *s; 2841fe00b8bSCristian Marussi 2857cab5377SCristian Marussi s = ((const struct scmi_sens_ipriv *)p)->priv; 2861fe00b8bSCristian Marussi /* Set the number of sensors to be skipped/already read */ 2871fe00b8bSCristian Marussi msg->id = cpu_to_le32(s->id); 2881fe00b8bSCristian Marussi msg->index = cpu_to_le32(desc_index); 2897cab5377SCristian Marussi } 2901fe00b8bSCristian Marussi 2917cab5377SCristian Marussi static int iter_intervals_update_state(struct scmi_iterator_state *st, 2927cab5377SCristian Marussi const void *response, void *p) 2937cab5377SCristian Marussi { 2947cab5377SCristian Marussi u32 flags; 2957cab5377SCristian Marussi struct scmi_sensor_info *s = ((struct scmi_sens_ipriv *)p)->priv; 2967cab5377SCristian Marussi struct device *dev = ((struct scmi_sens_ipriv *)p)->dev; 2977cab5377SCristian Marussi const struct scmi_msg_resp_sensor_list_update_intervals *r = response; 2981fe00b8bSCristian Marussi 2997cab5377SCristian Marussi flags = le32_to_cpu(r->num_intervals_flags); 3007cab5377SCristian Marussi st->num_returned = NUM_INTERVALS_RETURNED(flags); 3017cab5377SCristian Marussi st->num_remaining = NUM_INTERVALS_REMAINING(flags); 3021fe00b8bSCristian Marussi 3031fe00b8bSCristian Marussi /* 3041fe00b8bSCristian Marussi * Max intervals is not declared previously anywhere so we 3057cab5377SCristian Marussi * assume it's returned+remaining on first call. 3061fe00b8bSCristian Marussi */ 3077cab5377SCristian Marussi if (!st->max_resources) { 3081fe00b8bSCristian Marussi s->intervals.segmented = SEGMENTED_INTVL_FORMAT(flags); 3097cab5377SCristian Marussi s->intervals.count = st->num_returned + st->num_remaining; 3101fe00b8bSCristian Marussi /* segmented intervals are reported in one triplet */ 3111fe00b8bSCristian Marussi if (s->intervals.segmented && 3127cab5377SCristian Marussi (st->num_remaining || st->num_returned != 3)) { 3137cab5377SCristian Marussi dev_err(dev, 3141fe00b8bSCristian Marussi "Sensor ID:%d advertises an invalid segmented interval (%d)\n", 3151fe00b8bSCristian Marussi s->id, s->intervals.count); 3161fe00b8bSCristian Marussi s->intervals.segmented = false; 3171fe00b8bSCristian Marussi s->intervals.count = 0; 3187cab5377SCristian Marussi return -EINVAL; 3191fe00b8bSCristian Marussi } 3201fe00b8bSCristian Marussi /* Direct allocation when exceeding pre-allocated */ 3211fe00b8bSCristian Marussi if (s->intervals.count >= SCMI_MAX_PREALLOC_POOL) { 3221fe00b8bSCristian Marussi s->intervals.desc = 3237cab5377SCristian Marussi devm_kcalloc(dev, 3241fe00b8bSCristian Marussi s->intervals.count, 3251fe00b8bSCristian Marussi sizeof(*s->intervals.desc), 3261fe00b8bSCristian Marussi GFP_KERNEL); 3271fe00b8bSCristian Marussi if (!s->intervals.desc) { 3281fe00b8bSCristian Marussi s->intervals.segmented = false; 3291fe00b8bSCristian Marussi s->intervals.count = 0; 3307cab5377SCristian Marussi return -ENOMEM; 3311fe00b8bSCristian Marussi } 3321fe00b8bSCristian Marussi } 3337cab5377SCristian Marussi 3347cab5377SCristian Marussi st->max_resources = s->intervals.count; 3351fe00b8bSCristian Marussi } 3361fe00b8bSCristian Marussi 3377cab5377SCristian Marussi return 0; 3387cab5377SCristian Marussi } 3391fe00b8bSCristian Marussi 3407cab5377SCristian Marussi static int 3417cab5377SCristian Marussi iter_intervals_process_response(const struct scmi_protocol_handle *ph, 3427cab5377SCristian Marussi const void *response, 3437cab5377SCristian Marussi struct scmi_iterator_state *st, void *p) 3447cab5377SCristian Marussi { 3457cab5377SCristian Marussi const struct scmi_msg_resp_sensor_list_update_intervals *r = response; 3467cab5377SCristian Marussi struct scmi_sensor_info *s = ((struct scmi_sens_ipriv *)p)->priv; 3471fe00b8bSCristian Marussi 3487cab5377SCristian Marussi s->intervals.desc[st->desc_index + st->loop_idx] = 3497cab5377SCristian Marussi le32_to_cpu(r->intervals[st->loop_idx]); 3501fe00b8bSCristian Marussi 3517cab5377SCristian Marussi return 0; 3527cab5377SCristian Marussi } 3537cab5377SCristian Marussi 3547cab5377SCristian Marussi static int scmi_sensor_update_intervals(const struct scmi_protocol_handle *ph, 3557cab5377SCristian Marussi struct scmi_sensor_info *s) 3567cab5377SCristian Marussi { 3577cab5377SCristian Marussi void *iter; 3587cab5377SCristian Marussi struct scmi_iterator_ops ops = { 3597cab5377SCristian Marussi .prepare_message = iter_intervals_prepare_message, 3607cab5377SCristian Marussi .update_state = iter_intervals_update_state, 3617cab5377SCristian Marussi .process_response = iter_intervals_process_response, 3627cab5377SCristian Marussi }; 3637cab5377SCristian Marussi struct scmi_sens_ipriv upriv = { 3647cab5377SCristian Marussi .priv = s, 3657cab5377SCristian Marussi .dev = ph->dev, 3667cab5377SCristian Marussi }; 3677cab5377SCristian Marussi 3687cab5377SCristian Marussi iter = ph->hops->iter_response_init(ph, &ops, s->intervals.count, 3697cab5377SCristian Marussi SENSOR_LIST_UPDATE_INTERVALS, 370d0c94befSCristian Marussi sizeof(struct scmi_msg_sensor_list_update_intervals), 371d0c94befSCristian Marussi &upriv); 3727cab5377SCristian Marussi if (IS_ERR(iter)) 3737cab5377SCristian Marussi return PTR_ERR(iter); 3747cab5377SCristian Marussi 3757cab5377SCristian Marussi return ph->hops->iter_response_run(iter); 3767cab5377SCristian Marussi } 3777cab5377SCristian Marussi 3788e60294cSCristian Marussi struct scmi_apriv { 3798e60294cSCristian Marussi bool any_axes_support_extended_names; 3808e60294cSCristian Marussi struct scmi_sensor_info *s; 3818e60294cSCristian Marussi }; 3828e60294cSCristian Marussi 3837cab5377SCristian Marussi static void iter_axes_desc_prepare_message(void *message, 3847cab5377SCristian Marussi const unsigned int desc_index, 3857cab5377SCristian Marussi const void *priv) 3867cab5377SCristian Marussi { 3877cab5377SCristian Marussi struct scmi_msg_sensor_axis_description_get *msg = message; 3888e60294cSCristian Marussi const struct scmi_apriv *apriv = priv; 3897cab5377SCristian Marussi 3907cab5377SCristian Marussi /* Set the number of sensors to be skipped/already read */ 3918e60294cSCristian Marussi msg->id = cpu_to_le32(apriv->s->id); 3927cab5377SCristian Marussi msg->axis_desc_index = cpu_to_le32(desc_index); 3937cab5377SCristian Marussi } 3947cab5377SCristian Marussi 3957cab5377SCristian Marussi static int 3967cab5377SCristian Marussi iter_axes_desc_update_state(struct scmi_iterator_state *st, 3977cab5377SCristian Marussi const void *response, void *priv) 3987cab5377SCristian Marussi { 3997cab5377SCristian Marussi u32 flags; 4007cab5377SCristian Marussi const struct scmi_msg_resp_sensor_axis_description *r = response; 4017cab5377SCristian Marussi 4027cab5377SCristian Marussi flags = le32_to_cpu(r->num_axis_flags); 4037cab5377SCristian Marussi st->num_returned = NUM_AXIS_RETURNED(flags); 4047cab5377SCristian Marussi st->num_remaining = NUM_AXIS_REMAINING(flags); 4057cab5377SCristian Marussi st->priv = (void *)&r->desc[0]; 4067cab5377SCristian Marussi 4077cab5377SCristian Marussi return 0; 4087cab5377SCristian Marussi } 4097cab5377SCristian Marussi 4107cab5377SCristian Marussi static int 4117cab5377SCristian Marussi iter_axes_desc_process_response(const struct scmi_protocol_handle *ph, 4127cab5377SCristian Marussi const void *response, 4137cab5377SCristian Marussi struct scmi_iterator_state *st, void *priv) 4147cab5377SCristian Marussi { 4157cab5377SCristian Marussi u32 attrh, attrl; 4167cab5377SCristian Marussi struct scmi_sensor_axis_info *a; 4177cab5377SCristian Marussi size_t dsize = SCMI_MSG_RESP_AXIS_DESCR_BASE_SZ; 4188e60294cSCristian Marussi struct scmi_apriv *apriv = priv; 4197cab5377SCristian Marussi const struct scmi_axis_descriptor *adesc = st->priv; 4207cab5377SCristian Marussi 4217cab5377SCristian Marussi attrl = le32_to_cpu(adesc->attributes_low); 4228e60294cSCristian Marussi if (SUPPORTS_EXTENDED_AXIS_NAMES(attrl)) 4238e60294cSCristian Marussi apriv->any_axes_support_extended_names = true; 4247cab5377SCristian Marussi 4258e60294cSCristian Marussi a = &apriv->s->axis[st->desc_index + st->loop_idx]; 4267cab5377SCristian Marussi a->id = le32_to_cpu(adesc->id); 4277cab5377SCristian Marussi a->extended_attrs = SUPPORTS_EXTEND_ATTRS(attrl); 4287cab5377SCristian Marussi 4297cab5377SCristian Marussi attrh = le32_to_cpu(adesc->attributes_high); 4307cab5377SCristian Marussi a->scale = S32_EXT(SENSOR_SCALE(attrh)); 4317cab5377SCristian Marussi a->type = SENSOR_TYPE(attrh); 4324314f9f4SCristian Marussi strscpy(a->name, adesc->name, SCMI_SHORT_NAME_MAX_SIZE); 4337cab5377SCristian Marussi 4347cab5377SCristian Marussi if (a->extended_attrs) { 4357cab5377SCristian Marussi unsigned int ares = le32_to_cpu(adesc->resolution); 4367cab5377SCristian Marussi 4377cab5377SCristian Marussi a->resolution = SENSOR_RES(ares); 4387cab5377SCristian Marussi a->exponent = S32_EXT(SENSOR_RES_EXP(ares)); 4397cab5377SCristian Marussi dsize += sizeof(adesc->resolution); 4407cab5377SCristian Marussi 4417cab5377SCristian Marussi scmi_parse_range_attrs(&a->attrs, &adesc->attrs); 4427cab5377SCristian Marussi dsize += sizeof(adesc->attrs); 4437cab5377SCristian Marussi } 4447cab5377SCristian Marussi st->priv = ((u8 *)adesc + dsize); 4457cab5377SCristian Marussi 4467cab5377SCristian Marussi return 0; 4471fe00b8bSCristian Marussi } 4481fe00b8bSCristian Marussi 449802b0bedSCristian Marussi static int 450802b0bedSCristian Marussi iter_axes_extended_name_update_state(struct scmi_iterator_state *st, 451802b0bedSCristian Marussi const void *response, void *priv) 452802b0bedSCristian Marussi { 453802b0bedSCristian Marussi u32 flags; 454802b0bedSCristian Marussi const struct scmi_msg_resp_sensor_axis_names_description *r = response; 455802b0bedSCristian Marussi 456802b0bedSCristian Marussi flags = le32_to_cpu(r->num_axis_flags); 457802b0bedSCristian Marussi st->num_returned = NUM_AXIS_RETURNED(flags); 458802b0bedSCristian Marussi st->num_remaining = NUM_AXIS_REMAINING(flags); 459802b0bedSCristian Marussi st->priv = (void *)&r->desc[0]; 460802b0bedSCristian Marussi 461802b0bedSCristian Marussi return 0; 462802b0bedSCristian Marussi } 463802b0bedSCristian Marussi 464802b0bedSCristian Marussi static int 465802b0bedSCristian Marussi iter_axes_extended_name_process_response(const struct scmi_protocol_handle *ph, 466802b0bedSCristian Marussi const void *response, 467802b0bedSCristian Marussi struct scmi_iterator_state *st, 468802b0bedSCristian Marussi void *priv) 469802b0bedSCristian Marussi { 470802b0bedSCristian Marussi struct scmi_sensor_axis_info *a; 4718e60294cSCristian Marussi const struct scmi_apriv *apriv = priv; 472802b0bedSCristian Marussi struct scmi_sensor_axis_name_descriptor *adesc = st->priv; 4738e60294cSCristian Marussi u32 axis_id = le32_to_cpu(adesc->axis_id); 474802b0bedSCristian Marussi 4758e60294cSCristian Marussi if (axis_id >= st->max_resources) 4768e60294cSCristian Marussi return -EPROTO; 4778e60294cSCristian Marussi 4788e60294cSCristian Marussi /* 4798e60294cSCristian Marussi * Pick the corresponding descriptor based on the axis_id embedded 4808e60294cSCristian Marussi * in the reply since the list of axes supporting extended names 4818e60294cSCristian Marussi * can be a subset of all the axes. 4828e60294cSCristian Marussi */ 4838e60294cSCristian Marussi a = &apriv->s->axis[axis_id]; 484802b0bedSCristian Marussi strscpy(a->name, adesc->name, SCMI_MAX_STR_SIZE); 485802b0bedSCristian Marussi st->priv = ++adesc; 486802b0bedSCristian Marussi 487802b0bedSCristian Marussi return 0; 488802b0bedSCristian Marussi } 489802b0bedSCristian Marussi 490802b0bedSCristian Marussi static int 491802b0bedSCristian Marussi scmi_sensor_axis_extended_names_get(const struct scmi_protocol_handle *ph, 4921fe00b8bSCristian Marussi struct scmi_sensor_info *s) 4931fe00b8bSCristian Marussi { 4948e60294cSCristian Marussi int ret; 4957cab5377SCristian Marussi void *iter; 4967cab5377SCristian Marussi struct scmi_iterator_ops ops = { 4977cab5377SCristian Marussi .prepare_message = iter_axes_desc_prepare_message, 498802b0bedSCristian Marussi .update_state = iter_axes_extended_name_update_state, 499802b0bedSCristian Marussi .process_response = iter_axes_extended_name_process_response, 500802b0bedSCristian Marussi }; 5018e60294cSCristian Marussi struct scmi_apriv apriv = { 5028e60294cSCristian Marussi .any_axes_support_extended_names = false, 5038e60294cSCristian Marussi .s = s, 5048e60294cSCristian Marussi }; 505802b0bedSCristian Marussi 506802b0bedSCristian Marussi iter = ph->hops->iter_response_init(ph, &ops, s->num_axis, 507802b0bedSCristian Marussi SENSOR_AXIS_NAME_GET, 508d0c94befSCristian Marussi sizeof(struct scmi_msg_sensor_axis_description_get), 5098e60294cSCristian Marussi &apriv); 510802b0bedSCristian Marussi if (IS_ERR(iter)) 511802b0bedSCristian Marussi return PTR_ERR(iter); 512802b0bedSCristian Marussi 5138e60294cSCristian Marussi /* 5148e60294cSCristian Marussi * Do not cause whole protocol initialization failure when failing to 5158e60294cSCristian Marussi * get extended names for axes. 5168e60294cSCristian Marussi */ 5178e60294cSCristian Marussi ret = ph->hops->iter_response_run(iter); 5188e60294cSCristian Marussi if (ret) 5198e60294cSCristian Marussi dev_warn(ph->dev, 5208e60294cSCristian Marussi "Failed to get axes extended names for %s (ret:%d).\n", 5218e60294cSCristian Marussi s->name, ret); 5228e60294cSCristian Marussi 5238e60294cSCristian Marussi return 0; 524802b0bedSCristian Marussi } 525802b0bedSCristian Marussi 526802b0bedSCristian Marussi static int scmi_sensor_axis_description(const struct scmi_protocol_handle *ph, 527802b0bedSCristian Marussi struct scmi_sensor_info *s, 528802b0bedSCristian Marussi u32 version) 529802b0bedSCristian Marussi { 530802b0bedSCristian Marussi int ret; 531802b0bedSCristian Marussi void *iter; 532802b0bedSCristian Marussi struct scmi_iterator_ops ops = { 533802b0bedSCristian Marussi .prepare_message = iter_axes_desc_prepare_message, 5347cab5377SCristian Marussi .update_state = iter_axes_desc_update_state, 5357cab5377SCristian Marussi .process_response = iter_axes_desc_process_response, 5367cab5377SCristian Marussi }; 5378e60294cSCristian Marussi struct scmi_apriv apriv = { 5388e60294cSCristian Marussi .any_axes_support_extended_names = false, 5398e60294cSCristian Marussi .s = s, 5408e60294cSCristian Marussi }; 5411fe00b8bSCristian Marussi 5429694a7f6SCristian Marussi s->axis = devm_kcalloc(ph->dev, s->num_axis, 5431fe00b8bSCristian Marussi sizeof(*s->axis), GFP_KERNEL); 5441fe00b8bSCristian Marussi if (!s->axis) 5451fe00b8bSCristian Marussi return -ENOMEM; 5461fe00b8bSCristian Marussi 5477cab5377SCristian Marussi iter = ph->hops->iter_response_init(ph, &ops, s->num_axis, 5487cab5377SCristian Marussi SENSOR_AXIS_DESCRIPTION_GET, 549d0c94befSCristian Marussi sizeof(struct scmi_msg_sensor_axis_description_get), 5508e60294cSCristian Marussi &apriv); 5517cab5377SCristian Marussi if (IS_ERR(iter)) 5527cab5377SCristian Marussi return PTR_ERR(iter); 5531fe00b8bSCristian Marussi 554802b0bedSCristian Marussi ret = ph->hops->iter_response_run(iter); 555802b0bedSCristian Marussi if (ret) 556802b0bedSCristian Marussi return ret; 557802b0bedSCristian Marussi 5588e60294cSCristian Marussi if (PROTOCOL_REV_MAJOR(version) >= 0x3 && 5598e60294cSCristian Marussi apriv.any_axes_support_extended_names) 560802b0bedSCristian Marussi ret = scmi_sensor_axis_extended_names_get(ph, s); 561802b0bedSCristian Marussi 562802b0bedSCristian Marussi return ret; 5631fe00b8bSCristian Marussi } 5641fe00b8bSCristian Marussi 5657cab5377SCristian Marussi static void iter_sens_descr_prepare_message(void *message, 5667cab5377SCristian Marussi unsigned int desc_index, 5677cab5377SCristian Marussi const void *priv) 5685179c523SSudeep Holla { 5697cab5377SCristian Marussi struct scmi_msg_sensor_description *msg = message; 5705179c523SSudeep Holla 5717cab5377SCristian Marussi msg->desc_index = cpu_to_le32(desc_index); 5725179c523SSudeep Holla } 5735179c523SSudeep Holla 5747cab5377SCristian Marussi static int iter_sens_descr_update_state(struct scmi_iterator_state *st, 5757cab5377SCristian Marussi const void *response, void *priv) 5767cab5377SCristian Marussi { 5777cab5377SCristian Marussi const struct scmi_msg_resp_sensor_description *r = response; 5785179c523SSudeep Holla 5797cab5377SCristian Marussi st->num_returned = le16_to_cpu(r->num_returned); 5807cab5377SCristian Marussi st->num_remaining = le16_to_cpu(r->num_remaining); 5817cab5377SCristian Marussi st->priv = (void *)&r->desc[0]; 5827cab5377SCristian Marussi 5837cab5377SCristian Marussi return 0; 5847cab5377SCristian Marussi } 5857cab5377SCristian Marussi 5867cab5377SCristian Marussi static int 5877cab5377SCristian Marussi iter_sens_descr_process_response(const struct scmi_protocol_handle *ph, 5887cab5377SCristian Marussi const void *response, 5897cab5377SCristian Marussi struct scmi_iterator_state *st, void *priv) 5907cab5377SCristian Marussi 5917cab5377SCristian Marussi { 5927cab5377SCristian Marussi int ret = 0; 5937cab5377SCristian Marussi u32 attrh, attrl; 5947cab5377SCristian Marussi size_t dsize = SCMI_MSG_RESP_SENS_DESCR_BASE_SZ; 5957cab5377SCristian Marussi struct scmi_sensor_info *s; 5967cab5377SCristian Marussi struct sensors_info *si = priv; 5977cab5377SCristian Marussi const struct scmi_sensor_descriptor *sdesc = st->priv; 5987cab5377SCristian Marussi 5997cab5377SCristian Marussi s = &si->sensors[st->desc_index + st->loop_idx]; 6001fe00b8bSCristian Marussi s->id = le32_to_cpu(sdesc->id); 6011fe00b8bSCristian Marussi 6021fe00b8bSCristian Marussi attrl = le32_to_cpu(sdesc->attributes_low); 6031fe00b8bSCristian Marussi /* common bitfields parsing */ 604d09aac0eSSudeep Holla s->async = SUPPORTS_ASYNC_READ(attrl); 605d09aac0eSSudeep Holla s->num_trip_points = NUM_TRIP_POINTS(attrl); 6061fe00b8bSCristian Marussi /** 6071fe00b8bSCristian Marussi * only SCMIv3.0 specific bitfield below. 6081fe00b8bSCristian Marussi * Such bitfields are assumed to be zeroed on non 6091fe00b8bSCristian Marussi * relevant fw versions...assuming fw not buggy ! 6101fe00b8bSCristian Marussi */ 6117ac7932dSCristian Marussi if (si->notify_continuos_update_cmd) 6121fe00b8bSCristian Marussi s->update = SUPPORTS_UPDATE_NOTIFY(attrl); 6131fe00b8bSCristian Marussi s->timestamped = SUPPORTS_TIMESTAMP(attrl); 6141fe00b8bSCristian Marussi if (s->timestamped) 6157cab5377SCristian Marussi s->tstamp_scale = S32_EXT(SENSOR_TSTAMP_EXP(attrl)); 6167cab5377SCristian Marussi s->extended_scalar_attrs = SUPPORTS_EXTEND_ATTRS(attrl); 6171fe00b8bSCristian Marussi 6181fe00b8bSCristian Marussi attrh = le32_to_cpu(sdesc->attributes_high); 6191fe00b8bSCristian Marussi /* common bitfields parsing */ 6201fe00b8bSCristian Marussi s->scale = S32_EXT(SENSOR_SCALE(attrh)); 6211fe00b8bSCristian Marussi s->type = SENSOR_TYPE(attrh); 6221fe00b8bSCristian Marussi /* Use pre-allocated pool wherever possible */ 6231fe00b8bSCristian Marussi s->intervals.desc = s->intervals.prealloc_pool; 6241fe00b8bSCristian Marussi if (si->version == SCMIv2_SENSOR_PROTOCOL) { 6251fe00b8bSCristian Marussi s->intervals.segmented = false; 6261fe00b8bSCristian Marussi s->intervals.count = 1; 6271fe00b8bSCristian Marussi /* 6281fe00b8bSCristian Marussi * Convert SCMIv2.0 update interval format to 6291fe00b8bSCristian Marussi * SCMIv3.0 to be used as the common exposed 6301fe00b8bSCristian Marussi * descriptor, accessible via common macros. 6311fe00b8bSCristian Marussi */ 6327cab5377SCristian Marussi s->intervals.desc[0] = (SENSOR_UPDATE_BASE(attrh) << 5) | 6331fe00b8bSCristian Marussi SENSOR_UPDATE_SCALE(attrh); 6341fe00b8bSCristian Marussi } else { 6351fe00b8bSCristian Marussi /* 6361fe00b8bSCristian Marussi * From SCMIv3.0 update intervals are retrieved 6371fe00b8bSCristian Marussi * via a dedicated (optional) command. 6381fe00b8bSCristian Marussi * Since the command is optional, on error carry 6391fe00b8bSCristian Marussi * on without any update interval. 6401fe00b8bSCristian Marussi */ 6419694a7f6SCristian Marussi if (scmi_sensor_update_intervals(ph, s)) 6429694a7f6SCristian Marussi dev_dbg(ph->dev, 6431fe00b8bSCristian Marussi "Update Intervals not available for sensor ID:%d\n", 6441fe00b8bSCristian Marussi s->id); 6451fe00b8bSCristian Marussi } 6461fe00b8bSCristian Marussi /** 6471fe00b8bSCristian Marussi * only > SCMIv2.0 specific bitfield below. 6481fe00b8bSCristian Marussi * Such bitfields are assumed to be zeroed on non 6491fe00b8bSCristian Marussi * relevant fw versions...assuming fw not buggy ! 6501fe00b8bSCristian Marussi */ 6511fe00b8bSCristian Marussi s->num_axis = min_t(unsigned int, 6521fe00b8bSCristian Marussi SUPPORTS_AXIS(attrh) ? 6531fe00b8bSCristian Marussi SENSOR_AXIS_NUMBER(attrh) : 0, 6541fe00b8bSCristian Marussi SCMI_MAX_NUM_SENSOR_AXIS); 6554314f9f4SCristian Marussi strscpy(s->name, sdesc->name, SCMI_SHORT_NAME_MAX_SIZE); 6561fe00b8bSCristian Marussi 657b260fccaSCristian Marussi /* 658b260fccaSCristian Marussi * If supported overwrite short name with the extended 659b260fccaSCristian Marussi * one; on error just carry on and use already provided 660b260fccaSCristian Marussi * short name. 661b260fccaSCristian Marussi */ 662b260fccaSCristian Marussi if (PROTOCOL_REV_MAJOR(si->version) >= 0x3 && 663b260fccaSCristian Marussi SUPPORTS_EXTENDED_NAMES(attrl)) 6647cab5377SCristian Marussi ph->hops->extended_name_get(ph, SENSOR_NAME_GET, s->id, 665e4e6e8f1SCristian Marussi NULL, s->name, SCMI_MAX_STR_SIZE); 666b260fccaSCristian Marussi 6671fe00b8bSCristian Marussi if (s->extended_scalar_attrs) { 6681fe00b8bSCristian Marussi s->sensor_power = le32_to_cpu(sdesc->power); 6691fe00b8bSCristian Marussi dsize += sizeof(sdesc->power); 6707cab5377SCristian Marussi 6711fe00b8bSCristian Marussi /* Only for sensors reporting scalar values */ 6721fe00b8bSCristian Marussi if (s->num_axis == 0) { 6737cab5377SCristian Marussi unsigned int sres = le32_to_cpu(sdesc->resolution); 6741fe00b8bSCristian Marussi 6751fe00b8bSCristian Marussi s->resolution = SENSOR_RES(sres); 6767cab5377SCristian Marussi s->exponent = S32_EXT(SENSOR_RES_EXP(sres)); 6771fe00b8bSCristian Marussi dsize += sizeof(sdesc->resolution); 6781fe00b8bSCristian Marussi 6791fe00b8bSCristian Marussi scmi_parse_range_attrs(&s->scalar_attrs, 6801fe00b8bSCristian Marussi &sdesc->scalar_attrs); 6811fe00b8bSCristian Marussi dsize += sizeof(sdesc->scalar_attrs); 6821fe00b8bSCristian Marussi } 6831fe00b8bSCristian Marussi } 6847cab5377SCristian Marussi 6857cab5377SCristian Marussi if (s->num_axis > 0) 686802b0bedSCristian Marussi ret = scmi_sensor_axis_description(ph, s, si->version); 6871fe00b8bSCristian Marussi 6887cab5377SCristian Marussi st->priv = ((u8 *)sdesc + dsize); 6895179c523SSudeep Holla 6905179c523SSudeep Holla return ret; 6915179c523SSudeep Holla } 6925179c523SSudeep Holla 6937cab5377SCristian Marussi static int scmi_sensor_description_get(const struct scmi_protocol_handle *ph, 6947cab5377SCristian Marussi struct sensors_info *si) 6957cab5377SCristian Marussi { 6967cab5377SCristian Marussi void *iter; 6977cab5377SCristian Marussi struct scmi_iterator_ops ops = { 6987cab5377SCristian Marussi .prepare_message = iter_sens_descr_prepare_message, 6997cab5377SCristian Marussi .update_state = iter_sens_descr_update_state, 7007cab5377SCristian Marussi .process_response = iter_sens_descr_process_response, 7017cab5377SCristian Marussi }; 7027cab5377SCristian Marussi 7037cab5377SCristian Marussi iter = ph->hops->iter_response_init(ph, &ops, si->num_sensors, 7047cab5377SCristian Marussi SENSOR_DESCRIPTION_GET, 7057cab5377SCristian Marussi sizeof(__le32), si); 7067cab5377SCristian Marussi if (IS_ERR(iter)) 7077cab5377SCristian Marussi return PTR_ERR(iter); 7087cab5377SCristian Marussi 7097cab5377SCristian Marussi return ph->hops->iter_response_run(iter); 7107cab5377SCristian Marussi } 7117cab5377SCristian Marussi 712e3811190SCristian Marussi static inline int 7139694a7f6SCristian Marussi scmi_sensor_request_notify(const struct scmi_protocol_handle *ph, u32 sensor_id, 714e3811190SCristian Marussi u8 message_id, bool enable) 7155179c523SSudeep Holla { 7165179c523SSudeep Holla int ret; 717e3811190SCristian Marussi u32 evt_cntl = enable ? SENSOR_NOTIFY_ALL : 0; 7185179c523SSudeep Holla struct scmi_xfer *t; 719e3811190SCristian Marussi struct scmi_msg_sensor_request_notify *cfg; 7205179c523SSudeep Holla 7219694a7f6SCristian Marussi ret = ph->xops->xfer_get_init(ph, message_id, sizeof(*cfg), 0, &t); 7225179c523SSudeep Holla if (ret) 7235179c523SSudeep Holla return ret; 7245179c523SSudeep Holla 7255179c523SSudeep Holla cfg = t->tx.buf; 7265179c523SSudeep Holla cfg->id = cpu_to_le32(sensor_id); 7275179c523SSudeep Holla cfg->event_control = cpu_to_le32(evt_cntl); 7285179c523SSudeep Holla 7299694a7f6SCristian Marussi ret = ph->xops->do_xfer(ph, t); 7305179c523SSudeep Holla 7319694a7f6SCristian Marussi ph->xops->xfer_put(ph, t); 7325179c523SSudeep Holla return ret; 7335179c523SSudeep Holla } 7345179c523SSudeep Holla 7359694a7f6SCristian Marussi static int scmi_sensor_trip_point_notify(const struct scmi_protocol_handle *ph, 736e3811190SCristian Marussi u32 sensor_id, bool enable) 737e3811190SCristian Marussi { 7389694a7f6SCristian Marussi return scmi_sensor_request_notify(ph, sensor_id, 739e3811190SCristian Marussi SENSOR_TRIP_POINT_NOTIFY, 740e3811190SCristian Marussi enable); 741e3811190SCristian Marussi } 742e3811190SCristian Marussi 743e3811190SCristian Marussi static int 7449694a7f6SCristian Marussi scmi_sensor_continuous_update_notify(const struct scmi_protocol_handle *ph, 745e3811190SCristian Marussi u32 sensor_id, bool enable) 746e3811190SCristian Marussi { 7479694a7f6SCristian Marussi return scmi_sensor_request_notify(ph, sensor_id, 748e3811190SCristian Marussi SENSOR_CONTINUOUS_UPDATE_NOTIFY, 749e3811190SCristian Marussi enable); 750e3811190SCristian Marussi } 751e3811190SCristian Marussi 7529eefa43aSSudeep Holla static int 7539694a7f6SCristian Marussi scmi_sensor_trip_point_config(const struct scmi_protocol_handle *ph, 7549694a7f6SCristian Marussi u32 sensor_id, u8 trip_id, u64 trip_value) 7555179c523SSudeep Holla { 7565179c523SSudeep Holla int ret; 7575179c523SSudeep Holla u32 evt_cntl = SENSOR_TP_BOTH; 7585179c523SSudeep Holla struct scmi_xfer *t; 7595179c523SSudeep Holla struct scmi_msg_set_sensor_trip_point *trip; 7605179c523SSudeep Holla 7619694a7f6SCristian Marussi ret = ph->xops->xfer_get_init(ph, SENSOR_TRIP_POINT_CONFIG, 7629694a7f6SCristian Marussi sizeof(*trip), 0, &t); 7635179c523SSudeep Holla if (ret) 7645179c523SSudeep Holla return ret; 7655179c523SSudeep Holla 7665179c523SSudeep Holla trip = t->tx.buf; 7675179c523SSudeep Holla trip->id = cpu_to_le32(sensor_id); 7685179c523SSudeep Holla trip->event_control = cpu_to_le32(evt_cntl | SENSOR_TP_ID(trip_id)); 7695179c523SSudeep Holla trip->value_low = cpu_to_le32(trip_value & 0xffffffff); 7705179c523SSudeep Holla trip->value_high = cpu_to_le32(trip_value >> 32); 7715179c523SSudeep Holla 7729694a7f6SCristian Marussi ret = ph->xops->do_xfer(ph, t); 7735179c523SSudeep Holla 7749694a7f6SCristian Marussi ph->xops->xfer_put(ph, t); 7755179c523SSudeep Holla return ret; 7765179c523SSudeep Holla } 7775179c523SSudeep Holla 7789694a7f6SCristian Marussi static int scmi_sensor_config_get(const struct scmi_protocol_handle *ph, 7797b83c5f4SCristian Marussi u32 sensor_id, u32 *sensor_config) 7807b83c5f4SCristian Marussi { 7817b83c5f4SCristian Marussi int ret; 7827b83c5f4SCristian Marussi struct scmi_xfer *t; 78376f89c95SCristian Marussi struct sensors_info *si = ph->get_priv(ph); 78476f89c95SCristian Marussi 78576f89c95SCristian Marussi if (sensor_id >= si->num_sensors) 78676f89c95SCristian Marussi return -EINVAL; 7877b83c5f4SCristian Marussi 7889694a7f6SCristian Marussi ret = ph->xops->xfer_get_init(ph, SENSOR_CONFIG_GET, 7899694a7f6SCristian Marussi sizeof(__le32), sizeof(__le32), &t); 7907b83c5f4SCristian Marussi if (ret) 7917b83c5f4SCristian Marussi return ret; 7927b83c5f4SCristian Marussi 793bd074e50SCristian Marussi put_unaligned_le32(sensor_id, t->tx.buf); 7949694a7f6SCristian Marussi ret = ph->xops->do_xfer(ph, t); 7957b83c5f4SCristian Marussi if (!ret) { 7967b83c5f4SCristian Marussi struct scmi_sensor_info *s = si->sensors + sensor_id; 7977b83c5f4SCristian Marussi 7987b83c5f4SCristian Marussi *sensor_config = get_unaligned_le64(t->rx.buf); 7997b83c5f4SCristian Marussi s->sensor_config = *sensor_config; 8007b83c5f4SCristian Marussi } 8017b83c5f4SCristian Marussi 8029694a7f6SCristian Marussi ph->xops->xfer_put(ph, t); 8037b83c5f4SCristian Marussi return ret; 8047b83c5f4SCristian Marussi } 8057b83c5f4SCristian Marussi 8069694a7f6SCristian Marussi static int scmi_sensor_config_set(const struct scmi_protocol_handle *ph, 8077b83c5f4SCristian Marussi u32 sensor_id, u32 sensor_config) 8087b83c5f4SCristian Marussi { 8097b83c5f4SCristian Marussi int ret; 8107b83c5f4SCristian Marussi struct scmi_xfer *t; 8117b83c5f4SCristian Marussi struct scmi_msg_sensor_config_set *msg; 81276f89c95SCristian Marussi struct sensors_info *si = ph->get_priv(ph); 81376f89c95SCristian Marussi 81476f89c95SCristian Marussi if (sensor_id >= si->num_sensors) 81576f89c95SCristian Marussi return -EINVAL; 8167b83c5f4SCristian Marussi 8179694a7f6SCristian Marussi ret = ph->xops->xfer_get_init(ph, SENSOR_CONFIG_SET, 8189694a7f6SCristian Marussi sizeof(*msg), 0, &t); 8197b83c5f4SCristian Marussi if (ret) 8207b83c5f4SCristian Marussi return ret; 8217b83c5f4SCristian Marussi 8227b83c5f4SCristian Marussi msg = t->tx.buf; 8237b83c5f4SCristian Marussi msg->id = cpu_to_le32(sensor_id); 8247b83c5f4SCristian Marussi msg->sensor_config = cpu_to_le32(sensor_config); 8257b83c5f4SCristian Marussi 8269694a7f6SCristian Marussi ret = ph->xops->do_xfer(ph, t); 8277b83c5f4SCristian Marussi if (!ret) { 8287b83c5f4SCristian Marussi struct scmi_sensor_info *s = si->sensors + sensor_id; 8297b83c5f4SCristian Marussi 8307b83c5f4SCristian Marussi s->sensor_config = sensor_config; 8317b83c5f4SCristian Marussi } 8327b83c5f4SCristian Marussi 8339694a7f6SCristian Marussi ph->xops->xfer_put(ph, t); 8347b83c5f4SCristian Marussi return ret; 8357b83c5f4SCristian Marussi } 8367b83c5f4SCristian Marussi 837e2083d36SCristian Marussi /** 838e2083d36SCristian Marussi * scmi_sensor_reading_get - Read scalar sensor value 8399694a7f6SCristian Marussi * @ph: Protocol handle 840e2083d36SCristian Marussi * @sensor_id: Sensor ID 841e2083d36SCristian Marussi * @value: The 64bit value sensor reading 842e2083d36SCristian Marussi * 843e2083d36SCristian Marussi * This function returns a single 64 bit reading value representing the sensor 844e2083d36SCristian Marussi * value; if the platform SCMI Protocol implementation and the sensor support 845e2083d36SCristian Marussi * multiple axis and timestamped-reads, this just returns the first axis while 846e2083d36SCristian Marussi * dropping the timestamp value. 847e2083d36SCristian Marussi * Use instead the @scmi_sensor_reading_get_timestamped to retrieve the array of 848e2083d36SCristian Marussi * timestamped multi-axis values. 849e2083d36SCristian Marussi * 850e2083d36SCristian Marussi * Return: 0 on Success 851e2083d36SCristian Marussi */ 8529694a7f6SCristian Marussi static int scmi_sensor_reading_get(const struct scmi_protocol_handle *ph, 8536a55331cSSudeep Holla u32 sensor_id, u64 *value) 8545179c523SSudeep Holla { 8555179c523SSudeep Holla int ret; 8565179c523SSudeep Holla struct scmi_xfer *t; 8575179c523SSudeep Holla struct scmi_msg_sensor_reading_get *sensor; 85876f89c95SCristian Marussi struct scmi_sensor_info *s; 8599694a7f6SCristian Marussi struct sensors_info *si = ph->get_priv(ph); 86076f89c95SCristian Marussi 86176f89c95SCristian Marussi if (sensor_id >= si->num_sensors) 86276f89c95SCristian Marussi return -EINVAL; 8635179c523SSudeep Holla 8649694a7f6SCristian Marussi ret = ph->xops->xfer_get_init(ph, SENSOR_READING_GET, 8659694a7f6SCristian Marussi sizeof(*sensor), 0, &t); 8665179c523SSudeep Holla if (ret) 8675179c523SSudeep Holla return ret; 8685179c523SSudeep Holla 8695179c523SSudeep Holla sensor = t->tx.buf; 8705179c523SSudeep Holla sensor->id = cpu_to_le32(sensor_id); 87176f89c95SCristian Marussi s = si->sensors + sensor_id; 872d09aac0eSSudeep Holla if (s->async) { 873d09aac0eSSudeep Holla sensor->flags = cpu_to_le32(SENSOR_READ_ASYNC); 8749694a7f6SCristian Marussi ret = ph->xops->do_xfer_with_response(ph, t); 875e2083d36SCristian Marussi if (!ret) { 876e2083d36SCristian Marussi struct scmi_resp_sensor_reading_complete *resp; 877e2083d36SCristian Marussi 878e2083d36SCristian Marussi resp = t->rx.buf; 879e2083d36SCristian Marussi if (le32_to_cpu(resp->id) == sensor_id) 880187a002bSCristian Marussi *value = 881187a002bSCristian Marussi get_unaligned_le64(&resp->readings_low); 882e2083d36SCristian Marussi else 883e2083d36SCristian Marussi ret = -EPROTO; 884e2083d36SCristian Marussi } 885d09aac0eSSudeep Holla } else { 886d09aac0eSSudeep Holla sensor->flags = cpu_to_le32(0); 8879694a7f6SCristian Marussi ret = ph->xops->do_xfer(ph, t); 888aa90ac45SSudeep Holla if (!ret) 889aa90ac45SSudeep Holla *value = get_unaligned_le64(t->rx.buf); 890d09aac0eSSudeep Holla } 8915179c523SSudeep Holla 8929694a7f6SCristian Marussi ph->xops->xfer_put(ph, t); 8935179c523SSudeep Holla return ret; 8945179c523SSudeep Holla } 8955179c523SSudeep Holla 896e2083d36SCristian Marussi static inline void 897e2083d36SCristian Marussi scmi_parse_sensor_readings(struct scmi_sensor_reading *out, 898e945927dSCristian Marussi const struct scmi_sensor_reading_resp *in) 899e2083d36SCristian Marussi { 900e2083d36SCristian Marussi out->value = get_unaligned_le64((void *)&in->sensor_value_low); 901e2083d36SCristian Marussi out->timestamp = get_unaligned_le64((void *)&in->timestamp_low); 902e2083d36SCristian Marussi } 903e2083d36SCristian Marussi 904e2083d36SCristian Marussi /** 905e2083d36SCristian Marussi * scmi_sensor_reading_get_timestamped - Read multiple-axis timestamped values 9069694a7f6SCristian Marussi * @ph: Protocol handle 907e2083d36SCristian Marussi * @sensor_id: Sensor ID 908e2083d36SCristian Marussi * @count: The length of the provided @readings array 909e2083d36SCristian Marussi * @readings: An array of elements each representing a timestamped per-axis 910e2083d36SCristian Marussi * reading of type @struct scmi_sensor_reading. 911e2083d36SCristian Marussi * Returned readings are ordered as the @axis descriptors array 912e2083d36SCristian Marussi * included in @struct scmi_sensor_info and the max number of 913e2083d36SCristian Marussi * returned elements is min(@count, @num_axis); ideally the provided 914e2083d36SCristian Marussi * array should be of length @count equal to @num_axis. 915e2083d36SCristian Marussi * 916e2083d36SCristian Marussi * Return: 0 on Success 917e2083d36SCristian Marussi */ 918e2083d36SCristian Marussi static int 9199694a7f6SCristian Marussi scmi_sensor_reading_get_timestamped(const struct scmi_protocol_handle *ph, 920e2083d36SCristian Marussi u32 sensor_id, u8 count, 921e2083d36SCristian Marussi struct scmi_sensor_reading *readings) 922e2083d36SCristian Marussi { 923e2083d36SCristian Marussi int ret; 924e2083d36SCristian Marussi struct scmi_xfer *t; 925e2083d36SCristian Marussi struct scmi_msg_sensor_reading_get *sensor; 92676f89c95SCristian Marussi struct scmi_sensor_info *s; 9279694a7f6SCristian Marussi struct sensors_info *si = ph->get_priv(ph); 928e2083d36SCristian Marussi 92976f89c95SCristian Marussi if (sensor_id >= si->num_sensors) 93076f89c95SCristian Marussi return -EINVAL; 93176f89c95SCristian Marussi 93276f89c95SCristian Marussi s = si->sensors + sensor_id; 933e2083d36SCristian Marussi if (!count || !readings || 934e2083d36SCristian Marussi (!s->num_axis && count > 1) || (s->num_axis && count > s->num_axis)) 935e2083d36SCristian Marussi return -EINVAL; 936e2083d36SCristian Marussi 9379694a7f6SCristian Marussi ret = ph->xops->xfer_get_init(ph, SENSOR_READING_GET, 9389694a7f6SCristian Marussi sizeof(*sensor), 0, &t); 939e2083d36SCristian Marussi if (ret) 940e2083d36SCristian Marussi return ret; 941e2083d36SCristian Marussi 942e2083d36SCristian Marussi sensor = t->tx.buf; 943e2083d36SCristian Marussi sensor->id = cpu_to_le32(sensor_id); 944e2083d36SCristian Marussi if (s->async) { 945e2083d36SCristian Marussi sensor->flags = cpu_to_le32(SENSOR_READ_ASYNC); 9469694a7f6SCristian Marussi ret = ph->xops->do_xfer_with_response(ph, t); 947e2083d36SCristian Marussi if (!ret) { 948e2083d36SCristian Marussi int i; 949e2083d36SCristian Marussi struct scmi_resp_sensor_reading_complete_v3 *resp; 950e2083d36SCristian Marussi 951e2083d36SCristian Marussi resp = t->rx.buf; 952e2083d36SCristian Marussi /* Retrieve only the number of requested axis anyway */ 953e2083d36SCristian Marussi if (le32_to_cpu(resp->id) == sensor_id) 954e2083d36SCristian Marussi for (i = 0; i < count; i++) 955e2083d36SCristian Marussi scmi_parse_sensor_readings(&readings[i], 956e2083d36SCristian Marussi &resp->readings[i]); 957e2083d36SCristian Marussi else 958e2083d36SCristian Marussi ret = -EPROTO; 959e2083d36SCristian Marussi } 960e2083d36SCristian Marussi } else { 961e2083d36SCristian Marussi sensor->flags = cpu_to_le32(0); 9629694a7f6SCristian Marussi ret = ph->xops->do_xfer(ph, t); 963e2083d36SCristian Marussi if (!ret) { 964e2083d36SCristian Marussi int i; 965e945927dSCristian Marussi struct scmi_sensor_reading_resp *resp_readings; 966e2083d36SCristian Marussi 967e2083d36SCristian Marussi resp_readings = t->rx.buf; 968e2083d36SCristian Marussi for (i = 0; i < count; i++) 969e2083d36SCristian Marussi scmi_parse_sensor_readings(&readings[i], 970e2083d36SCristian Marussi &resp_readings[i]); 971e2083d36SCristian Marussi } 972e2083d36SCristian Marussi } 973e2083d36SCristian Marussi 9749694a7f6SCristian Marussi ph->xops->xfer_put(ph, t); 975e2083d36SCristian Marussi return ret; 976e2083d36SCristian Marussi } 977e2083d36SCristian Marussi 9789694a7f6SCristian Marussi static const struct scmi_sensor_info * 9799694a7f6SCristian Marussi scmi_sensor_info_get(const struct scmi_protocol_handle *ph, u32 sensor_id) 9809694a7f6SCristian Marussi { 9819694a7f6SCristian Marussi struct sensors_info *si = ph->get_priv(ph); 9825179c523SSudeep Holla 9831ecb7d27SCristian Marussi if (sensor_id >= si->num_sensors) 9841ecb7d27SCristian Marussi return NULL; 9851ecb7d27SCristian Marussi 9865179c523SSudeep Holla return si->sensors + sensor_id; 9875179c523SSudeep Holla } 9885179c523SSudeep Holla 9899694a7f6SCristian Marussi static int scmi_sensor_count_get(const struct scmi_protocol_handle *ph) 9909694a7f6SCristian Marussi { 9919694a7f6SCristian Marussi struct sensors_info *si = ph->get_priv(ph); 9925179c523SSudeep Holla 9935179c523SSudeep Holla return si->num_sensors; 9945179c523SSudeep Holla } 9955179c523SSudeep Holla 9969694a7f6SCristian Marussi static const struct scmi_sensor_proto_ops sensor_proto_ops = { 9975179c523SSudeep Holla .count_get = scmi_sensor_count_get, 9985179c523SSudeep Holla .info_get = scmi_sensor_info_get, 9999eefa43aSSudeep Holla .trip_point_config = scmi_sensor_trip_point_config, 10005179c523SSudeep Holla .reading_get = scmi_sensor_reading_get, 1001e2083d36SCristian Marussi .reading_get_timestamped = scmi_sensor_reading_get_timestamped, 10027b83c5f4SCristian Marussi .config_get = scmi_sensor_config_get, 10037b83c5f4SCristian Marussi .config_set = scmi_sensor_config_set, 10045179c523SSudeep Holla }; 10055179c523SSudeep Holla 10067ac7932dSCristian Marussi static bool scmi_sensor_notify_supported(const struct scmi_protocol_handle *ph, 10077ac7932dSCristian Marussi u8 evt_id, u32 src_id) 10087ac7932dSCristian Marussi { 10097ac7932dSCristian Marussi bool supported = false; 10107ac7932dSCristian Marussi const struct scmi_sensor_info *s; 10117ac7932dSCristian Marussi struct sensors_info *sinfo = ph->get_priv(ph); 10127ac7932dSCristian Marussi 10137ac7932dSCristian Marussi s = scmi_sensor_info_get(ph, src_id); 10147ac7932dSCristian Marussi if (!s) 10157ac7932dSCristian Marussi return false; 10167ac7932dSCristian Marussi 10177ac7932dSCristian Marussi if (evt_id == SCMI_EVENT_SENSOR_TRIP_POINT_EVENT) 10187ac7932dSCristian Marussi supported = sinfo->notify_trip_point_cmd; 10197ac7932dSCristian Marussi else if (evt_id == SCMI_EVENT_SENSOR_UPDATE) 10207ac7932dSCristian Marussi supported = s->update; 10217ac7932dSCristian Marussi 10227ac7932dSCristian Marussi return supported; 10237ac7932dSCristian Marussi } 10247ac7932dSCristian Marussi 10253cb8c95fSCristian Marussi static int scmi_sensor_set_notify_enabled(const struct scmi_protocol_handle *ph, 1026128e3e93SCristian Marussi u8 evt_id, u32 src_id, bool enable) 1027128e3e93SCristian Marussi { 1028128e3e93SCristian Marussi int ret; 1029128e3e93SCristian Marussi 1030e3811190SCristian Marussi switch (evt_id) { 1031e3811190SCristian Marussi case SCMI_EVENT_SENSOR_TRIP_POINT_EVENT: 10329694a7f6SCristian Marussi ret = scmi_sensor_trip_point_notify(ph, src_id, enable); 1033e3811190SCristian Marussi break; 1034e3811190SCristian Marussi case SCMI_EVENT_SENSOR_UPDATE: 10359694a7f6SCristian Marussi ret = scmi_sensor_continuous_update_notify(ph, src_id, enable); 1036e3811190SCristian Marussi break; 1037e3811190SCristian Marussi default: 1038e3811190SCristian Marussi ret = -EINVAL; 1039e3811190SCristian Marussi break; 1040e3811190SCristian Marussi } 1041e3811190SCristian Marussi 1042128e3e93SCristian Marussi if (ret) 1043128e3e93SCristian Marussi pr_debug("FAIL_ENABLED - evt[%X] dom[%d] - ret:%d\n", 1044128e3e93SCristian Marussi evt_id, src_id, ret); 1045128e3e93SCristian Marussi 1046128e3e93SCristian Marussi return ret; 1047128e3e93SCristian Marussi } 1048128e3e93SCristian Marussi 10493cb8c95fSCristian Marussi static void * 10503cb8c95fSCristian Marussi scmi_sensor_fill_custom_report(const struct scmi_protocol_handle *ph, 105172a5eb9dSCristian Marussi u8 evt_id, ktime_t timestamp, 1052128e3e93SCristian Marussi const void *payld, size_t payld_sz, 1053128e3e93SCristian Marussi void *report, u32 *src_id) 1054128e3e93SCristian Marussi { 1055e3811190SCristian Marussi void *rep = NULL; 1056e3811190SCristian Marussi 1057e3811190SCristian Marussi switch (evt_id) { 1058e3811190SCristian Marussi case SCMI_EVENT_SENSOR_TRIP_POINT_EVENT: 1059e3811190SCristian Marussi { 1060128e3e93SCristian Marussi const struct scmi_sensor_trip_notify_payld *p = payld; 1061128e3e93SCristian Marussi struct scmi_sensor_trip_point_report *r = report; 1062128e3e93SCristian Marussi 1063e3811190SCristian Marussi if (sizeof(*p) != payld_sz) 1064e3811190SCristian Marussi break; 1065128e3e93SCristian Marussi 1066128e3e93SCristian Marussi r->timestamp = timestamp; 1067128e3e93SCristian Marussi r->agent_id = le32_to_cpu(p->agent_id); 1068128e3e93SCristian Marussi r->sensor_id = le32_to_cpu(p->sensor_id); 1069128e3e93SCristian Marussi r->trip_point_desc = le32_to_cpu(p->trip_point_desc); 1070128e3e93SCristian Marussi *src_id = r->sensor_id; 1071e3811190SCristian Marussi rep = r; 1072e3811190SCristian Marussi break; 1073e3811190SCristian Marussi } 1074e3811190SCristian Marussi case SCMI_EVENT_SENSOR_UPDATE: 1075e3811190SCristian Marussi { 1076e3811190SCristian Marussi int i; 1077e3811190SCristian Marussi struct scmi_sensor_info *s; 1078e3811190SCristian Marussi const struct scmi_sensor_update_notify_payld *p = payld; 1079e3811190SCristian Marussi struct scmi_sensor_update_report *r = report; 10803cb8c95fSCristian Marussi struct sensors_info *sinfo = ph->get_priv(ph); 1081128e3e93SCristian Marussi 1082e3811190SCristian Marussi /* payld_sz is variable for this event */ 1083e3811190SCristian Marussi r->sensor_id = le32_to_cpu(p->sensor_id); 1084e3811190SCristian Marussi if (r->sensor_id >= sinfo->num_sensors) 1085e3811190SCristian Marussi break; 1086e3811190SCristian Marussi r->timestamp = timestamp; 1087e3811190SCristian Marussi r->agent_id = le32_to_cpu(p->agent_id); 1088e3811190SCristian Marussi s = &sinfo->sensors[r->sensor_id]; 1089e3811190SCristian Marussi /* 1090e3811190SCristian Marussi * The generated report r (@struct scmi_sensor_update_report) 1091e3811190SCristian Marussi * was pre-allocated to contain up to SCMI_MAX_NUM_SENSOR_AXIS 1092e3811190SCristian Marussi * readings: here it is filled with the effective @num_axis 1093e3811190SCristian Marussi * readings defined for this sensor or 1 for scalar sensors. 1094e3811190SCristian Marussi */ 1095e3811190SCristian Marussi r->readings_count = s->num_axis ?: 1; 1096e3811190SCristian Marussi for (i = 0; i < r->readings_count; i++) 1097e3811190SCristian Marussi scmi_parse_sensor_readings(&r->readings[i], 1098e3811190SCristian Marussi &p->readings[i]); 1099e3811190SCristian Marussi *src_id = r->sensor_id; 1100e3811190SCristian Marussi rep = r; 1101e3811190SCristian Marussi break; 1102e3811190SCristian Marussi } 1103e3811190SCristian Marussi default: 1104e3811190SCristian Marussi break; 1105e3811190SCristian Marussi } 1106e3811190SCristian Marussi 1107e3811190SCristian Marussi return rep; 1108128e3e93SCristian Marussi } 1109128e3e93SCristian Marussi 11103cb8c95fSCristian Marussi static int scmi_sensor_get_num_sources(const struct scmi_protocol_handle *ph) 1111533c7095SCristian Marussi { 11123cb8c95fSCristian Marussi struct sensors_info *si = ph->get_priv(ph); 1113533c7095SCristian Marussi 1114533c7095SCristian Marussi return si->num_sensors; 1115533c7095SCristian Marussi } 1116533c7095SCristian Marussi 1117128e3e93SCristian Marussi static const struct scmi_event sensor_events[] = { 1118128e3e93SCristian Marussi { 1119128e3e93SCristian Marussi .id = SCMI_EVENT_SENSOR_TRIP_POINT_EVENT, 1120128e3e93SCristian Marussi .max_payld_sz = sizeof(struct scmi_sensor_trip_notify_payld), 1121128e3e93SCristian Marussi .max_report_sz = sizeof(struct scmi_sensor_trip_point_report), 1122128e3e93SCristian Marussi }, 1123e3811190SCristian Marussi { 1124e3811190SCristian Marussi .id = SCMI_EVENT_SENSOR_UPDATE, 1125e3811190SCristian Marussi .max_payld_sz = 1126e3811190SCristian Marussi sizeof(struct scmi_sensor_update_notify_payld) + 1127e3811190SCristian Marussi SCMI_MAX_NUM_SENSOR_AXIS * 1128e945927dSCristian Marussi sizeof(struct scmi_sensor_reading_resp), 1129e3811190SCristian Marussi .max_report_sz = sizeof(struct scmi_sensor_update_report) + 1130e3811190SCristian Marussi SCMI_MAX_NUM_SENSOR_AXIS * 1131e3811190SCristian Marussi sizeof(struct scmi_sensor_reading), 1132e3811190SCristian Marussi }, 1133128e3e93SCristian Marussi }; 1134128e3e93SCristian Marussi 1135128e3e93SCristian Marussi static const struct scmi_event_ops sensor_event_ops = { 11367ac7932dSCristian Marussi .is_notify_supported = scmi_sensor_notify_supported, 1137533c7095SCristian Marussi .get_num_sources = scmi_sensor_get_num_sources, 1138128e3e93SCristian Marussi .set_notify_enabled = scmi_sensor_set_notify_enabled, 1139128e3e93SCristian Marussi .fill_custom_report = scmi_sensor_fill_custom_report, 1140128e3e93SCristian Marussi }; 1141128e3e93SCristian Marussi 1142533c7095SCristian Marussi static const struct scmi_protocol_events sensor_protocol_events = { 1143533c7095SCristian Marussi .queue_sz = SCMI_PROTO_QUEUE_SZ, 1144533c7095SCristian Marussi .ops = &sensor_event_ops, 1145533c7095SCristian Marussi .evts = sensor_events, 1146533c7095SCristian Marussi .num_events = ARRAY_SIZE(sensor_events), 1147533c7095SCristian Marussi }; 1148533c7095SCristian Marussi 11499694a7f6SCristian Marussi static int scmi_sensors_protocol_init(const struct scmi_protocol_handle *ph) 11505179c523SSudeep Holla { 11515179c523SSudeep Holla u32 version; 1152f25fb6deSCristian Marussi int ret; 11535179c523SSudeep Holla struct sensors_info *sinfo; 11545179c523SSudeep Holla 11554de1b36fSCristian Marussi ret = ph->xops->version_get(ph, &version); 11564de1b36fSCristian Marussi if (ret) 11574de1b36fSCristian Marussi return ret; 11585179c523SSudeep Holla 11599694a7f6SCristian Marussi dev_dbg(ph->dev, "Sensor Version %d.%d\n", 11605179c523SSudeep Holla PROTOCOL_REV_MAJOR(version), PROTOCOL_REV_MINOR(version)); 11615179c523SSudeep Holla 11629694a7f6SCristian Marussi sinfo = devm_kzalloc(ph->dev, sizeof(*sinfo), GFP_KERNEL); 11635179c523SSudeep Holla if (!sinfo) 11645179c523SSudeep Holla return -ENOMEM; 1165f25fb6deSCristian Marussi sinfo->version = version; 11665179c523SSudeep Holla 11679694a7f6SCristian Marussi ret = scmi_sensor_attributes_get(ph, sinfo); 1168f25fb6deSCristian Marussi if (ret) 1169f25fb6deSCristian Marussi return ret; 11709694a7f6SCristian Marussi sinfo->sensors = devm_kcalloc(ph->dev, sinfo->num_sensors, 11715179c523SSudeep Holla sizeof(*sinfo->sensors), GFP_KERNEL); 11725179c523SSudeep Holla if (!sinfo->sensors) 11735179c523SSudeep Holla return -ENOMEM; 11745179c523SSudeep Holla 11759694a7f6SCristian Marussi ret = scmi_sensor_description_get(ph, sinfo); 1176f25fb6deSCristian Marussi if (ret) 1177f25fb6deSCristian Marussi return ret; 11785179c523SSudeep Holla 1179b5efc28aSCristian Marussi return ph->set_priv(ph, sinfo, version); 11805179c523SSudeep Holla } 11815179c523SSudeep Holla 118248dc16e2SCristian Marussi static const struct scmi_protocol scmi_sensors = { 118348dc16e2SCristian Marussi .id = SCMI_PROTOCOL_SENSOR, 1184f5800e0bSCristian Marussi .owner = THIS_MODULE, 11859694a7f6SCristian Marussi .instance_init = &scmi_sensors_protocol_init, 11869694a7f6SCristian Marussi .ops = &sensor_proto_ops, 1187533c7095SCristian Marussi .events = &sensor_protocol_events, 1188b5efc28aSCristian Marussi .supported_version = SCMI_PROTOCOL_SUPPORTED_VERSION, 118948dc16e2SCristian Marussi }; 119048dc16e2SCristian Marussi 119148dc16e2SCristian Marussi DEFINE_SCMI_PROTOCOL_REGISTER_UNREGISTER(sensors, scmi_sensors) 1192