| Andrew Jeffery | 7992eb8 | 2023-04-06 16:13:53 +0930 | [diff] [blame] | 1 | #include "msgbuf/platform.h" | 
| Manojkiran Eda | 9a8e497 | 2022-11-28 16:38:21 +0530 | [diff] [blame] | 2 | #include "base.h" | 
| Andrew Jeffery | 7992eb8 | 2023-04-06 16:13:53 +0930 | [diff] [blame] | 3 | #include "msgbuf.h" | 
|  | 4 | #include "platform.h" | 
| Manojkiran Eda | 9a8e497 | 2022-11-28 16:38:21 +0530 | [diff] [blame] | 5 | #include "pldm_types.h" | 
| Andrew Jeffery | 9c76679 | 2022-08-10 23:12:49 +0930 | [diff] [blame] | 6 | #include <endian.h> | 
| Manojkiran Eda | 9a8e497 | 2022-11-28 16:38:21 +0530 | [diff] [blame] | 7 | #include <stdint.h> | 
| Andrew Jeffery | 9c76679 | 2022-08-10 23:12:49 +0930 | [diff] [blame] | 8 | #include <string.h> | 
|  | 9 |  | 
| Andrew Jeffery | 7992eb8 | 2023-04-06 16:13:53 +0930 | [diff] [blame] | 10 | static int pldm_platform_pdr_hdr_validate(struct pldm_value_pdr_hdr *ctx, | 
|  | 11 | size_t lower, size_t upper) | 
|  | 12 | { | 
|  | 13 | if (ctx->length + sizeof(*ctx) < lower) { | 
|  | 14 | return PLDM_ERROR_INVALID_LENGTH; | 
|  | 15 | } | 
|  | 16 |  | 
|  | 17 | if (ctx->length > upper) { | 
|  | 18 | return PLDM_ERROR_INVALID_LENGTH; | 
|  | 19 | } | 
|  | 20 |  | 
|  | 21 | return PLDM_SUCCESS; | 
|  | 22 | } | 
| Andrew Jeffery | 9c76679 | 2022-08-10 23:12:49 +0930 | [diff] [blame] | 23 |  | 
|  | 24 | int encode_state_effecter_pdr( | 
|  | 25 | struct pldm_state_effecter_pdr *const effecter, | 
|  | 26 | const size_t allocation_size, | 
|  | 27 | const struct state_effecter_possible_states *const possible_states, | 
|  | 28 | const size_t possible_states_size, size_t *const actual_size) | 
|  | 29 | { | 
|  | 30 | // Encode possible states | 
|  | 31 |  | 
|  | 32 | size_t calculated_possible_states_size = 0; | 
|  | 33 |  | 
|  | 34 | { | 
|  | 35 | char *states_ptr = (char *)possible_states; | 
|  | 36 | char *const begin_states_ptr = states_ptr; | 
|  | 37 |  | 
|  | 38 | for (int i = 0; i < effecter->composite_effecter_count; ++i) { | 
|  | 39 | struct state_effecter_possible_states *states = | 
|  | 40 | (struct state_effecter_possible_states *)states_ptr; | 
|  | 41 |  | 
|  | 42 | HTOLE16(states->state_set_id); | 
|  | 43 |  | 
|  | 44 | states_ptr += | 
|  | 45 | (sizeof(*states) - sizeof(states->states) + | 
|  | 46 | states->possible_states_size); | 
|  | 47 | } | 
|  | 48 |  | 
|  | 49 | calculated_possible_states_size = states_ptr - begin_states_ptr; | 
|  | 50 | } | 
|  | 51 |  | 
|  | 52 | // Check lengths | 
|  | 53 |  | 
|  | 54 | if (possible_states_size != calculated_possible_states_size) { | 
|  | 55 | *actual_size = 0; | 
|  | 56 | return PLDM_ERROR; | 
|  | 57 | } | 
|  | 58 |  | 
|  | 59 | *actual_size = | 
|  | 60 | (sizeof(struct pldm_state_effecter_pdr) + possible_states_size - | 
|  | 61 | sizeof(effecter->possible_states)); | 
|  | 62 |  | 
|  | 63 | if (allocation_size < *actual_size) { | 
|  | 64 | *actual_size = 0; | 
|  | 65 | return PLDM_ERROR_INVALID_LENGTH; | 
|  | 66 | } | 
|  | 67 |  | 
|  | 68 | // Encode rest of PDR | 
|  | 69 |  | 
|  | 70 | effecter->hdr.version = 1; | 
|  | 71 | effecter->hdr.type = PLDM_STATE_EFFECTER_PDR; | 
|  | 72 | effecter->hdr.length = *actual_size - sizeof(struct pldm_pdr_hdr); | 
|  | 73 |  | 
|  | 74 | memcpy(effecter->possible_states, possible_states, | 
|  | 75 | possible_states_size); | 
|  | 76 |  | 
|  | 77 | // Convert effecter PDR body | 
|  | 78 | HTOLE16(effecter->terminus_handle); | 
|  | 79 | HTOLE16(effecter->effecter_id); | 
|  | 80 | HTOLE16(effecter->entity_type); | 
|  | 81 | HTOLE16(effecter->entity_instance); | 
|  | 82 | HTOLE16(effecter->container_id); | 
|  | 83 | HTOLE16(effecter->effecter_semantic_id); | 
|  | 84 |  | 
|  | 85 | // Convert header | 
|  | 86 | HTOLE32(effecter->hdr.record_handle); | 
|  | 87 | HTOLE16(effecter->hdr.record_change_num); | 
|  | 88 | HTOLE16(effecter->hdr.length); | 
|  | 89 |  | 
|  | 90 | return PLDM_SUCCESS; | 
|  | 91 | } | 
|  | 92 |  | 
|  | 93 | int encode_state_sensor_pdr( | 
|  | 94 | struct pldm_state_sensor_pdr *const sensor, const size_t allocation_size, | 
|  | 95 | const struct state_sensor_possible_states *const possible_states, | 
|  | 96 | const size_t possible_states_size, size_t *const actual_size) | 
|  | 97 | { | 
|  | 98 | // Encode possible states | 
|  | 99 |  | 
|  | 100 | size_t calculated_possible_states_size = 0; | 
|  | 101 |  | 
|  | 102 | { | 
| Andrew Jeffery | fbe61d7 | 2023-04-05 20:28:23 +0930 | [diff] [blame] | 103 | char *states_ptr = (char *)possible_states; | 
|  | 104 | char *const begin_states_ptr = states_ptr; | 
| Andrew Jeffery | 9c76679 | 2022-08-10 23:12:49 +0930 | [diff] [blame] | 105 |  | 
|  | 106 | for (int i = 0; i < sensor->composite_sensor_count; ++i) { | 
|  | 107 | struct state_sensor_possible_states *states = | 
|  | 108 | (struct state_sensor_possible_states *)states_ptr; | 
|  | 109 |  | 
|  | 110 | HTOLE16(states->state_set_id); | 
|  | 111 |  | 
|  | 112 | states_ptr += | 
|  | 113 | (sizeof(*states) - sizeof(states->states) + | 
|  | 114 | states->possible_states_size); | 
|  | 115 | } | 
|  | 116 |  | 
|  | 117 | calculated_possible_states_size = states_ptr - begin_states_ptr; | 
|  | 118 | } | 
|  | 119 |  | 
|  | 120 | // Check lengths | 
|  | 121 |  | 
|  | 122 | if (possible_states_size != calculated_possible_states_size) { | 
|  | 123 | *actual_size = 0; | 
|  | 124 | return PLDM_ERROR; | 
|  | 125 | } | 
|  | 126 |  | 
|  | 127 | *actual_size = (sizeof(struct pldm_state_sensor_pdr) + | 
|  | 128 | possible_states_size - sizeof(sensor->possible_states)); | 
|  | 129 |  | 
|  | 130 | if (allocation_size < *actual_size) { | 
|  | 131 | *actual_size = 0; | 
|  | 132 | return PLDM_ERROR_INVALID_LENGTH; | 
|  | 133 | } | 
|  | 134 |  | 
|  | 135 | // Encode rest of PDR | 
|  | 136 |  | 
|  | 137 | sensor->hdr.version = 1; | 
|  | 138 | sensor->hdr.type = PLDM_STATE_SENSOR_PDR; | 
|  | 139 | sensor->hdr.length = *actual_size - sizeof(struct pldm_pdr_hdr); | 
|  | 140 |  | 
|  | 141 | memcpy(sensor->possible_states, possible_states, possible_states_size); | 
|  | 142 |  | 
|  | 143 | // Convert sensor PDR body | 
|  | 144 | HTOLE16(sensor->terminus_handle); | 
|  | 145 | HTOLE16(sensor->sensor_id); | 
|  | 146 | HTOLE16(sensor->entity_type); | 
|  | 147 | HTOLE16(sensor->entity_instance); | 
|  | 148 | HTOLE16(sensor->container_id); | 
|  | 149 |  | 
|  | 150 | // Convert header | 
|  | 151 | HTOLE32(sensor->hdr.record_handle); | 
|  | 152 | HTOLE16(sensor->hdr.record_change_num); | 
|  | 153 | HTOLE16(sensor->hdr.length); | 
|  | 154 |  | 
|  | 155 | return PLDM_SUCCESS; | 
|  | 156 | } | 
|  | 157 |  | 
|  | 158 | int encode_set_state_effecter_states_resp(uint8_t instance_id, | 
|  | 159 | uint8_t completion_code, | 
|  | 160 | struct pldm_msg *msg) | 
|  | 161 | { | 
|  | 162 | if (msg == NULL) { | 
|  | 163 | return PLDM_ERROR_INVALID_DATA; | 
|  | 164 | } | 
|  | 165 |  | 
|  | 166 | struct pldm_header_info header = {0}; | 
|  | 167 | header.msg_type = PLDM_RESPONSE; | 
|  | 168 | header.instance = instance_id; | 
|  | 169 | header.pldm_type = PLDM_PLATFORM; | 
|  | 170 | header.command = PLDM_SET_STATE_EFFECTER_STATES; | 
|  | 171 |  | 
|  | 172 | uint8_t rc = pack_pldm_header(&header, &(msg->hdr)); | 
|  | 173 | if (rc != PLDM_SUCCESS) { | 
|  | 174 | return rc; | 
|  | 175 | } | 
|  | 176 |  | 
|  | 177 | msg->payload[0] = completion_code; | 
|  | 178 |  | 
|  | 179 | return PLDM_SUCCESS; | 
|  | 180 | } | 
|  | 181 |  | 
|  | 182 | int encode_set_state_effecter_states_req(uint8_t instance_id, | 
|  | 183 | uint16_t effecter_id, | 
|  | 184 | uint8_t comp_effecter_count, | 
|  | 185 | set_effecter_state_field *field, | 
|  | 186 | struct pldm_msg *msg) | 
|  | 187 | { | 
|  | 188 | if (msg == NULL) { | 
|  | 189 | return PLDM_ERROR_INVALID_DATA; | 
|  | 190 | } | 
|  | 191 |  | 
|  | 192 | if (comp_effecter_count < 0x1 || comp_effecter_count > 0x8 || | 
|  | 193 | field == NULL) { | 
|  | 194 | return PLDM_ERROR_INVALID_DATA; | 
|  | 195 | } | 
|  | 196 |  | 
|  | 197 | struct pldm_header_info header = {0}; | 
|  | 198 | header.msg_type = PLDM_REQUEST; | 
|  | 199 | header.instance = instance_id; | 
|  | 200 | header.pldm_type = PLDM_PLATFORM; | 
|  | 201 | header.command = PLDM_SET_STATE_EFFECTER_STATES; | 
|  | 202 |  | 
|  | 203 | uint8_t rc = pack_pldm_header(&header, &(msg->hdr)); | 
|  | 204 | if (rc != PLDM_SUCCESS) { | 
|  | 205 | return rc; | 
|  | 206 | } | 
|  | 207 |  | 
|  | 208 | struct pldm_set_state_effecter_states_req *request = | 
|  | 209 | (struct pldm_set_state_effecter_states_req *)msg->payload; | 
|  | 210 | effecter_id = htole16(effecter_id); | 
|  | 211 | request->effecter_id = effecter_id; | 
|  | 212 | request->comp_effecter_count = comp_effecter_count; | 
|  | 213 | memcpy(request->field, field, | 
|  | 214 | (sizeof(set_effecter_state_field) * comp_effecter_count)); | 
|  | 215 |  | 
|  | 216 | return PLDM_SUCCESS; | 
|  | 217 | } | 
|  | 218 |  | 
|  | 219 | int decode_set_state_effecter_states_resp(const struct pldm_msg *msg, | 
|  | 220 | size_t payload_length, | 
|  | 221 | uint8_t *completion_code) | 
|  | 222 | { | 
|  | 223 | if (msg == NULL || completion_code == NULL) { | 
|  | 224 | return PLDM_ERROR_INVALID_DATA; | 
|  | 225 | } | 
|  | 226 |  | 
|  | 227 | *completion_code = msg->payload[0]; | 
|  | 228 | if (PLDM_SUCCESS != *completion_code) { | 
|  | 229 | return PLDM_SUCCESS; | 
|  | 230 | } | 
|  | 231 |  | 
|  | 232 | if (payload_length > PLDM_SET_STATE_EFFECTER_STATES_RESP_BYTES) { | 
|  | 233 | return PLDM_ERROR_INVALID_LENGTH; | 
|  | 234 | } | 
|  | 235 |  | 
|  | 236 | return PLDM_SUCCESS; | 
|  | 237 | } | 
|  | 238 |  | 
| Andrew Jeffery | 5d773b3 | 2023-04-04 10:52:57 +0930 | [diff] [blame] | 239 | #define PLDM_SET_STATE_EFFECTER_STATES_MIN_SIZE 3 | 
| Andrew Jeffery | 9c76679 | 2022-08-10 23:12:49 +0930 | [diff] [blame] | 240 | int decode_set_state_effecter_states_req(const struct pldm_msg *msg, | 
|  | 241 | size_t payload_length, | 
|  | 242 | uint16_t *effecter_id, | 
|  | 243 | uint8_t *comp_effecter_count, | 
|  | 244 | set_effecter_state_field *field) | 
|  | 245 | { | 
| Andrew Jeffery | 5d773b3 | 2023-04-04 10:52:57 +0930 | [diff] [blame] | 246 | struct pldm_msgbuf _buf; | 
|  | 247 | struct pldm_msgbuf *buf = &_buf; | 
|  | 248 | int rc; | 
|  | 249 | int i; | 
|  | 250 |  | 
| Andrew Jeffery | 9c76679 | 2022-08-10 23:12:49 +0930 | [diff] [blame] | 251 | if (msg == NULL || effecter_id == NULL || comp_effecter_count == NULL || | 
|  | 252 | field == NULL) { | 
|  | 253 | return PLDM_ERROR_INVALID_DATA; | 
|  | 254 | } | 
|  | 255 |  | 
|  | 256 | if (payload_length > PLDM_SET_STATE_EFFECTER_STATES_REQ_BYTES) { | 
|  | 257 | return PLDM_ERROR_INVALID_LENGTH; | 
|  | 258 | } | 
|  | 259 |  | 
| Andrew Jeffery | 5d773b3 | 2023-04-04 10:52:57 +0930 | [diff] [blame] | 260 | rc = pldm_msgbuf_init(buf, PLDM_SET_STATE_EFFECTER_STATES_MIN_SIZE, | 
|  | 261 | msg->payload, payload_length); | 
|  | 262 | if (rc) { | 
|  | 263 | return rc; | 
|  | 264 | } | 
| Andrew Jeffery | 9c76679 | 2022-08-10 23:12:49 +0930 | [diff] [blame] | 265 |  | 
| Andrew Jeffery | 5d773b3 | 2023-04-04 10:52:57 +0930 | [diff] [blame] | 266 | pldm_msgbuf_extract(buf, effecter_id); | 
|  | 267 | pldm_msgbuf_extract(buf, comp_effecter_count); | 
| Andrew Jeffery | 9c76679 | 2022-08-10 23:12:49 +0930 | [diff] [blame] | 268 |  | 
| Andrew Jeffery | 5d773b3 | 2023-04-04 10:52:57 +0930 | [diff] [blame] | 269 | if (*comp_effecter_count > 8) { | 
|  | 270 | return PLDM_ERROR_INVALID_DATA; | 
|  | 271 | } | 
|  | 272 |  | 
|  | 273 | for (i = 0; i < *comp_effecter_count; i++) { | 
|  | 274 | pldm_msgbuf_extract(buf, &field[i].set_request); | 
|  | 275 | pldm_msgbuf_extract(buf, &field[i].effecter_state); | 
|  | 276 | } | 
|  | 277 |  | 
|  | 278 | return pldm_msgbuf_destroy(buf); | 
| Andrew Jeffery | 9c76679 | 2022-08-10 23:12:49 +0930 | [diff] [blame] | 279 | } | 
|  | 280 |  | 
|  | 281 | int decode_get_pdr_req(const struct pldm_msg *msg, size_t payload_length, | 
|  | 282 | uint32_t *record_hndl, uint32_t *data_transfer_hndl, | 
|  | 283 | uint8_t *transfer_op_flag, uint16_t *request_cnt, | 
|  | 284 | uint16_t *record_chg_num) | 
|  | 285 | { | 
| Andrew Jeffery | 891781e | 2023-04-04 11:04:18 +0930 | [diff] [blame] | 286 | struct pldm_msgbuf _buf; | 
|  | 287 | struct pldm_msgbuf *buf = &_buf; | 
|  | 288 | int rc; | 
|  | 289 |  | 
| Andrew Jeffery | 9c76679 | 2022-08-10 23:12:49 +0930 | [diff] [blame] | 290 | if (msg == NULL || record_hndl == NULL || data_transfer_hndl == NULL || | 
|  | 291 | transfer_op_flag == NULL || request_cnt == NULL || | 
|  | 292 | record_chg_num == NULL) { | 
|  | 293 | return PLDM_ERROR_INVALID_DATA; | 
|  | 294 | } | 
| Andrew Jeffery | 891781e | 2023-04-04 11:04:18 +0930 | [diff] [blame] | 295 |  | 
| Andrew Jeffery | 9c76679 | 2022-08-10 23:12:49 +0930 | [diff] [blame] | 296 | if (payload_length != PLDM_GET_PDR_REQ_BYTES) { | 
|  | 297 | return PLDM_ERROR_INVALID_LENGTH; | 
|  | 298 | } | 
|  | 299 |  | 
| Andrew Jeffery | 891781e | 2023-04-04 11:04:18 +0930 | [diff] [blame] | 300 | rc = pldm_msgbuf_init(buf, PLDM_GET_PDR_REQ_BYTES, msg->payload, | 
|  | 301 | payload_length); | 
|  | 302 | if (rc) { | 
|  | 303 | return rc; | 
|  | 304 | } | 
| Andrew Jeffery | 9c76679 | 2022-08-10 23:12:49 +0930 | [diff] [blame] | 305 |  | 
| Andrew Jeffery | 891781e | 2023-04-04 11:04:18 +0930 | [diff] [blame] | 306 | pldm_msgbuf_extract(buf, record_hndl); | 
|  | 307 | pldm_msgbuf_extract(buf, data_transfer_hndl); | 
|  | 308 | pldm_msgbuf_extract(buf, transfer_op_flag); | 
|  | 309 | pldm_msgbuf_extract(buf, request_cnt); | 
|  | 310 | pldm_msgbuf_extract(buf, record_chg_num); | 
|  | 311 |  | 
|  | 312 | return pldm_msgbuf_destroy(buf); | 
| Andrew Jeffery | 9c76679 | 2022-08-10 23:12:49 +0930 | [diff] [blame] | 313 | } | 
|  | 314 |  | 
|  | 315 | int encode_get_pdr_resp(uint8_t instance_id, uint8_t completion_code, | 
|  | 316 | uint32_t next_record_hndl, | 
|  | 317 | uint32_t next_data_transfer_hndl, uint8_t transfer_flag, | 
|  | 318 | uint16_t resp_cnt, const uint8_t *record_data, | 
|  | 319 | uint8_t transfer_crc, struct pldm_msg *msg) | 
|  | 320 | { | 
|  | 321 | if (msg == NULL) { | 
|  | 322 | return PLDM_ERROR_INVALID_DATA; | 
|  | 323 | } | 
|  | 324 |  | 
|  | 325 | struct pldm_header_info header = {0}; | 
|  | 326 | header.msg_type = PLDM_RESPONSE; | 
|  | 327 | header.instance = instance_id; | 
|  | 328 | header.pldm_type = PLDM_PLATFORM; | 
|  | 329 | header.command = PLDM_GET_PDR; | 
|  | 330 |  | 
|  | 331 | uint8_t rc = pack_pldm_header(&header, &(msg->hdr)); | 
|  | 332 | if (rc != PLDM_SUCCESS) { | 
|  | 333 | return rc; | 
|  | 334 | } | 
|  | 335 |  | 
|  | 336 | struct pldm_get_pdr_resp *response = | 
|  | 337 | (struct pldm_get_pdr_resp *)msg->payload; | 
|  | 338 | response->completion_code = completion_code; | 
|  | 339 |  | 
|  | 340 | if (response->completion_code == PLDM_SUCCESS) { | 
|  | 341 | response->next_record_handle = htole32(next_record_hndl); | 
|  | 342 | response->next_data_transfer_handle = | 
|  | 343 | htole32(next_data_transfer_hndl); | 
|  | 344 | response->transfer_flag = transfer_flag; | 
|  | 345 | response->response_count = htole16(resp_cnt); | 
|  | 346 | if (record_data != NULL && resp_cnt > 0) { | 
|  | 347 | memcpy(response->record_data, record_data, resp_cnt); | 
|  | 348 | } | 
|  | 349 | if (transfer_flag == PLDM_END) { | 
|  | 350 | uint8_t *dst = msg->payload; | 
|  | 351 | dst += | 
|  | 352 | (sizeof(struct pldm_get_pdr_resp) - 1) + resp_cnt; | 
|  | 353 | *dst = transfer_crc; | 
|  | 354 | } | 
|  | 355 | } | 
|  | 356 |  | 
|  | 357 | return PLDM_SUCCESS; | 
|  | 358 | } | 
|  | 359 |  | 
|  | 360 | int encode_get_pdr_repository_info_resp( | 
|  | 361 | uint8_t instance_id, uint8_t completion_code, uint8_t repository_state, | 
|  | 362 | const uint8_t *update_time, const uint8_t *oem_update_time, | 
|  | 363 | uint32_t record_count, uint32_t repository_size, | 
|  | 364 | uint32_t largest_record_size, uint8_t data_transfer_handle_timeout, | 
|  | 365 | struct pldm_msg *msg) | 
|  | 366 | { | 
|  | 367 | if (msg == NULL) { | 
|  | 368 | return PLDM_ERROR_INVALID_DATA; | 
|  | 369 | } | 
|  | 370 |  | 
|  | 371 | struct pldm_header_info header = {0}; | 
|  | 372 | header.msg_type = PLDM_RESPONSE; | 
|  | 373 | header.instance = instance_id; | 
|  | 374 | header.pldm_type = PLDM_PLATFORM; | 
|  | 375 | header.command = PLDM_GET_PDR_REPOSITORY_INFO; | 
|  | 376 |  | 
|  | 377 | uint8_t rc = pack_pldm_header(&header, &(msg->hdr)); | 
|  | 378 | if (rc != PLDM_SUCCESS) { | 
|  | 379 | return rc; | 
|  | 380 | } | 
|  | 381 |  | 
|  | 382 | struct pldm_pdr_repository_info_resp *response = | 
|  | 383 | (struct pldm_pdr_repository_info_resp *)msg->payload; | 
|  | 384 | response->completion_code = completion_code; | 
|  | 385 |  | 
|  | 386 | if (response->completion_code == PLDM_SUCCESS) { | 
|  | 387 | response->repository_state = repository_state; | 
|  | 388 | if (update_time != NULL) { | 
|  | 389 | memcpy(response->update_time, update_time, | 
|  | 390 | PLDM_TIMESTAMP104_SIZE); | 
|  | 391 | } | 
|  | 392 | if (oem_update_time != NULL) { | 
|  | 393 | memcpy(response->oem_update_time, oem_update_time, | 
|  | 394 | PLDM_TIMESTAMP104_SIZE); | 
|  | 395 | } | 
|  | 396 | response->record_count = htole32(record_count); | 
|  | 397 | response->repository_size = htole32(repository_size); | 
|  | 398 | response->largest_record_size = htole32(largest_record_size); | 
|  | 399 | response->data_transfer_handle_timeout = | 
|  | 400 | data_transfer_handle_timeout; | 
|  | 401 | } | 
|  | 402 |  | 
|  | 403 | return PLDM_SUCCESS; | 
|  | 404 | } | 
|  | 405 |  | 
| Gilbert Chen | b7c73e5 | 2022-11-10 11:29:52 +0800 | [diff] [blame] | 406 | int decode_get_pdr_repository_info_resp( | 
|  | 407 | const struct pldm_msg *msg, size_t payload_length, uint8_t *completion_code, | 
|  | 408 | uint8_t *repository_state, uint8_t *update_time, uint8_t *oem_update_time, | 
|  | 409 | uint32_t *record_count, uint32_t *repository_size, | 
|  | 410 | uint32_t *largest_record_size, uint8_t *data_transfer_handle_timeout) | 
|  | 411 | { | 
| Andrew Jeffery | 5c651b8 | 2023-04-04 11:37:56 +0930 | [diff] [blame] | 412 | struct pldm_msgbuf _buf; | 
|  | 413 | struct pldm_msgbuf *buf = &_buf; | 
|  | 414 | int rc; | 
|  | 415 |  | 
| Gilbert Chen | b7c73e5 | 2022-11-10 11:29:52 +0800 | [diff] [blame] | 416 | if (msg == NULL || completion_code == NULL || | 
|  | 417 | repository_state == NULL || update_time == NULL || | 
|  | 418 | oem_update_time == NULL || record_count == NULL || | 
|  | 419 | repository_size == NULL || largest_record_size == NULL || | 
|  | 420 | data_transfer_handle_timeout == NULL) { | 
|  | 421 | return PLDM_ERROR_INVALID_DATA; | 
|  | 422 | } | 
|  | 423 |  | 
| Andrew Jeffery | 5c651b8 | 2023-04-04 11:37:56 +0930 | [diff] [blame] | 424 | rc = pldm_msgbuf_init(buf, PLDM_GET_PDR_REPOSITORY_INFO_RESP_BYTES, | 
|  | 425 | msg->payload, payload_length); | 
|  | 426 | if (rc) { | 
|  | 427 | return rc; | 
|  | 428 | } | 
|  | 429 |  | 
|  | 430 | pldm_msgbuf_extract(buf, completion_code); | 
| Gilbert Chen | b7c73e5 | 2022-11-10 11:29:52 +0800 | [diff] [blame] | 431 | if (PLDM_SUCCESS != *completion_code) { | 
|  | 432 | return PLDM_SUCCESS; | 
|  | 433 | } | 
|  | 434 |  | 
| Andrew Jeffery | 5c651b8 | 2023-04-04 11:37:56 +0930 | [diff] [blame] | 435 | pldm_msgbuf_extract(buf, repository_state); | 
| Gilbert Chen | b7c73e5 | 2022-11-10 11:29:52 +0800 | [diff] [blame] | 436 | if (*repository_state > PLDM_FAILED) { | 
|  | 437 | return PLDM_ERROR_INVALID_DATA; | 
|  | 438 | } | 
|  | 439 |  | 
| Andrew Jeffery | 5c651b8 | 2023-04-04 11:37:56 +0930 | [diff] [blame] | 440 | pldm_msgbuf_extract_array(buf, update_time, PLDM_TIMESTAMP104_SIZE); | 
|  | 441 | pldm_msgbuf_extract_array(buf, oem_update_time, PLDM_TIMESTAMP104_SIZE); | 
|  | 442 | pldm_msgbuf_extract(buf, record_count); | 
|  | 443 | pldm_msgbuf_extract(buf, repository_size); | 
|  | 444 | pldm_msgbuf_extract(buf, largest_record_size); | 
|  | 445 | pldm_msgbuf_extract(buf, data_transfer_handle_timeout); | 
| Gilbert Chen | b7c73e5 | 2022-11-10 11:29:52 +0800 | [diff] [blame] | 446 |  | 
| Andrew Jeffery | 5c651b8 | 2023-04-04 11:37:56 +0930 | [diff] [blame] | 447 | return pldm_msgbuf_destroy(buf); | 
| Gilbert Chen | b7c73e5 | 2022-11-10 11:29:52 +0800 | [diff] [blame] | 448 | } | 
|  | 449 |  | 
| Andrew Jeffery | 9c76679 | 2022-08-10 23:12:49 +0930 | [diff] [blame] | 450 | int encode_get_pdr_req(uint8_t instance_id, uint32_t record_hndl, | 
|  | 451 | uint32_t data_transfer_hndl, uint8_t transfer_op_flag, | 
|  | 452 | uint16_t request_cnt, uint16_t record_chg_num, | 
|  | 453 | struct pldm_msg *msg, size_t payload_length) | 
|  | 454 | { | 
|  | 455 | if (msg == NULL) { | 
|  | 456 | return PLDM_ERROR_INVALID_DATA; | 
|  | 457 | } | 
|  | 458 |  | 
|  | 459 | if (payload_length != PLDM_GET_PDR_REQ_BYTES) { | 
|  | 460 | return PLDM_ERROR_INVALID_LENGTH; | 
|  | 461 | } | 
|  | 462 |  | 
|  | 463 | struct pldm_header_info header = {0}; | 
|  | 464 | header.msg_type = PLDM_REQUEST; | 
|  | 465 | header.instance = instance_id; | 
|  | 466 | header.pldm_type = PLDM_PLATFORM; | 
|  | 467 | header.command = PLDM_GET_PDR; | 
|  | 468 |  | 
|  | 469 | uint8_t rc = pack_pldm_header(&header, &(msg->hdr)); | 
|  | 470 | if (rc != PLDM_SUCCESS) { | 
|  | 471 | return rc; | 
|  | 472 | } | 
|  | 473 |  | 
|  | 474 | struct pldm_get_pdr_req *request = | 
|  | 475 | (struct pldm_get_pdr_req *)msg->payload; | 
|  | 476 | request->record_handle = htole32(record_hndl); | 
|  | 477 | request->data_transfer_handle = htole32(data_transfer_hndl); | 
|  | 478 | request->transfer_op_flag = transfer_op_flag; | 
|  | 479 | request->request_count = htole16(request_cnt); | 
|  | 480 | request->record_change_number = htole16(record_chg_num); | 
|  | 481 |  | 
|  | 482 | return PLDM_SUCCESS; | 
|  | 483 | } | 
|  | 484 |  | 
|  | 485 | int decode_get_pdr_resp(const struct pldm_msg *msg, size_t payload_length, | 
|  | 486 | uint8_t *completion_code, uint32_t *next_record_hndl, | 
|  | 487 | uint32_t *next_data_transfer_hndl, | 
|  | 488 | uint8_t *transfer_flag, uint16_t *resp_cnt, | 
|  | 489 | uint8_t *record_data, size_t record_data_length, | 
|  | 490 | uint8_t *transfer_crc) | 
|  | 491 | { | 
| Andrew Jeffery | 4e5e8a2 | 2023-04-04 11:58:45 +0930 | [diff] [blame] | 492 | struct pldm_msgbuf _buf; | 
|  | 493 | struct pldm_msgbuf *buf = &_buf; | 
|  | 494 | int rc; | 
|  | 495 |  | 
| Andrew Jeffery | 9c76679 | 2022-08-10 23:12:49 +0930 | [diff] [blame] | 496 | if (msg == NULL || completion_code == NULL || | 
|  | 497 | next_record_hndl == NULL || next_data_transfer_hndl == NULL || | 
|  | 498 | transfer_flag == NULL || resp_cnt == NULL || transfer_crc == NULL) { | 
|  | 499 | return PLDM_ERROR_INVALID_DATA; | 
|  | 500 | } | 
|  | 501 |  | 
| Andrew Jeffery | 4e5e8a2 | 2023-04-04 11:58:45 +0930 | [diff] [blame] | 502 | rc = pldm_msgbuf_init(buf, PLDM_GET_PDR_MIN_RESP_BYTES, msg->payload, | 
|  | 503 | payload_length); | 
|  | 504 | if (rc) { | 
|  | 505 | return rc; | 
|  | 506 | } | 
|  | 507 |  | 
|  | 508 | pldm_msgbuf_extract(buf, completion_code); | 
| Andrew Jeffery | 9c76679 | 2022-08-10 23:12:49 +0930 | [diff] [blame] | 509 | if (PLDM_SUCCESS != *completion_code) { | 
|  | 510 | return PLDM_SUCCESS; | 
|  | 511 | } | 
|  | 512 |  | 
| Andrew Jeffery | 4e5e8a2 | 2023-04-04 11:58:45 +0930 | [diff] [blame] | 513 | pldm_msgbuf_extract(buf, next_record_hndl); | 
|  | 514 | pldm_msgbuf_extract(buf, next_data_transfer_hndl); | 
|  | 515 | pldm_msgbuf_extract(buf, transfer_flag); | 
|  | 516 | rc = pldm_msgbuf_extract(buf, resp_cnt); | 
|  | 517 | if (rc) { | 
|  | 518 | return rc; | 
| Andrew Jeffery | 9c76679 | 2022-08-10 23:12:49 +0930 | [diff] [blame] | 519 | } | 
|  | 520 |  | 
|  | 521 | if (*resp_cnt > 0 && record_data != NULL) { | 
|  | 522 | if (record_data_length < *resp_cnt) { | 
|  | 523 | return PLDM_ERROR_INVALID_LENGTH; | 
|  | 524 | } | 
| Andrew Jeffery | 4e5e8a2 | 2023-04-04 11:58:45 +0930 | [diff] [blame] | 525 | pldm_msgbuf_extract_array(buf, record_data, *resp_cnt); | 
| Andrew Jeffery | 9c76679 | 2022-08-10 23:12:49 +0930 | [diff] [blame] | 526 | } | 
|  | 527 |  | 
|  | 528 | if (*transfer_flag == PLDM_END) { | 
| Andrew Jeffery | 4e5e8a2 | 2023-04-04 11:58:45 +0930 | [diff] [blame] | 529 | pldm_msgbuf_extract(buf, transfer_crc); | 
| Andrew Jeffery | 9c76679 | 2022-08-10 23:12:49 +0930 | [diff] [blame] | 530 | } | 
|  | 531 |  | 
| Andrew Jeffery | 4e5e8a2 | 2023-04-04 11:58:45 +0930 | [diff] [blame] | 532 | return pldm_msgbuf_destroy(buf); | 
| Andrew Jeffery | 9c76679 | 2022-08-10 23:12:49 +0930 | [diff] [blame] | 533 | } | 
|  | 534 |  | 
|  | 535 | int decode_set_numeric_effecter_value_req(const struct pldm_msg *msg, | 
|  | 536 | size_t payload_length, | 
|  | 537 | uint16_t *effecter_id, | 
|  | 538 | uint8_t *effecter_data_size, | 
| Andrew Jeffery | 3884c44 | 2023-04-12 11:13:24 +0930 | [diff] [blame] | 539 | uint8_t effecter_value[4]) | 
| Andrew Jeffery | 9c76679 | 2022-08-10 23:12:49 +0930 | [diff] [blame] | 540 | { | 
| Andrew Jeffery | 3884c44 | 2023-04-12 11:13:24 +0930 | [diff] [blame] | 541 | struct pldm_msgbuf _buf; | 
|  | 542 | struct pldm_msgbuf *buf = &_buf; | 
|  | 543 | int rc; | 
|  | 544 |  | 
| Andrew Jeffery | 9c76679 | 2022-08-10 23:12:49 +0930 | [diff] [blame] | 545 | if (msg == NULL || effecter_id == NULL || effecter_data_size == NULL || | 
|  | 546 | effecter_value == NULL) { | 
|  | 547 | return PLDM_ERROR_INVALID_DATA; | 
|  | 548 | } | 
|  | 549 |  | 
| Andrew Jeffery | 3884c44 | 2023-04-12 11:13:24 +0930 | [diff] [blame] | 550 | rc = | 
|  | 551 | pldm_msgbuf_init(buf, PLDM_SET_NUMERIC_EFFECTER_VALUE_MIN_REQ_BYTES, | 
|  | 552 | msg->payload, payload_length); | 
|  | 553 | if (rc) { | 
|  | 554 | return rc; | 
| Andrew Jeffery | 9c76679 | 2022-08-10 23:12:49 +0930 | [diff] [blame] | 555 | } | 
|  | 556 |  | 
| Andrew Jeffery | 3884c44 | 2023-04-12 11:13:24 +0930 | [diff] [blame] | 557 | pldm_msgbuf_extract(buf, effecter_id); | 
|  | 558 | rc = pldm_msgbuf_extract(buf, effecter_data_size); | 
|  | 559 | if (rc) { | 
|  | 560 | return PLDM_ERROR_INVALID_DATA; | 
|  | 561 | } | 
| Andrew Jeffery | 9c76679 | 2022-08-10 23:12:49 +0930 | [diff] [blame] | 562 |  | 
|  | 563 | if (*effecter_data_size > PLDM_EFFECTER_DATA_SIZE_SINT32) { | 
|  | 564 | return PLDM_ERROR_INVALID_DATA; | 
|  | 565 | } | 
|  | 566 |  | 
| Andrew Jeffery | 3884c44 | 2023-04-12 11:13:24 +0930 | [diff] [blame] | 567 | pldm_msgbuf_extract_effecter_value(buf, *effecter_data_size, | 
|  | 568 | effecter_value); | 
| Andrew Jeffery | 9c76679 | 2022-08-10 23:12:49 +0930 | [diff] [blame] | 569 |  | 
| Andrew Jeffery | 3884c44 | 2023-04-12 11:13:24 +0930 | [diff] [blame] | 570 | return pldm_msgbuf_destroy(buf); | 
| Andrew Jeffery | 9c76679 | 2022-08-10 23:12:49 +0930 | [diff] [blame] | 571 | } | 
|  | 572 |  | 
|  | 573 | int encode_set_numeric_effecter_value_resp(uint8_t instance_id, | 
|  | 574 | uint8_t completion_code, | 
|  | 575 | struct pldm_msg *msg, | 
|  | 576 | size_t payload_length) | 
|  | 577 | { | 
|  | 578 | if (msg == NULL) { | 
|  | 579 | return PLDM_ERROR_INVALID_DATA; | 
|  | 580 | } | 
|  | 581 |  | 
|  | 582 | if (payload_length != PLDM_SET_NUMERIC_EFFECTER_VALUE_RESP_BYTES) { | 
|  | 583 | return PLDM_ERROR_INVALID_LENGTH; | 
|  | 584 | } | 
|  | 585 |  | 
|  | 586 | struct pldm_header_info header = {0}; | 
|  | 587 | header.msg_type = PLDM_RESPONSE; | 
|  | 588 | header.instance = instance_id; | 
|  | 589 | header.pldm_type = PLDM_PLATFORM; | 
|  | 590 | header.command = PLDM_SET_NUMERIC_EFFECTER_VALUE; | 
|  | 591 |  | 
|  | 592 | uint8_t rc = pack_pldm_header(&header, &(msg->hdr)); | 
|  | 593 | if (rc != PLDM_SUCCESS) { | 
|  | 594 | return rc; | 
|  | 595 | } | 
|  | 596 |  | 
|  | 597 | msg->payload[0] = completion_code; | 
|  | 598 |  | 
|  | 599 | return rc; | 
|  | 600 | } | 
|  | 601 |  | 
|  | 602 | int encode_set_numeric_effecter_value_req( | 
|  | 603 | uint8_t instance_id, uint16_t effecter_id, uint8_t effecter_data_size, | 
| Andrew Jeffery | debe6b3 | 2023-04-05 20:30:46 +0930 | [diff] [blame] | 604 | const uint8_t *effecter_value, struct pldm_msg *msg, size_t payload_length) | 
| Andrew Jeffery | 9c76679 | 2022-08-10 23:12:49 +0930 | [diff] [blame] | 605 | { | 
|  | 606 | if (msg == NULL || effecter_value == NULL) { | 
|  | 607 | return PLDM_ERROR_INVALID_DATA; | 
|  | 608 | } | 
|  | 609 |  | 
|  | 610 | if (effecter_data_size > PLDM_EFFECTER_DATA_SIZE_SINT32) { | 
|  | 611 | return PLDM_ERROR_INVALID_DATA; | 
|  | 612 | } | 
|  | 613 |  | 
|  | 614 | struct pldm_header_info header = {0}; | 
|  | 615 | header.msg_type = PLDM_REQUEST; | 
|  | 616 | header.instance = instance_id; | 
|  | 617 | header.pldm_type = PLDM_PLATFORM; | 
|  | 618 | header.command = PLDM_SET_NUMERIC_EFFECTER_VALUE; | 
|  | 619 |  | 
|  | 620 | uint8_t rc = pack_pldm_header(&header, &(msg->hdr)); | 
|  | 621 | if (rc != PLDM_SUCCESS) { | 
|  | 622 | return rc; | 
|  | 623 | } | 
|  | 624 |  | 
|  | 625 | struct pldm_set_numeric_effecter_value_req *request = | 
|  | 626 | (struct pldm_set_numeric_effecter_value_req *)msg->payload; | 
|  | 627 | if (effecter_data_size == PLDM_EFFECTER_DATA_SIZE_UINT8 || | 
|  | 628 | effecter_data_size == PLDM_EFFECTER_DATA_SIZE_SINT8) { | 
|  | 629 | if (payload_length != | 
|  | 630 | PLDM_SET_NUMERIC_EFFECTER_VALUE_MIN_REQ_BYTES) { | 
|  | 631 | return PLDM_ERROR_INVALID_LENGTH; | 
|  | 632 | } | 
|  | 633 | request->effecter_value[0] = *effecter_value; | 
|  | 634 | } else if (effecter_data_size == PLDM_EFFECTER_DATA_SIZE_UINT16 || | 
|  | 635 | effecter_data_size == PLDM_EFFECTER_DATA_SIZE_SINT16) { | 
|  | 636 | if (payload_length != | 
|  | 637 | PLDM_SET_NUMERIC_EFFECTER_VALUE_MIN_REQ_BYTES + 1) { | 
|  | 638 | return PLDM_ERROR_INVALID_LENGTH; | 
|  | 639 | } | 
|  | 640 |  | 
|  | 641 | uint16_t val = *(uint16_t *)(effecter_value); | 
|  | 642 | val = htole16(val); | 
|  | 643 | memcpy(request->effecter_value, &val, sizeof(uint16_t)); | 
|  | 644 |  | 
|  | 645 | } else if (effecter_data_size == PLDM_EFFECTER_DATA_SIZE_UINT32 || | 
|  | 646 | effecter_data_size == PLDM_EFFECTER_DATA_SIZE_SINT32) { | 
|  | 647 | if (payload_length != | 
|  | 648 | PLDM_SET_NUMERIC_EFFECTER_VALUE_MIN_REQ_BYTES + 3) { | 
|  | 649 | return PLDM_ERROR_INVALID_LENGTH; | 
|  | 650 | } | 
|  | 651 |  | 
|  | 652 | uint32_t val = *(uint32_t *)(effecter_value); | 
|  | 653 | val = htole32(val); | 
|  | 654 | memcpy(request->effecter_value, &val, sizeof(uint32_t)); | 
|  | 655 | } | 
|  | 656 |  | 
|  | 657 | request->effecter_id = htole16(effecter_id); | 
|  | 658 | request->effecter_data_size = effecter_data_size; | 
|  | 659 |  | 
|  | 660 | return PLDM_SUCCESS; | 
|  | 661 | } | 
|  | 662 |  | 
|  | 663 | int decode_set_numeric_effecter_value_resp(const struct pldm_msg *msg, | 
|  | 664 | size_t payload_length, | 
|  | 665 | uint8_t *completion_code) | 
|  | 666 | { | 
|  | 667 | if (msg == NULL || completion_code == NULL) { | 
|  | 668 | return PLDM_ERROR_INVALID_DATA; | 
|  | 669 | } | 
|  | 670 |  | 
|  | 671 | if (payload_length != PLDM_SET_NUMERIC_EFFECTER_VALUE_RESP_BYTES) { | 
|  | 672 | return PLDM_ERROR_INVALID_LENGTH; | 
|  | 673 | } | 
|  | 674 |  | 
|  | 675 | *completion_code = msg->payload[0]; | 
|  | 676 |  | 
|  | 677 | return PLDM_SUCCESS; | 
|  | 678 | } | 
|  | 679 |  | 
|  | 680 | int encode_get_state_sensor_readings_resp(uint8_t instance_id, | 
|  | 681 | uint8_t completion_code, | 
|  | 682 | uint8_t comp_sensor_count, | 
|  | 683 | get_sensor_state_field *field, | 
|  | 684 | struct pldm_msg *msg) | 
|  | 685 | { | 
|  | 686 | if (msg == NULL) { | 
|  | 687 | return PLDM_ERROR_INVALID_DATA; | 
|  | 688 | } | 
|  | 689 |  | 
|  | 690 | if (comp_sensor_count < 0x1 || comp_sensor_count > 0x8) { | 
|  | 691 | return PLDM_ERROR_INVALID_DATA; | 
|  | 692 | } | 
|  | 693 |  | 
|  | 694 | struct pldm_header_info header = {0}; | 
|  | 695 | header.msg_type = PLDM_RESPONSE; | 
|  | 696 | header.instance = instance_id; | 
|  | 697 | header.pldm_type = PLDM_PLATFORM; | 
|  | 698 | header.command = PLDM_GET_STATE_SENSOR_READINGS; | 
|  | 699 |  | 
|  | 700 | uint8_t rc = pack_pldm_header(&header, &(msg->hdr)); | 
|  | 701 | if (rc != PLDM_SUCCESS) { | 
|  | 702 | return rc; | 
|  | 703 | } | 
|  | 704 |  | 
|  | 705 | struct pldm_get_state_sensor_readings_resp *response = | 
|  | 706 | (struct pldm_get_state_sensor_readings_resp *)msg->payload; | 
|  | 707 |  | 
|  | 708 | response->completion_code = completion_code; | 
|  | 709 | response->comp_sensor_count = comp_sensor_count; | 
|  | 710 | memcpy(response->field, field, | 
|  | 711 | (sizeof(get_sensor_state_field) * comp_sensor_count)); | 
|  | 712 |  | 
|  | 713 | return PLDM_SUCCESS; | 
|  | 714 | } | 
|  | 715 |  | 
|  | 716 | int encode_get_state_sensor_readings_req(uint8_t instance_id, | 
|  | 717 | uint16_t sensor_id, | 
|  | 718 | bitfield8_t sensor_rearm, | 
|  | 719 | uint8_t reserved, struct pldm_msg *msg) | 
|  | 720 | { | 
|  | 721 | if (msg == NULL) { | 
|  | 722 | return PLDM_ERROR_INVALID_DATA; | 
|  | 723 | } | 
|  | 724 |  | 
|  | 725 | struct pldm_header_info header = {0}; | 
|  | 726 | header.msg_type = PLDM_REQUEST; | 
|  | 727 | header.instance = instance_id; | 
|  | 728 | header.pldm_type = PLDM_PLATFORM; | 
|  | 729 | header.command = PLDM_GET_STATE_SENSOR_READINGS; | 
|  | 730 |  | 
|  | 731 | uint8_t rc = pack_pldm_header(&header, &(msg->hdr)); | 
|  | 732 | if (rc != PLDM_SUCCESS) { | 
|  | 733 | return rc; | 
|  | 734 | } | 
|  | 735 |  | 
|  | 736 | struct pldm_get_state_sensor_readings_req *request = | 
|  | 737 | (struct pldm_get_state_sensor_readings_req *)msg->payload; | 
|  | 738 |  | 
|  | 739 | request->sensor_id = htole16(sensor_id); | 
|  | 740 | request->reserved = reserved; | 
|  | 741 | request->sensor_rearm = sensor_rearm; | 
|  | 742 |  | 
|  | 743 | return PLDM_SUCCESS; | 
|  | 744 | } | 
|  | 745 |  | 
|  | 746 | int decode_get_state_sensor_readings_resp(const struct pldm_msg *msg, | 
|  | 747 | size_t payload_length, | 
|  | 748 | uint8_t *completion_code, | 
|  | 749 | uint8_t *comp_sensor_count, | 
|  | 750 | get_sensor_state_field *field) | 
|  | 751 | { | 
| Andrew Jeffery | b0e22a7 | 2023-04-12 23:14:36 +0930 | [diff] [blame] | 752 | struct pldm_msgbuf _buf; | 
|  | 753 | struct pldm_msgbuf *buf = &_buf; | 
|  | 754 | uint8_t i; | 
|  | 755 | int rc; | 
|  | 756 |  | 
| Andrew Jeffery | 9c76679 | 2022-08-10 23:12:49 +0930 | [diff] [blame] | 757 | if (msg == NULL || completion_code == NULL || | 
|  | 758 | comp_sensor_count == NULL || field == NULL) { | 
|  | 759 | return PLDM_ERROR_INVALID_DATA; | 
|  | 760 | } | 
|  | 761 |  | 
| Andrew Jeffery | b0e22a7 | 2023-04-12 23:14:36 +0930 | [diff] [blame] | 762 | rc = | 
|  | 763 | pldm_msgbuf_init(buf, PLDM_GET_STATE_SENSOR_READINGS_MIN_RESP_BYTES, | 
|  | 764 | msg->payload, payload_length); | 
|  | 765 | if (rc) { | 
|  | 766 | return rc; | 
|  | 767 | } | 
|  | 768 |  | 
|  | 769 | rc = pldm_msgbuf_extract(buf, completion_code); | 
|  | 770 | if (rc) { | 
|  | 771 | return rc; | 
|  | 772 | } | 
|  | 773 |  | 
| Andrew Jeffery | 9c76679 | 2022-08-10 23:12:49 +0930 | [diff] [blame] | 774 | if (PLDM_SUCCESS != *completion_code) { | 
|  | 775 | return PLDM_SUCCESS; | 
|  | 776 | } | 
|  | 777 |  | 
| Andrew Jeffery | b0e22a7 | 2023-04-12 23:14:36 +0930 | [diff] [blame] | 778 | rc = pldm_msgbuf_extract(buf, comp_sensor_count); | 
|  | 779 | if (rc) { | 
|  | 780 | return rc; | 
|  | 781 | } | 
| Andrew Jeffery | 9c76679 | 2022-08-10 23:12:49 +0930 | [diff] [blame] | 782 |  | 
| Andrew Jeffery | b0e22a7 | 2023-04-12 23:14:36 +0930 | [diff] [blame] | 783 | if (*comp_sensor_count < 0x1 || *comp_sensor_count > 0x8) { | 
| Andrew Jeffery | 9c76679 | 2022-08-10 23:12:49 +0930 | [diff] [blame] | 784 | return PLDM_ERROR_INVALID_DATA; | 
|  | 785 | } | 
|  | 786 |  | 
| Andrew Jeffery | b0e22a7 | 2023-04-12 23:14:36 +0930 | [diff] [blame] | 787 | for (i = 0; i < *comp_sensor_count; i++) { | 
|  | 788 | pldm_msgbuf_extract(buf, &field[i].sensor_op_state); | 
|  | 789 | pldm_msgbuf_extract(buf, &field[i].present_state); | 
|  | 790 | pldm_msgbuf_extract(buf, &field[i].previous_state); | 
|  | 791 | pldm_msgbuf_extract(buf, &field[i].event_state); | 
| Andrew Jeffery | 9c76679 | 2022-08-10 23:12:49 +0930 | [diff] [blame] | 792 | } | 
|  | 793 |  | 
| Andrew Jeffery | b0e22a7 | 2023-04-12 23:14:36 +0930 | [diff] [blame] | 794 | return pldm_msgbuf_destroy_consumed(buf); | 
| Andrew Jeffery | 9c76679 | 2022-08-10 23:12:49 +0930 | [diff] [blame] | 795 | } | 
|  | 796 |  | 
|  | 797 | int decode_get_state_sensor_readings_req(const struct pldm_msg *msg, | 
|  | 798 | size_t payload_length, | 
|  | 799 | uint16_t *sensor_id, | 
|  | 800 | bitfield8_t *sensor_rearm, | 
|  | 801 | uint8_t *reserved) | 
|  | 802 | { | 
| Andrew Jeffery | f75aca6 | 2023-04-13 11:27:07 +0930 | [diff] [blame] | 803 | struct pldm_msgbuf _buf; | 
|  | 804 | struct pldm_msgbuf *buf = &_buf; | 
|  | 805 | int rc; | 
|  | 806 |  | 
| Andrew Jeffery | 9c76679 | 2022-08-10 23:12:49 +0930 | [diff] [blame] | 807 | if (msg == NULL || sensor_id == NULL || sensor_rearm == NULL) { | 
|  | 808 | return PLDM_ERROR_INVALID_DATA; | 
|  | 809 | } | 
|  | 810 |  | 
| Andrew Jeffery | f75aca6 | 2023-04-13 11:27:07 +0930 | [diff] [blame] | 811 | rc = pldm_msgbuf_init(buf, PLDM_GET_STATE_SENSOR_READINGS_REQ_BYTES, | 
|  | 812 | msg->payload, payload_length); | 
|  | 813 | if (rc) { | 
|  | 814 | return rc; | 
| Andrew Jeffery | 9c76679 | 2022-08-10 23:12:49 +0930 | [diff] [blame] | 815 | } | 
|  | 816 |  | 
| Andrew Jeffery | f75aca6 | 2023-04-13 11:27:07 +0930 | [diff] [blame] | 817 | pldm_msgbuf_extract(buf, sensor_id); | 
|  | 818 | pldm_msgbuf_extract(buf, &sensor_rearm->byte); | 
|  | 819 | pldm_msgbuf_extract(buf, reserved); | 
| Andrew Jeffery | 9c76679 | 2022-08-10 23:12:49 +0930 | [diff] [blame] | 820 |  | 
| Andrew Jeffery | f75aca6 | 2023-04-13 11:27:07 +0930 | [diff] [blame] | 821 | return pldm_msgbuf_destroy(buf); | 
| Andrew Jeffery | 9c76679 | 2022-08-10 23:12:49 +0930 | [diff] [blame] | 822 | } | 
|  | 823 |  | 
|  | 824 | int encode_sensor_event_data( | 
|  | 825 | struct pldm_sensor_event_data *const event_data, | 
|  | 826 | const size_t event_data_size, const uint16_t sensor_id, | 
|  | 827 | const enum sensor_event_class_states sensor_event_class, | 
|  | 828 | const uint8_t sensor_offset, const uint8_t event_state, | 
|  | 829 | const uint8_t previous_event_state, size_t *const actual_event_data_size) | 
|  | 830 | { | 
|  | 831 | *actual_event_data_size = | 
|  | 832 | (sizeof(*event_data) - sizeof(event_data->event_class) + | 
|  | 833 | sizeof(struct pldm_sensor_event_state_sensor_state)); | 
|  | 834 |  | 
|  | 835 | if (!event_data) { | 
|  | 836 | return PLDM_SUCCESS; | 
|  | 837 | } | 
|  | 838 |  | 
|  | 839 | if (event_data_size < *actual_event_data_size) { | 
|  | 840 | *actual_event_data_size = 0; | 
|  | 841 | return PLDM_ERROR_INVALID_LENGTH; | 
|  | 842 | } | 
|  | 843 |  | 
|  | 844 | event_data->sensor_id = htole16(sensor_id); | 
|  | 845 | event_data->sensor_event_class_type = sensor_event_class; | 
|  | 846 |  | 
|  | 847 | struct pldm_sensor_event_state_sensor_state *const state_data = | 
|  | 848 | (struct pldm_sensor_event_state_sensor_state *) | 
|  | 849 | event_data->event_class; | 
|  | 850 |  | 
|  | 851 | state_data->sensor_offset = sensor_offset; | 
|  | 852 | state_data->event_state = event_state; | 
|  | 853 | state_data->previous_event_state = previous_event_state; | 
|  | 854 |  | 
|  | 855 | return PLDM_SUCCESS; | 
|  | 856 | } | 
|  | 857 |  | 
|  | 858 | int decode_platform_event_message_req(const struct pldm_msg *msg, | 
|  | 859 | size_t payload_length, | 
|  | 860 | uint8_t *format_version, uint8_t *tid, | 
|  | 861 | uint8_t *event_class, | 
|  | 862 | size_t *event_data_offset) | 
|  | 863 | { | 
| Andrew Jeffery | dc48ce3 | 2023-04-13 12:01:42 +0930 | [diff] [blame] | 864 | struct pldm_msgbuf _buf; | 
|  | 865 | struct pldm_msgbuf *buf = &_buf; | 
|  | 866 | int rc; | 
| Andrew Jeffery | 9c76679 | 2022-08-10 23:12:49 +0930 | [diff] [blame] | 867 |  | 
|  | 868 | if (msg == NULL || format_version == NULL || tid == NULL || | 
|  | 869 | event_class == NULL || event_data_offset == NULL) { | 
|  | 870 | return PLDM_ERROR_INVALID_DATA; | 
|  | 871 | } | 
|  | 872 |  | 
| Andrew Jeffery | dc48ce3 | 2023-04-13 12:01:42 +0930 | [diff] [blame] | 873 | rc = pldm_msgbuf_init(buf, PLDM_PLATFORM_EVENT_MESSAGE_MIN_REQ_BYTES, | 
|  | 874 | msg->payload, payload_length); | 
|  | 875 | if (rc) { | 
|  | 876 | return rc; | 
| Andrew Jeffery | 9c76679 | 2022-08-10 23:12:49 +0930 | [diff] [blame] | 877 | } | 
| Andrew Jeffery | 9c76679 | 2022-08-10 23:12:49 +0930 | [diff] [blame] | 878 |  | 
| Andrew Jeffery | dc48ce3 | 2023-04-13 12:01:42 +0930 | [diff] [blame] | 879 | pldm_msgbuf_extract(buf, format_version); | 
|  | 880 | pldm_msgbuf_extract(buf, tid); | 
|  | 881 | pldm_msgbuf_extract(buf, event_class); | 
| Andrew Jeffery | 9c76679 | 2022-08-10 23:12:49 +0930 | [diff] [blame] | 882 | *event_data_offset = | 
|  | 883 | sizeof(*format_version) + sizeof(*tid) + sizeof(*event_class); | 
|  | 884 |  | 
| Andrew Jeffery | dc48ce3 | 2023-04-13 12:01:42 +0930 | [diff] [blame] | 885 | return pldm_msgbuf_destroy(buf); | 
| Andrew Jeffery | 9c76679 | 2022-08-10 23:12:49 +0930 | [diff] [blame] | 886 | } | 
|  | 887 |  | 
|  | 888 | int encode_platform_event_message_resp(uint8_t instance_id, | 
|  | 889 | uint8_t completion_code, | 
|  | 890 | uint8_t platform_event_status, | 
|  | 891 | struct pldm_msg *msg) | 
|  | 892 | { | 
|  | 893 | if (msg == NULL) { | 
|  | 894 | return PLDM_ERROR_INVALID_DATA; | 
|  | 895 | } | 
|  | 896 |  | 
|  | 897 | if (platform_event_status > PLDM_EVENT_LOGGING_REJECTED) { | 
|  | 898 | return PLDM_ERROR_INVALID_DATA; | 
|  | 899 | } | 
|  | 900 |  | 
|  | 901 | struct pldm_header_info header = {0}; | 
|  | 902 | header.msg_type = PLDM_RESPONSE; | 
|  | 903 | header.instance = instance_id; | 
|  | 904 | header.pldm_type = PLDM_PLATFORM; | 
|  | 905 | header.command = PLDM_PLATFORM_EVENT_MESSAGE; | 
|  | 906 |  | 
|  | 907 | uint8_t rc = pack_pldm_header(&header, &(msg->hdr)); | 
|  | 908 | if (rc != PLDM_SUCCESS) { | 
|  | 909 | return rc; | 
|  | 910 | } | 
|  | 911 |  | 
|  | 912 | struct pldm_platform_event_message_resp *response = | 
|  | 913 | (struct pldm_platform_event_message_resp *)msg->payload; | 
|  | 914 | response->completion_code = completion_code; | 
|  | 915 | response->platform_event_status = platform_event_status; | 
|  | 916 |  | 
|  | 917 | return PLDM_SUCCESS; | 
|  | 918 | } | 
|  | 919 |  | 
|  | 920 | int encode_platform_event_message_req( | 
|  | 921 | uint8_t instance_id, uint8_t format_version, uint8_t tid, | 
|  | 922 | uint8_t event_class, const uint8_t *event_data, size_t event_data_length, | 
|  | 923 | struct pldm_msg *msg, size_t payload_length) | 
|  | 924 |  | 
|  | 925 | { | 
|  | 926 | if (format_version != 1) { | 
|  | 927 | return PLDM_ERROR_INVALID_DATA; | 
|  | 928 | } | 
|  | 929 |  | 
|  | 930 | if (msg == NULL || event_data == NULL) { | 
|  | 931 | return PLDM_ERROR_INVALID_DATA; | 
|  | 932 | } | 
|  | 933 |  | 
|  | 934 | if (event_data_length == 0) { | 
|  | 935 | return PLDM_ERROR_INVALID_DATA; | 
|  | 936 | } | 
|  | 937 |  | 
|  | 938 | if (payload_length != | 
|  | 939 | PLDM_PLATFORM_EVENT_MESSAGE_MIN_REQ_BYTES + event_data_length) { | 
|  | 940 | return PLDM_ERROR_INVALID_LENGTH; | 
|  | 941 | } | 
|  | 942 |  | 
|  | 943 | if (event_class > PLDM_HEARTBEAT_TIMER_ELAPSED_EVENT && | 
|  | 944 | !(event_class >= 0xF0 && event_class <= 0xFE)) { | 
|  | 945 | return PLDM_ERROR_INVALID_DATA; | 
|  | 946 | } | 
|  | 947 |  | 
|  | 948 | struct pldm_header_info header = {0}; | 
|  | 949 | header.msg_type = PLDM_REQUEST; | 
|  | 950 | header.instance = instance_id; | 
|  | 951 | header.pldm_type = PLDM_PLATFORM; | 
|  | 952 | header.command = PLDM_PLATFORM_EVENT_MESSAGE; | 
|  | 953 |  | 
|  | 954 | uint8_t rc = pack_pldm_header(&header, &(msg->hdr)); | 
|  | 955 | if (rc != PLDM_SUCCESS) { | 
|  | 956 | return rc; | 
|  | 957 | } | 
|  | 958 |  | 
|  | 959 | struct pldm_platform_event_message_req *request = | 
|  | 960 | (struct pldm_platform_event_message_req *)msg->payload; | 
|  | 961 | request->format_version = format_version; | 
|  | 962 | request->tid = tid; | 
|  | 963 | request->event_class = event_class; | 
|  | 964 | memcpy(request->event_data, event_data, event_data_length); | 
|  | 965 |  | 
|  | 966 | return PLDM_SUCCESS; | 
|  | 967 | } | 
|  | 968 |  | 
|  | 969 | int decode_platform_event_message_resp(const struct pldm_msg *msg, | 
|  | 970 | size_t payload_length, | 
|  | 971 | uint8_t *completion_code, | 
|  | 972 | uint8_t *platform_event_status) | 
|  | 973 | { | 
| Andrew Jeffery | e501177 | 2023-04-13 12:06:22 +0930 | [diff] [blame] | 974 | struct pldm_msgbuf _buf; | 
|  | 975 | struct pldm_msgbuf *buf = &_buf; | 
|  | 976 | int rc; | 
|  | 977 |  | 
| Andrew Jeffery | 9c76679 | 2022-08-10 23:12:49 +0930 | [diff] [blame] | 978 | if (msg == NULL || completion_code == NULL || | 
|  | 979 | platform_event_status == NULL) { | 
|  | 980 | return PLDM_ERROR_INVALID_DATA; | 
|  | 981 | } | 
|  | 982 |  | 
| Andrew Jeffery | e501177 | 2023-04-13 12:06:22 +0930 | [diff] [blame] | 983 | rc = pldm_msgbuf_init(buf, PLDM_PLATFORM_EVENT_MESSAGE_RESP_BYTES, | 
|  | 984 | msg->payload, payload_length); | 
|  | 985 | if (rc) { | 
|  | 986 | return rc; | 
|  | 987 | } | 
|  | 988 |  | 
|  | 989 | rc = pldm_msgbuf_extract(buf, completion_code); | 
|  | 990 | if (rc) { | 
|  | 991 | return rc; | 
|  | 992 | } | 
|  | 993 |  | 
| Andrew Jeffery | 9c76679 | 2022-08-10 23:12:49 +0930 | [diff] [blame] | 994 | if (PLDM_SUCCESS != *completion_code) { | 
|  | 995 | return PLDM_SUCCESS; | 
|  | 996 | } | 
| Andrew Jeffery | 9c76679 | 2022-08-10 23:12:49 +0930 | [diff] [blame] | 997 |  | 
| Andrew Jeffery | e501177 | 2023-04-13 12:06:22 +0930 | [diff] [blame] | 998 | rc = pldm_msgbuf_extract(buf, platform_event_status); | 
|  | 999 | if (rc) { | 
|  | 1000 | return rc; | 
|  | 1001 | } | 
| Andrew Jeffery | 9c76679 | 2022-08-10 23:12:49 +0930 | [diff] [blame] | 1002 |  | 
|  | 1003 | if (*platform_event_status > PLDM_EVENT_LOGGING_REJECTED) { | 
|  | 1004 | return PLDM_ERROR_INVALID_DATA; | 
|  | 1005 | } | 
|  | 1006 |  | 
| Andrew Jeffery | e501177 | 2023-04-13 12:06:22 +0930 | [diff] [blame] | 1007 | return pldm_msgbuf_destroy(buf); | 
| Andrew Jeffery | 9c76679 | 2022-08-10 23:12:49 +0930 | [diff] [blame] | 1008 | } | 
|  | 1009 |  | 
| Dung Cao | d6ae898 | 2022-11-02 10:00:10 +0700 | [diff] [blame] | 1010 | int encode_event_message_buffer_size_req( | 
|  | 1011 | uint8_t instance_id, uint16_t event_receiver_max_buffer_size, | 
|  | 1012 | struct pldm_msg *msg) | 
|  | 1013 | { | 
|  | 1014 | struct pldm_header_info header = {0}; | 
|  | 1015 | header.msg_type = PLDM_REQUEST; | 
|  | 1016 | header.instance = instance_id; | 
|  | 1017 | header.pldm_type = PLDM_PLATFORM; | 
|  | 1018 | header.command = PLDM_EVENT_MESSAGE_BUFFER_SIZE; | 
|  | 1019 |  | 
|  | 1020 | uint8_t rc = pack_pldm_header(&header, &(msg->hdr)); | 
|  | 1021 | if (rc != PLDM_SUCCESS) { | 
|  | 1022 | return rc; | 
|  | 1023 | } | 
|  | 1024 |  | 
|  | 1025 | struct pldm_event_message_buffer_size_req *request = | 
|  | 1026 | (struct pldm_event_message_buffer_size_req *)msg->payload; | 
|  | 1027 | request->event_receiver_max_buffer_size = | 
|  | 1028 | event_receiver_max_buffer_size; | 
|  | 1029 |  | 
|  | 1030 | return PLDM_SUCCESS; | 
|  | 1031 | } | 
|  | 1032 |  | 
|  | 1033 | int decode_event_message_buffer_size_resp(const struct pldm_msg *msg, | 
|  | 1034 | size_t payload_length, | 
|  | 1035 | uint8_t *completion_code, | 
|  | 1036 | uint16_t *terminus_max_buffer_size) | 
|  | 1037 | { | 
| Andrew Jeffery | 1112690 | 2023-04-13 12:12:10 +0930 | [diff] [blame] | 1038 | struct pldm_msgbuf _buf; | 
|  | 1039 | struct pldm_msgbuf *buf = &_buf; | 
|  | 1040 | int rc; | 
|  | 1041 |  | 
| Dung Cao | d6ae898 | 2022-11-02 10:00:10 +0700 | [diff] [blame] | 1042 | if (msg == NULL || completion_code == NULL || | 
|  | 1043 | terminus_max_buffer_size == NULL) { | 
|  | 1044 | return PLDM_ERROR_INVALID_DATA; | 
|  | 1045 | } | 
|  | 1046 |  | 
| Andrew Jeffery | 1112690 | 2023-04-13 12:12:10 +0930 | [diff] [blame] | 1047 | rc = pldm_msgbuf_init(buf, PLDM_EVENT_MESSAGE_BUFFER_SIZE_RESP_BYTES, | 
|  | 1048 | msg->payload, payload_length); | 
|  | 1049 | if (rc) { | 
|  | 1050 | return rc; | 
|  | 1051 | } | 
|  | 1052 |  | 
|  | 1053 | rc = pldm_msgbuf_extract(buf, completion_code); | 
|  | 1054 | if (rc) { | 
|  | 1055 | return rc; | 
|  | 1056 | } | 
|  | 1057 |  | 
| Dung Cao | d6ae898 | 2022-11-02 10:00:10 +0700 | [diff] [blame] | 1058 | if (PLDM_SUCCESS != *completion_code) { | 
|  | 1059 | return PLDM_SUCCESS; | 
|  | 1060 | } | 
| Dung Cao | d6ae898 | 2022-11-02 10:00:10 +0700 | [diff] [blame] | 1061 |  | 
| Andrew Jeffery | 1112690 | 2023-04-13 12:12:10 +0930 | [diff] [blame] | 1062 | pldm_msgbuf_extract(buf, terminus_max_buffer_size); | 
| Dung Cao | d6ae898 | 2022-11-02 10:00:10 +0700 | [diff] [blame] | 1063 |  | 
| Andrew Jeffery | 1112690 | 2023-04-13 12:12:10 +0930 | [diff] [blame] | 1064 | return pldm_msgbuf_destroy_consumed(buf); | 
| Dung Cao | d6ae898 | 2022-11-02 10:00:10 +0700 | [diff] [blame] | 1065 | } | 
|  | 1066 |  | 
| Dung Cao | 1bf8c87 | 2022-11-29 05:32:58 +0700 | [diff] [blame] | 1067 | int encode_event_message_supported_req(uint8_t instance_id, | 
|  | 1068 | uint8_t format_version, | 
|  | 1069 | struct pldm_msg *msg) | 
|  | 1070 | { | 
|  | 1071 | if (format_version != 1) { | 
|  | 1072 | return PLDM_ERROR_INVALID_DATA; | 
|  | 1073 | } | 
|  | 1074 |  | 
|  | 1075 | if (msg == NULL) { | 
|  | 1076 | return PLDM_ERROR_INVALID_DATA; | 
|  | 1077 | } | 
|  | 1078 |  | 
|  | 1079 | struct pldm_header_info header = {0}; | 
|  | 1080 | header.msg_type = PLDM_REQUEST; | 
|  | 1081 | header.instance = instance_id; | 
|  | 1082 | header.pldm_type = PLDM_PLATFORM; | 
|  | 1083 | header.command = PLDM_EVENT_MESSAGE_SUPPORTED; | 
|  | 1084 |  | 
|  | 1085 | uint8_t rc = pack_pldm_header(&header, &(msg->hdr)); | 
|  | 1086 | if (rc != PLDM_SUCCESS) { | 
|  | 1087 | return rc; | 
|  | 1088 | } | 
|  | 1089 |  | 
|  | 1090 | struct pldm_event_message_supported_req *request = | 
|  | 1091 | (struct pldm_event_message_supported_req *)msg->payload; | 
|  | 1092 | request->format_version = format_version; | 
|  | 1093 |  | 
|  | 1094 | return PLDM_SUCCESS; | 
|  | 1095 | } | 
|  | 1096 |  | 
|  | 1097 | int decode_event_message_supported_resp( | 
|  | 1098 | const struct pldm_msg *msg, size_t payload_length, uint8_t *completion_code, | 
|  | 1099 | uint8_t *synchrony_config, bitfield8_t *synchrony_config_support, | 
|  | 1100 | uint8_t *number_event_class_returned, uint8_t *event_class, | 
|  | 1101 | uint8_t event_class_count) | 
|  | 1102 | { | 
| Andrew Jeffery | 2d00ff8 | 2023-04-13 12:34:27 +0930 | [diff] [blame] | 1103 | struct pldm_msgbuf _buf; | 
|  | 1104 | struct pldm_msgbuf *buf = &_buf; | 
|  | 1105 | int i; | 
|  | 1106 | int rc; | 
|  | 1107 |  | 
| Dung Cao | 1bf8c87 | 2022-11-29 05:32:58 +0700 | [diff] [blame] | 1108 | if (msg == NULL || completion_code == NULL || | 
|  | 1109 | synchrony_config == NULL || synchrony_config_support == NULL || | 
|  | 1110 | number_event_class_returned == NULL || event_class == NULL) { | 
|  | 1111 | return PLDM_ERROR_INVALID_DATA; | 
|  | 1112 | } | 
|  | 1113 |  | 
| Andrew Jeffery | 2d00ff8 | 2023-04-13 12:34:27 +0930 | [diff] [blame] | 1114 | rc = pldm_msgbuf_init(buf, PLDM_EVENT_MESSAGE_SUPPORTED_MIN_RESP_BYTES, | 
|  | 1115 | msg->payload, payload_length); | 
|  | 1116 | if (rc) { | 
|  | 1117 | return rc; | 
|  | 1118 | } | 
|  | 1119 |  | 
|  | 1120 | rc = pldm_msgbuf_extract(buf, completion_code); | 
|  | 1121 | if (rc) { | 
|  | 1122 | return rc; | 
|  | 1123 | } | 
|  | 1124 |  | 
| Dung Cao | 1bf8c87 | 2022-11-29 05:32:58 +0700 | [diff] [blame] | 1125 | if (PLDM_SUCCESS != *completion_code) { | 
|  | 1126 | return PLDM_SUCCESS; | 
|  | 1127 | } | 
| Andrew Jeffery | 2d00ff8 | 2023-04-13 12:34:27 +0930 | [diff] [blame] | 1128 |  | 
|  | 1129 | rc = pldm_msgbuf_extract(buf, synchrony_config); | 
|  | 1130 | if (rc) { | 
|  | 1131 | return rc; | 
| Dung Cao | 1bf8c87 | 2022-11-29 05:32:58 +0700 | [diff] [blame] | 1132 | } | 
|  | 1133 |  | 
| Dung Cao | 1bf8c87 | 2022-11-29 05:32:58 +0700 | [diff] [blame] | 1134 | if (*synchrony_config > PLDM_MESSAGE_TYPE_ASYNCHRONOUS_WITH_HEARTBEAT) { | 
|  | 1135 | return PLDM_ERROR_INVALID_DATA; | 
|  | 1136 | } | 
|  | 1137 |  | 
| Andrew Jeffery | 2d00ff8 | 2023-04-13 12:34:27 +0930 | [diff] [blame] | 1138 | pldm_msgbuf_extract(buf, &synchrony_config_support->byte); | 
| Dung Cao | 1bf8c87 | 2022-11-29 05:32:58 +0700 | [diff] [blame] | 1139 |  | 
| Andrew Jeffery | 2d00ff8 | 2023-04-13 12:34:27 +0930 | [diff] [blame] | 1140 | rc = pldm_msgbuf_extract(buf, number_event_class_returned); | 
|  | 1141 | if (rc) { | 
|  | 1142 | return rc; | 
| Dung Cao | 1bf8c87 | 2022-11-29 05:32:58 +0700 | [diff] [blame] | 1143 | } | 
|  | 1144 |  | 
| Andrew Jeffery | 2d00ff8 | 2023-04-13 12:34:27 +0930 | [diff] [blame] | 1145 | if (*number_event_class_returned == 0) { | 
|  | 1146 | return pldm_msgbuf_destroy(buf); | 
|  | 1147 | } | 
|  | 1148 |  | 
|  | 1149 | if (event_class_count < *number_event_class_returned) { | 
|  | 1150 | return PLDM_ERROR_INVALID_LENGTH; | 
|  | 1151 | } | 
|  | 1152 |  | 
|  | 1153 | for (i = 0; i < *number_event_class_returned; i++) { | 
|  | 1154 | pldm_msgbuf_extract(buf, &event_class[i]); | 
|  | 1155 | } | 
|  | 1156 |  | 
|  | 1157 | return pldm_msgbuf_destroy_consumed(buf); | 
| Dung Cao | 1bf8c87 | 2022-11-29 05:32:58 +0700 | [diff] [blame] | 1158 | } | 
|  | 1159 |  | 
| Andrew Jeffery | 9c76679 | 2022-08-10 23:12:49 +0930 | [diff] [blame] | 1160 | int decode_sensor_event_data(const uint8_t *event_data, | 
|  | 1161 | size_t event_data_length, uint16_t *sensor_id, | 
|  | 1162 | uint8_t *sensor_event_class_type, | 
|  | 1163 | size_t *event_class_data_offset) | 
|  | 1164 | { | 
| Andrew Jeffery | 4fd4595 | 2023-04-13 13:01:45 +0930 | [diff] [blame] | 1165 | struct pldm_msgbuf _buf; | 
|  | 1166 | struct pldm_msgbuf *buf = &_buf; | 
|  | 1167 | int rc; | 
|  | 1168 |  | 
|  | 1169 | rc = pldm_msgbuf_init(buf, PLDM_SENSOR_EVENT_DATA_MIN_LENGTH, | 
|  | 1170 | event_data, event_data_length); | 
|  | 1171 | if (rc) { | 
|  | 1172 | return rc; | 
| Andrew Jeffery | 9c76679 | 2022-08-10 23:12:49 +0930 | [diff] [blame] | 1173 | } | 
|  | 1174 |  | 
|  | 1175 | size_t event_class_data_length = | 
|  | 1176 | event_data_length - PLDM_PLATFORM_EVENT_MESSAGE_MIN_REQ_BYTES; | 
|  | 1177 |  | 
| Andrew Jeffery | 4fd4595 | 2023-04-13 13:01:45 +0930 | [diff] [blame] | 1178 | pldm_msgbuf_extract(buf, sensor_id); | 
|  | 1179 | rc = pldm_msgbuf_extract(buf, sensor_event_class_type); | 
|  | 1180 | if (rc) { | 
|  | 1181 | return rc; | 
|  | 1182 | } | 
|  | 1183 |  | 
|  | 1184 | if (*sensor_event_class_type == PLDM_SENSOR_OP_STATE) { | 
| Andrew Jeffery | 9c76679 | 2022-08-10 23:12:49 +0930 | [diff] [blame] | 1185 | if (event_class_data_length != | 
|  | 1186 | PLDM_SENSOR_EVENT_SENSOR_OP_STATE_DATA_LENGTH) { | 
|  | 1187 | return PLDM_ERROR_INVALID_LENGTH; | 
|  | 1188 | } | 
| Andrew Jeffery | 4fd4595 | 2023-04-13 13:01:45 +0930 | [diff] [blame] | 1189 | } else if (*sensor_event_class_type == PLDM_STATE_SENSOR_STATE) { | 
| Andrew Jeffery | 9c76679 | 2022-08-10 23:12:49 +0930 | [diff] [blame] | 1190 | if (event_class_data_length != | 
|  | 1191 | PLDM_SENSOR_EVENT_STATE_SENSOR_STATE_DATA_LENGTH) { | 
|  | 1192 | return PLDM_ERROR_INVALID_LENGTH; | 
|  | 1193 | } | 
| Andrew Jeffery | 4fd4595 | 2023-04-13 13:01:45 +0930 | [diff] [blame] | 1194 | } else if (*sensor_event_class_type == PLDM_NUMERIC_SENSOR_STATE) { | 
| Andrew Jeffery | 9c76679 | 2022-08-10 23:12:49 +0930 | [diff] [blame] | 1195 | if (event_class_data_length < | 
|  | 1196 | PLDM_SENSOR_EVENT_NUMERIC_SENSOR_STATE_MIN_DATA_LENGTH || | 
|  | 1197 | event_class_data_length > | 
|  | 1198 | PLDM_SENSOR_EVENT_NUMERIC_SENSOR_STATE_MAX_DATA_LENGTH) { | 
|  | 1199 | return PLDM_ERROR_INVALID_LENGTH; | 
|  | 1200 | } | 
|  | 1201 | } else { | 
|  | 1202 | return PLDM_ERROR_INVALID_DATA; | 
|  | 1203 | } | 
| Andrew Jeffery | 4fd4595 | 2023-04-13 13:01:45 +0930 | [diff] [blame] | 1204 |  | 
| Andrew Jeffery | 9c76679 | 2022-08-10 23:12:49 +0930 | [diff] [blame] | 1205 | *event_class_data_offset = | 
|  | 1206 | sizeof(*sensor_id) + sizeof(*sensor_event_class_type); | 
| Andrew Jeffery | 4fd4595 | 2023-04-13 13:01:45 +0930 | [diff] [blame] | 1207 |  | 
|  | 1208 | return pldm_msgbuf_destroy(buf); | 
| Andrew Jeffery | 9c76679 | 2022-08-10 23:12:49 +0930 | [diff] [blame] | 1209 | } | 
|  | 1210 |  | 
|  | 1211 | int decode_sensor_op_data(const uint8_t *sensor_data, size_t sensor_data_length, | 
|  | 1212 | uint8_t *present_op_state, uint8_t *previous_op_state) | 
|  | 1213 | { | 
| Andrew Jeffery | 4888ee5 | 2023-04-13 13:14:05 +0930 | [diff] [blame] | 1214 | struct pldm_msgbuf _buf; | 
|  | 1215 | struct pldm_msgbuf *buf = &_buf; | 
|  | 1216 | int rc; | 
|  | 1217 |  | 
|  | 1218 | if (present_op_state == NULL || previous_op_state == NULL) { | 
| Andrew Jeffery | 9c76679 | 2022-08-10 23:12:49 +0930 | [diff] [blame] | 1219 | return PLDM_ERROR_INVALID_DATA; | 
|  | 1220 | } | 
| Andrew Jeffery | 4888ee5 | 2023-04-13 13:14:05 +0930 | [diff] [blame] | 1221 |  | 
|  | 1222 | rc = | 
|  | 1223 | pldm_msgbuf_init(buf, PLDM_SENSOR_EVENT_SENSOR_OP_STATE_DATA_LENGTH, | 
|  | 1224 | sensor_data, sensor_data_length); | 
|  | 1225 | if (rc) { | 
|  | 1226 | return rc; | 
| Andrew Jeffery | 9c76679 | 2022-08-10 23:12:49 +0930 | [diff] [blame] | 1227 | } | 
|  | 1228 |  | 
| Andrew Jeffery | 4888ee5 | 2023-04-13 13:14:05 +0930 | [diff] [blame] | 1229 | pldm_msgbuf_extract(buf, present_op_state); | 
|  | 1230 | pldm_msgbuf_extract(buf, previous_op_state); | 
|  | 1231 |  | 
|  | 1232 | return pldm_msgbuf_destroy_consumed(buf); | 
| Andrew Jeffery | 9c76679 | 2022-08-10 23:12:49 +0930 | [diff] [blame] | 1233 | } | 
|  | 1234 |  | 
|  | 1235 | int decode_state_sensor_data(const uint8_t *sensor_data, | 
|  | 1236 | size_t sensor_data_length, uint8_t *sensor_offset, | 
|  | 1237 | uint8_t *event_state, | 
|  | 1238 | uint8_t *previous_event_state) | 
|  | 1239 | { | 
| Andrew Jeffery | 422790b | 2023-04-13 15:03:47 +0930 | [diff] [blame^] | 1240 | struct pldm_msgbuf _buf; | 
|  | 1241 | struct pldm_msgbuf *buf = &_buf; | 
|  | 1242 | int rc; | 
|  | 1243 |  | 
|  | 1244 | if (sensor_offset == NULL || event_state == NULL || | 
|  | 1245 | previous_event_state == NULL) { | 
| Andrew Jeffery | 9c76679 | 2022-08-10 23:12:49 +0930 | [diff] [blame] | 1246 | return PLDM_ERROR_INVALID_DATA; | 
|  | 1247 | } | 
| Andrew Jeffery | 422790b | 2023-04-13 15:03:47 +0930 | [diff] [blame^] | 1248 |  | 
|  | 1249 | rc = pldm_msgbuf_init(buf, | 
|  | 1250 | PLDM_SENSOR_EVENT_STATE_SENSOR_STATE_DATA_LENGTH, | 
|  | 1251 | sensor_data, sensor_data_length); | 
|  | 1252 | if (rc) { | 
|  | 1253 | return rc; | 
| Andrew Jeffery | 9c76679 | 2022-08-10 23:12:49 +0930 | [diff] [blame] | 1254 | } | 
|  | 1255 |  | 
| Andrew Jeffery | 422790b | 2023-04-13 15:03:47 +0930 | [diff] [blame^] | 1256 | pldm_msgbuf_extract(buf, sensor_offset); | 
|  | 1257 | pldm_msgbuf_extract(buf, event_state); | 
|  | 1258 | pldm_msgbuf_extract(buf, previous_event_state); | 
|  | 1259 |  | 
|  | 1260 | return pldm_msgbuf_destroy_consumed(buf); | 
| Andrew Jeffery | 9c76679 | 2022-08-10 23:12:49 +0930 | [diff] [blame] | 1261 | } | 
|  | 1262 |  | 
|  | 1263 | int decode_numeric_sensor_data(const uint8_t *sensor_data, | 
|  | 1264 | size_t sensor_data_length, uint8_t *event_state, | 
|  | 1265 | uint8_t *previous_event_state, | 
|  | 1266 | uint8_t *sensor_data_size, | 
|  | 1267 | uint32_t *present_reading) | 
|  | 1268 | { | 
|  | 1269 | if (sensor_data == NULL || sensor_data_size == NULL || | 
|  | 1270 | event_state == NULL || previous_event_state == NULL || | 
|  | 1271 | present_reading == NULL) { | 
|  | 1272 | return PLDM_ERROR_INVALID_DATA; | 
|  | 1273 | } | 
|  | 1274 | if (sensor_data_length < | 
|  | 1275 | PLDM_SENSOR_EVENT_NUMERIC_SENSOR_STATE_MIN_DATA_LENGTH || | 
|  | 1276 | sensor_data_length > | 
|  | 1277 | PLDM_SENSOR_EVENT_NUMERIC_SENSOR_STATE_MAX_DATA_LENGTH) { | 
|  | 1278 | return PLDM_ERROR_INVALID_LENGTH; | 
|  | 1279 | } | 
|  | 1280 | struct pldm_sensor_event_numeric_sensor_state *numeric_sensor_data = | 
|  | 1281 | (struct pldm_sensor_event_numeric_sensor_state *)sensor_data; | 
|  | 1282 | *event_state = numeric_sensor_data->event_state; | 
|  | 1283 | *previous_event_state = numeric_sensor_data->previous_event_state; | 
|  | 1284 | *sensor_data_size = numeric_sensor_data->sensor_data_size; | 
|  | 1285 | uint8_t *present_reading_ptr = numeric_sensor_data->present_reading; | 
|  | 1286 |  | 
|  | 1287 | switch (*sensor_data_size) { | 
|  | 1288 | case PLDM_SENSOR_DATA_SIZE_UINT8: | 
| Andrew Jeffery | 9c76679 | 2022-08-10 23:12:49 +0930 | [diff] [blame] | 1289 | if (sensor_data_length != | 
|  | 1290 | PLDM_SENSOR_EVENT_NUMERIC_SENSOR_STATE_8BIT_DATA_LENGTH) { | 
|  | 1291 | return PLDM_ERROR_INVALID_LENGTH; | 
|  | 1292 | } | 
|  | 1293 | *present_reading = present_reading_ptr[0]; | 
|  | 1294 | break; | 
| Andrew Jeffery | 92f6c3c | 2023-04-13 15:50:10 +0930 | [diff] [blame] | 1295 | case PLDM_SENSOR_DATA_SIZE_SINT8: | 
|  | 1296 | if (sensor_data_length != | 
|  | 1297 | PLDM_SENSOR_EVENT_NUMERIC_SENSOR_STATE_8BIT_DATA_LENGTH) { | 
|  | 1298 | return PLDM_ERROR_INVALID_LENGTH; | 
|  | 1299 | } | 
|  | 1300 | *present_reading = (uint32_t)(int32_t)present_reading_ptr[0]; | 
|  | 1301 | break; | 
|  | 1302 | case PLDM_SENSOR_DATA_SIZE_UINT16: { | 
|  | 1303 | uint16_t val_le; | 
|  | 1304 |  | 
| Andrew Jeffery | 9c76679 | 2022-08-10 23:12:49 +0930 | [diff] [blame] | 1305 | if (sensor_data_length != | 
|  | 1306 | PLDM_SENSOR_EVENT_NUMERIC_SENSOR_STATE_16BIT_DATA_LENGTH) { | 
|  | 1307 | return PLDM_ERROR_INVALID_LENGTH; | 
|  | 1308 | } | 
| Andrew Jeffery | 92f6c3c | 2023-04-13 15:50:10 +0930 | [diff] [blame] | 1309 |  | 
|  | 1310 | memcpy(&val_le, present_reading_ptr, sizeof(val_le)); | 
|  | 1311 | *present_reading = (uint32_t)(le16toh(val_le)); | 
| Andrew Jeffery | 9c76679 | 2022-08-10 23:12:49 +0930 | [diff] [blame] | 1312 | break; | 
| Andrew Jeffery | 92f6c3c | 2023-04-13 15:50:10 +0930 | [diff] [blame] | 1313 | } | 
|  | 1314 | case PLDM_SENSOR_DATA_SIZE_SINT16: { | 
|  | 1315 | uint16_t val_le; | 
|  | 1316 |  | 
|  | 1317 | if (sensor_data_length != | 
|  | 1318 | PLDM_SENSOR_EVENT_NUMERIC_SENSOR_STATE_16BIT_DATA_LENGTH) { | 
|  | 1319 | return PLDM_ERROR_INVALID_LENGTH; | 
|  | 1320 | } | 
|  | 1321 |  | 
|  | 1322 | memcpy(&val_le, present_reading_ptr, sizeof(val_le)); | 
|  | 1323 | *present_reading = (uint32_t)(int32_t)(le16toh(val_le)); | 
|  | 1324 | break; | 
|  | 1325 | } | 
| Andrew Jeffery | 9c76679 | 2022-08-10 23:12:49 +0930 | [diff] [blame] | 1326 | case PLDM_SENSOR_DATA_SIZE_UINT32: | 
| Andrew Jeffery | 92f6c3c | 2023-04-13 15:50:10 +0930 | [diff] [blame] | 1327 | case PLDM_SENSOR_DATA_SIZE_SINT32: { | 
|  | 1328 | uint32_t val_le; | 
|  | 1329 |  | 
| Andrew Jeffery | 9c76679 | 2022-08-10 23:12:49 +0930 | [diff] [blame] | 1330 | if (sensor_data_length != | 
|  | 1331 | PLDM_SENSOR_EVENT_NUMERIC_SENSOR_STATE_32BIT_DATA_LENGTH) { | 
|  | 1332 | return PLDM_ERROR_INVALID_LENGTH; | 
|  | 1333 | } | 
| Andrew Jeffery | 92f6c3c | 2023-04-13 15:50:10 +0930 | [diff] [blame] | 1334 |  | 
|  | 1335 | memcpy(&val_le, present_reading_ptr, sizeof(val_le)); | 
|  | 1336 | *present_reading = le32toh(val_le); | 
| Andrew Jeffery | 9c76679 | 2022-08-10 23:12:49 +0930 | [diff] [blame] | 1337 | break; | 
| Andrew Jeffery | 92f6c3c | 2023-04-13 15:50:10 +0930 | [diff] [blame] | 1338 | } | 
| Andrew Jeffery | 9c76679 | 2022-08-10 23:12:49 +0930 | [diff] [blame] | 1339 | default: | 
|  | 1340 | return PLDM_ERROR_INVALID_DATA; | 
|  | 1341 | } | 
|  | 1342 | return PLDM_SUCCESS; | 
|  | 1343 | } | 
|  | 1344 |  | 
| Andrew Jeffery | 7992eb8 | 2023-04-06 16:13:53 +0930 | [diff] [blame] | 1345 | #define PLDM_NUMERIC_SENSOR_VALUE_PDR_MIN_SIZE 69 | 
|  | 1346 | int decode_numeric_sensor_pdr_data( | 
|  | 1347 | const void *pdr_data, size_t pdr_data_length, | 
|  | 1348 | struct pldm_numeric_sensor_value_pdr *pdr_value) | 
|  | 1349 | { | 
|  | 1350 | struct pldm_msgbuf _buf; | 
|  | 1351 | struct pldm_msgbuf *buf = &_buf; | 
|  | 1352 | int rc; | 
|  | 1353 |  | 
|  | 1354 | rc = pldm_msgbuf_init(buf, PLDM_NUMERIC_SENSOR_VALUE_PDR_MIN_SIZE, | 
|  | 1355 | pdr_data, pdr_data_length); | 
|  | 1356 | if (rc) { | 
|  | 1357 | return rc; | 
|  | 1358 | } | 
|  | 1359 |  | 
|  | 1360 | rc = pldm_msgbuf_extract_value_pdr_hdr(buf, &pdr_value->hdr); | 
|  | 1361 | if (rc) { | 
|  | 1362 | return rc; | 
|  | 1363 | } | 
|  | 1364 |  | 
|  | 1365 | rc = pldm_platform_pdr_hdr_validate( | 
|  | 1366 | &pdr_value->hdr, PLDM_NUMERIC_SENSOR_VALUE_PDR_MIN_SIZE, | 
|  | 1367 | pdr_data_length); | 
|  | 1368 | if (rc) { | 
|  | 1369 | return rc; | 
|  | 1370 | } | 
|  | 1371 |  | 
|  | 1372 | pldm_msgbuf_extract(buf, &pdr_value->terminus_handle); | 
|  | 1373 | pldm_msgbuf_extract(buf, &pdr_value->sensor_id); | 
|  | 1374 | pldm_msgbuf_extract(buf, &pdr_value->entity_type); | 
|  | 1375 | pldm_msgbuf_extract(buf, &pdr_value->entity_instance_num); | 
|  | 1376 | pldm_msgbuf_extract(buf, &pdr_value->container_id); | 
|  | 1377 | pldm_msgbuf_extract(buf, &pdr_value->sensor_init); | 
|  | 1378 | pldm_msgbuf_extract(buf, &pdr_value->sensor_auxiliary_names_pdr); | 
|  | 1379 | pldm_msgbuf_extract(buf, &pdr_value->base_unit); | 
|  | 1380 | pldm_msgbuf_extract(buf, &pdr_value->unit_modifier); | 
|  | 1381 | pldm_msgbuf_extract(buf, &pdr_value->rate_unit); | 
|  | 1382 | pldm_msgbuf_extract(buf, &pdr_value->base_oem_unit_handle); | 
|  | 1383 | pldm_msgbuf_extract(buf, &pdr_value->aux_unit); | 
|  | 1384 | pldm_msgbuf_extract(buf, &pdr_value->aux_unit_modifier); | 
|  | 1385 | pldm_msgbuf_extract(buf, &pdr_value->aux_rate_unit); | 
|  | 1386 | pldm_msgbuf_extract(buf, &pdr_value->rel); | 
|  | 1387 | pldm_msgbuf_extract(buf, &pdr_value->aux_oem_unit_handle); | 
|  | 1388 | pldm_msgbuf_extract(buf, &pdr_value->is_linear); | 
|  | 1389 |  | 
|  | 1390 | rc = pldm_msgbuf_extract(buf, &pdr_value->sensor_data_size); | 
|  | 1391 | if (rc) { | 
|  | 1392 | return rc; | 
|  | 1393 | } | 
|  | 1394 | if (pdr_value->sensor_data_size > PLDM_SENSOR_DATA_SIZE_MAX) { | 
|  | 1395 | return PLDM_ERROR_INVALID_DATA; | 
|  | 1396 | } | 
|  | 1397 |  | 
|  | 1398 | pldm_msgbuf_extract(buf, &pdr_value->resolution); | 
|  | 1399 | pldm_msgbuf_extract(buf, &pdr_value->offset); | 
|  | 1400 | pldm_msgbuf_extract(buf, &pdr_value->accuracy); | 
|  | 1401 | pldm_msgbuf_extract(buf, &pdr_value->plus_tolerance); | 
|  | 1402 | pldm_msgbuf_extract(buf, &pdr_value->minus_tolerance); | 
|  | 1403 | pldm_msgbuf_extract_sensor_data(buf, pdr_value->sensor_data_size, | 
|  | 1404 | &pdr_value->hysteresis); | 
|  | 1405 | pldm_msgbuf_extract(buf, &pdr_value->supported_thresholds.byte); | 
|  | 1406 | pldm_msgbuf_extract( | 
|  | 1407 | buf, &pdr_value->threshold_and_hysteresis_volatility.byte); | 
|  | 1408 | pldm_msgbuf_extract(buf, &pdr_value->state_transition_interval); | 
|  | 1409 | pldm_msgbuf_extract(buf, &pdr_value->update_interval); | 
|  | 1410 | pldm_msgbuf_extract_sensor_data(buf, pdr_value->sensor_data_size, | 
|  | 1411 | &pdr_value->max_readable); | 
|  | 1412 | pldm_msgbuf_extract_sensor_data(buf, pdr_value->sensor_data_size, | 
|  | 1413 | &pdr_value->min_readable); | 
|  | 1414 |  | 
|  | 1415 | rc = pldm_msgbuf_extract(buf, &pdr_value->range_field_format); | 
|  | 1416 | if (rc) { | 
|  | 1417 | return rc; | 
|  | 1418 | } | 
|  | 1419 | if (pdr_value->range_field_format > PLDM_RANGE_FIELD_FORMAT_MAX) { | 
|  | 1420 | return PLDM_ERROR_INVALID_DATA; | 
|  | 1421 | } | 
|  | 1422 |  | 
|  | 1423 | pldm_msgbuf_extract(buf, &pdr_value->range_field_support.byte); | 
|  | 1424 | pldm_msgbuf_extract_range_field_format( | 
|  | 1425 | buf, pdr_value->range_field_format, &pdr_value->nominal_value); | 
|  | 1426 | pldm_msgbuf_extract_range_field_format( | 
|  | 1427 | buf, pdr_value->range_field_format, &pdr_value->normal_max); | 
|  | 1428 | pldm_msgbuf_extract_range_field_format( | 
|  | 1429 | buf, pdr_value->range_field_format, &pdr_value->normal_min); | 
|  | 1430 | pldm_msgbuf_extract_range_field_format( | 
|  | 1431 | buf, pdr_value->range_field_format, &pdr_value->warning_high); | 
|  | 1432 | pldm_msgbuf_extract_range_field_format( | 
|  | 1433 | buf, pdr_value->range_field_format, &pdr_value->warning_low); | 
|  | 1434 | pldm_msgbuf_extract_range_field_format( | 
|  | 1435 | buf, pdr_value->range_field_format, &pdr_value->critical_high); | 
|  | 1436 | pldm_msgbuf_extract_range_field_format( | 
|  | 1437 | buf, pdr_value->range_field_format, &pdr_value->critical_low); | 
|  | 1438 | pldm_msgbuf_extract_range_field_format( | 
|  | 1439 | buf, pdr_value->range_field_format, &pdr_value->fatal_high); | 
|  | 1440 | pldm_msgbuf_extract_range_field_format( | 
|  | 1441 | buf, pdr_value->range_field_format, &pdr_value->fatal_low); | 
|  | 1442 |  | 
|  | 1443 | return pldm_msgbuf_destroy(buf); | 
|  | 1444 | } | 
|  | 1445 |  | 
| Andrew Jeffery | 9c76679 | 2022-08-10 23:12:49 +0930 | [diff] [blame] | 1446 | int encode_get_numeric_effecter_value_req(uint8_t instance_id, | 
|  | 1447 | uint16_t effecter_id, | 
|  | 1448 | struct pldm_msg *msg) | 
|  | 1449 | { | 
|  | 1450 | if (msg == NULL) { | 
|  | 1451 | return PLDM_ERROR_INVALID_DATA; | 
|  | 1452 | } | 
|  | 1453 |  | 
|  | 1454 | struct pldm_header_info header = {0}; | 
|  | 1455 | header.msg_type = PLDM_REQUEST; | 
|  | 1456 | header.instance = instance_id; | 
|  | 1457 | header.pldm_type = PLDM_PLATFORM; | 
|  | 1458 | header.command = PLDM_GET_NUMERIC_EFFECTER_VALUE; | 
|  | 1459 |  | 
|  | 1460 | uint8_t rc = pack_pldm_header(&header, &(msg->hdr)); | 
|  | 1461 | if (rc != PLDM_SUCCESS) { | 
|  | 1462 | return rc; | 
|  | 1463 | } | 
|  | 1464 |  | 
|  | 1465 | struct pldm_get_numeric_effecter_value_req *request = | 
|  | 1466 | (struct pldm_get_numeric_effecter_value_req *)msg->payload; | 
|  | 1467 | request->effecter_id = htole16(effecter_id); | 
|  | 1468 |  | 
|  | 1469 | return PLDM_SUCCESS; | 
|  | 1470 | } | 
|  | 1471 |  | 
|  | 1472 | int encode_get_numeric_effecter_value_resp( | 
|  | 1473 | uint8_t instance_id, uint8_t completion_code, uint8_t effecter_data_size, | 
| Andrew Jeffery | debe6b3 | 2023-04-05 20:30:46 +0930 | [diff] [blame] | 1474 | uint8_t effecter_oper_state, const uint8_t *pending_value, | 
|  | 1475 | const uint8_t *present_value, struct pldm_msg *msg, size_t payload_length) | 
| Andrew Jeffery | 9c76679 | 2022-08-10 23:12:49 +0930 | [diff] [blame] | 1476 | { | 
|  | 1477 | if (msg == NULL || pending_value == NULL || present_value == NULL) { | 
|  | 1478 | return PLDM_ERROR_INVALID_DATA; | 
|  | 1479 | } | 
|  | 1480 |  | 
|  | 1481 | if (effecter_data_size > PLDM_EFFECTER_DATA_SIZE_SINT32) { | 
|  | 1482 | return PLDM_ERROR_INVALID_DATA; | 
|  | 1483 | } | 
|  | 1484 |  | 
|  | 1485 | if (effecter_oper_state > EFFECTER_OPER_STATE_INTEST) { | 
|  | 1486 | return PLDM_ERROR_INVALID_DATA; | 
|  | 1487 | } | 
|  | 1488 |  | 
|  | 1489 | struct pldm_header_info header = {0}; | 
|  | 1490 | header.msg_type = PLDM_RESPONSE; | 
|  | 1491 | header.instance = instance_id; | 
|  | 1492 | header.pldm_type = PLDM_PLATFORM; | 
|  | 1493 | header.command = PLDM_GET_NUMERIC_EFFECTER_VALUE; | 
|  | 1494 |  | 
|  | 1495 | uint8_t rc = pack_pldm_header(&header, &(msg->hdr)); | 
|  | 1496 | if (rc != PLDM_SUCCESS) { | 
|  | 1497 | return rc; | 
|  | 1498 | } | 
|  | 1499 |  | 
|  | 1500 | struct pldm_get_numeric_effecter_value_resp *response = | 
|  | 1501 | (struct pldm_get_numeric_effecter_value_resp *)msg->payload; | 
|  | 1502 |  | 
|  | 1503 | response->completion_code = completion_code; | 
|  | 1504 | response->effecter_data_size = effecter_data_size; | 
|  | 1505 | response->effecter_oper_state = effecter_oper_state; | 
|  | 1506 |  | 
|  | 1507 | if (effecter_data_size == PLDM_EFFECTER_DATA_SIZE_UINT8 || | 
|  | 1508 | effecter_data_size == PLDM_EFFECTER_DATA_SIZE_SINT8) { | 
|  | 1509 | if (payload_length != | 
|  | 1510 | PLDM_GET_NUMERIC_EFFECTER_VALUE_MIN_RESP_BYTES) { | 
|  | 1511 | return PLDM_ERROR_INVALID_LENGTH; | 
|  | 1512 | } | 
|  | 1513 | response->pending_and_present_values[0] = *pending_value; | 
|  | 1514 | response->pending_and_present_values[1] = *present_value; | 
|  | 1515 |  | 
|  | 1516 | } else if (effecter_data_size == PLDM_EFFECTER_DATA_SIZE_UINT16 || | 
|  | 1517 | effecter_data_size == PLDM_EFFECTER_DATA_SIZE_SINT16) { | 
|  | 1518 | if (payload_length != | 
|  | 1519 | PLDM_GET_NUMERIC_EFFECTER_VALUE_MIN_RESP_BYTES + 2) { | 
|  | 1520 | return PLDM_ERROR_INVALID_LENGTH; | 
|  | 1521 | } | 
|  | 1522 | uint16_t val_pending = *(uint16_t *)pending_value; | 
|  | 1523 | val_pending = htole16(val_pending); | 
|  | 1524 | memcpy(response->pending_and_present_values, &val_pending, | 
|  | 1525 | sizeof(uint16_t)); | 
|  | 1526 | uint16_t val_present = *(uint16_t *)present_value; | 
|  | 1527 | val_present = htole16(val_present); | 
|  | 1528 | memcpy( | 
|  | 1529 | (response->pending_and_present_values + sizeof(uint16_t)), | 
|  | 1530 | &val_present, sizeof(uint16_t)); | 
|  | 1531 |  | 
|  | 1532 | } else if (effecter_data_size == PLDM_EFFECTER_DATA_SIZE_UINT32 || | 
|  | 1533 | effecter_data_size == PLDM_EFFECTER_DATA_SIZE_SINT32) { | 
|  | 1534 | if (payload_length != | 
|  | 1535 | PLDM_GET_NUMERIC_EFFECTER_VALUE_MIN_RESP_BYTES + 6) { | 
|  | 1536 | return PLDM_ERROR_INVALID_LENGTH; | 
|  | 1537 | } | 
|  | 1538 | uint32_t val_pending = *(uint32_t *)pending_value; | 
|  | 1539 | val_pending = htole32(val_pending); | 
|  | 1540 | memcpy(response->pending_and_present_values, &val_pending, | 
|  | 1541 | sizeof(uint32_t)); | 
|  | 1542 | uint32_t val_present = *(uint32_t *)present_value; | 
|  | 1543 | val_present = htole32(val_present); | 
|  | 1544 | memcpy( | 
|  | 1545 | (response->pending_and_present_values + sizeof(uint32_t)), | 
|  | 1546 | &val_present, sizeof(uint32_t)); | 
|  | 1547 | } | 
|  | 1548 | return PLDM_SUCCESS; | 
|  | 1549 | } | 
|  | 1550 |  | 
|  | 1551 | int decode_get_numeric_effecter_value_req(const struct pldm_msg *msg, | 
|  | 1552 | size_t payload_length, | 
|  | 1553 | uint16_t *effecter_id) | 
|  | 1554 | { | 
|  | 1555 | if (msg == NULL || effecter_id == NULL) { | 
|  | 1556 | return PLDM_ERROR_INVALID_DATA; | 
|  | 1557 | } | 
|  | 1558 |  | 
|  | 1559 | if (payload_length != PLDM_GET_NUMERIC_EFFECTER_VALUE_REQ_BYTES) { | 
|  | 1560 | return PLDM_ERROR_INVALID_LENGTH; | 
|  | 1561 | } | 
|  | 1562 |  | 
|  | 1563 | struct pldm_get_numeric_effecter_value_req *request = | 
|  | 1564 | (struct pldm_get_numeric_effecter_value_req *)msg->payload; | 
|  | 1565 |  | 
|  | 1566 | *effecter_id = le16toh(request->effecter_id); | 
|  | 1567 |  | 
|  | 1568 | return PLDM_SUCCESS; | 
|  | 1569 | } | 
|  | 1570 |  | 
|  | 1571 | int decode_get_numeric_effecter_value_resp( | 
|  | 1572 | const struct pldm_msg *msg, size_t payload_length, uint8_t *completion_code, | 
|  | 1573 | uint8_t *effecter_data_size, uint8_t *effecter_oper_state, | 
|  | 1574 | uint8_t *pending_value, uint8_t *present_value) | 
|  | 1575 | { | 
|  | 1576 | if (msg == NULL || effecter_data_size == NULL || | 
|  | 1577 | effecter_oper_state == NULL || pending_value == NULL || | 
|  | 1578 | present_value == NULL) { | 
|  | 1579 | return PLDM_ERROR_INVALID_DATA; | 
|  | 1580 | } | 
|  | 1581 |  | 
|  | 1582 | *completion_code = msg->payload[0]; | 
|  | 1583 | if (PLDM_SUCCESS != *completion_code) { | 
|  | 1584 | return PLDM_SUCCESS; | 
|  | 1585 | } | 
|  | 1586 |  | 
|  | 1587 | if (payload_length < PLDM_GET_NUMERIC_EFFECTER_VALUE_MIN_RESP_BYTES) { | 
|  | 1588 | return PLDM_ERROR_INVALID_LENGTH; | 
|  | 1589 | } | 
|  | 1590 |  | 
|  | 1591 | struct pldm_get_numeric_effecter_value_resp *response = | 
|  | 1592 | (struct pldm_get_numeric_effecter_value_resp *)msg->payload; | 
|  | 1593 |  | 
|  | 1594 | *effecter_data_size = response->effecter_data_size; | 
|  | 1595 | *effecter_oper_state = response->effecter_oper_state; | 
|  | 1596 |  | 
|  | 1597 | if (*effecter_data_size > PLDM_EFFECTER_DATA_SIZE_SINT32) { | 
|  | 1598 | return PLDM_ERROR_INVALID_DATA; | 
|  | 1599 | } | 
|  | 1600 |  | 
|  | 1601 | if (*effecter_oper_state > EFFECTER_OPER_STATE_INTEST) { | 
|  | 1602 | return PLDM_ERROR_INVALID_DATA; | 
|  | 1603 | } | 
|  | 1604 |  | 
|  | 1605 | if (*effecter_data_size == PLDM_EFFECTER_DATA_SIZE_UINT8 || | 
|  | 1606 | *effecter_data_size == PLDM_EFFECTER_DATA_SIZE_SINT8) { | 
|  | 1607 | if (payload_length != | 
|  | 1608 | PLDM_GET_NUMERIC_EFFECTER_VALUE_MIN_RESP_BYTES) { | 
|  | 1609 | return PLDM_ERROR_INVALID_LENGTH; | 
|  | 1610 | } | 
|  | 1611 | memcpy(pending_value, response->pending_and_present_values, 1); | 
|  | 1612 | memcpy(present_value, &response->pending_and_present_values[1], | 
|  | 1613 | 1); | 
|  | 1614 |  | 
|  | 1615 | } else if (*effecter_data_size == PLDM_EFFECTER_DATA_SIZE_UINT16 || | 
|  | 1616 | *effecter_data_size == PLDM_EFFECTER_DATA_SIZE_SINT16) { | 
|  | 1617 | if (payload_length != | 
|  | 1618 | PLDM_GET_NUMERIC_EFFECTER_VALUE_MIN_RESP_BYTES + 2) { | 
|  | 1619 | return PLDM_ERROR_INVALID_LENGTH; | 
|  | 1620 | } | 
|  | 1621 | memcpy(pending_value, response->pending_and_present_values, | 
|  | 1622 | sizeof(uint16_t)); | 
|  | 1623 | uint16_t *val_pending = (uint16_t *)pending_value; | 
|  | 1624 | *val_pending = le16toh(*val_pending); | 
|  | 1625 | memcpy( | 
|  | 1626 | present_value, | 
|  | 1627 | (response->pending_and_present_values + sizeof(uint16_t)), | 
|  | 1628 | sizeof(uint16_t)); | 
|  | 1629 | uint16_t *val_present = (uint16_t *)present_value; | 
|  | 1630 | *val_present = le16toh(*val_present); | 
|  | 1631 |  | 
|  | 1632 | } else if (*effecter_data_size == PLDM_EFFECTER_DATA_SIZE_UINT32 || | 
|  | 1633 | *effecter_data_size == PLDM_EFFECTER_DATA_SIZE_SINT32) { | 
|  | 1634 | if (payload_length != | 
|  | 1635 | PLDM_GET_NUMERIC_EFFECTER_VALUE_MIN_RESP_BYTES + 6) { | 
|  | 1636 | return PLDM_ERROR_INVALID_LENGTH; | 
|  | 1637 | } | 
|  | 1638 | memcpy(pending_value, response->pending_and_present_values, | 
|  | 1639 | sizeof(uint32_t)); | 
|  | 1640 | uint32_t *val_pending = (uint32_t *)pending_value; | 
|  | 1641 | *val_pending = le32toh(*val_pending); | 
|  | 1642 | memcpy( | 
|  | 1643 | present_value, | 
|  | 1644 | (response->pending_and_present_values + sizeof(uint32_t)), | 
|  | 1645 | sizeof(uint32_t)); | 
|  | 1646 | uint32_t *val_present = (uint32_t *)present_value; | 
|  | 1647 | *val_present = le32toh(*val_present); | 
|  | 1648 | } | 
|  | 1649 | return PLDM_SUCCESS; | 
|  | 1650 | } | 
|  | 1651 |  | 
|  | 1652 | int encode_pldm_pdr_repository_chg_event_data( | 
|  | 1653 | uint8_t event_data_format, uint8_t number_of_change_records, | 
|  | 1654 | const uint8_t *event_data_operations, | 
|  | 1655 | const uint8_t *numbers_of_change_entries, | 
|  | 1656 | const uint32_t *const *change_entries, | 
|  | 1657 | struct pldm_pdr_repository_chg_event_data *event_data, | 
|  | 1658 | size_t *actual_change_records_size, size_t max_change_records_size) | 
|  | 1659 | { | 
|  | 1660 | if (event_data_operations == NULL || | 
|  | 1661 | numbers_of_change_entries == NULL || change_entries == NULL) { | 
|  | 1662 | return PLDM_ERROR_INVALID_DATA; | 
|  | 1663 | } | 
|  | 1664 |  | 
|  | 1665 | size_t expected_size = | 
|  | 1666 | sizeof(event_data_format) + sizeof(number_of_change_records); | 
|  | 1667 |  | 
|  | 1668 | expected_size += | 
|  | 1669 | sizeof(*event_data_operations) * number_of_change_records; | 
|  | 1670 | expected_size += | 
|  | 1671 | sizeof(*numbers_of_change_entries) * number_of_change_records; | 
|  | 1672 |  | 
|  | 1673 | for (uint8_t i = 0; i < number_of_change_records; ++i) { | 
|  | 1674 | expected_size += | 
|  | 1675 | sizeof(*change_entries[0]) * numbers_of_change_entries[i]; | 
|  | 1676 | } | 
|  | 1677 |  | 
|  | 1678 | *actual_change_records_size = expected_size; | 
|  | 1679 |  | 
|  | 1680 | if (event_data == NULL) { | 
|  | 1681 | return PLDM_SUCCESS; | 
|  | 1682 | } | 
|  | 1683 |  | 
|  | 1684 | if (max_change_records_size < expected_size) { | 
|  | 1685 | return PLDM_ERROR_INVALID_LENGTH; | 
|  | 1686 | } | 
|  | 1687 |  | 
|  | 1688 | event_data->event_data_format = event_data_format; | 
|  | 1689 | event_data->number_of_change_records = number_of_change_records; | 
|  | 1690 |  | 
|  | 1691 | struct pldm_pdr_repository_change_record_data *record_data = | 
|  | 1692 | (struct pldm_pdr_repository_change_record_data *) | 
|  | 1693 | event_data->change_records; | 
|  | 1694 |  | 
|  | 1695 | for (uint8_t i = 0; i < number_of_change_records; ++i) { | 
|  | 1696 | record_data->event_data_operation = event_data_operations[i]; | 
|  | 1697 | record_data->number_of_change_entries = | 
|  | 1698 | numbers_of_change_entries[i]; | 
|  | 1699 |  | 
|  | 1700 | for (uint8_t j = 0; j < record_data->number_of_change_entries; | 
|  | 1701 | ++j) { | 
|  | 1702 | record_data->change_entry[j] = | 
|  | 1703 | htole32(change_entries[i][j]); | 
|  | 1704 | } | 
|  | 1705 |  | 
|  | 1706 | record_data = (struct pldm_pdr_repository_change_record_data | 
|  | 1707 | *)(record_data->change_entry + | 
|  | 1708 | record_data->number_of_change_entries); | 
|  | 1709 | } | 
|  | 1710 |  | 
|  | 1711 | return PLDM_SUCCESS; | 
|  | 1712 | } | 
|  | 1713 |  | 
|  | 1714 | int decode_pldm_pdr_repository_chg_event_data(const uint8_t *event_data, | 
|  | 1715 | size_t event_data_size, | 
|  | 1716 | uint8_t *event_data_format, | 
|  | 1717 | uint8_t *number_of_change_records, | 
|  | 1718 | size_t *change_record_data_offset) | 
|  | 1719 | { | 
|  | 1720 | if (event_data == NULL || event_data_format == NULL || | 
|  | 1721 | number_of_change_records == NULL || | 
|  | 1722 | change_record_data_offset == NULL) { | 
|  | 1723 | return PLDM_ERROR_INVALID_DATA; | 
|  | 1724 | } | 
|  | 1725 | if (event_data_size < PLDM_PDR_REPOSITORY_CHG_EVENT_MIN_LENGTH) { | 
|  | 1726 | return PLDM_ERROR_INVALID_LENGTH; | 
|  | 1727 | } | 
|  | 1728 |  | 
|  | 1729 | struct pldm_pdr_repository_chg_event_data | 
|  | 1730 | *pdr_repository_chg_event_data = | 
|  | 1731 | (struct pldm_pdr_repository_chg_event_data *)event_data; | 
|  | 1732 |  | 
|  | 1733 | *event_data_format = pdr_repository_chg_event_data->event_data_format; | 
|  | 1734 | *number_of_change_records = | 
|  | 1735 | pdr_repository_chg_event_data->number_of_change_records; | 
|  | 1736 | *change_record_data_offset = | 
|  | 1737 | sizeof(*event_data_format) + sizeof(*number_of_change_records); | 
|  | 1738 |  | 
|  | 1739 | return PLDM_SUCCESS; | 
|  | 1740 | } | 
|  | 1741 |  | 
|  | 1742 | int decode_pldm_pdr_repository_change_record_data( | 
|  | 1743 | const uint8_t *change_record_data, size_t change_record_data_size, | 
|  | 1744 | uint8_t *event_data_operation, uint8_t *number_of_change_entries, | 
|  | 1745 | size_t *change_entry_data_offset) | 
|  | 1746 | { | 
|  | 1747 | if (change_record_data == NULL || event_data_operation == NULL || | 
|  | 1748 | number_of_change_entries == NULL || | 
|  | 1749 | change_entry_data_offset == NULL) { | 
|  | 1750 | return PLDM_ERROR_INVALID_DATA; | 
|  | 1751 | } | 
|  | 1752 | if (change_record_data_size < | 
|  | 1753 | PLDM_PDR_REPOSITORY_CHANGE_RECORD_MIN_LENGTH) { | 
|  | 1754 | return PLDM_ERROR_INVALID_LENGTH; | 
|  | 1755 | } | 
|  | 1756 |  | 
|  | 1757 | struct pldm_pdr_repository_change_record_data | 
|  | 1758 | *pdr_repository_change_record_data = | 
|  | 1759 | (struct pldm_pdr_repository_change_record_data *) | 
|  | 1760 | change_record_data; | 
|  | 1761 |  | 
|  | 1762 | *event_data_operation = | 
|  | 1763 | pdr_repository_change_record_data->event_data_operation; | 
|  | 1764 | *number_of_change_entries = | 
|  | 1765 | pdr_repository_change_record_data->number_of_change_entries; | 
|  | 1766 | *change_entry_data_offset = | 
|  | 1767 | sizeof(*event_data_operation) + sizeof(*number_of_change_entries); | 
|  | 1768 |  | 
|  | 1769 | return PLDM_SUCCESS; | 
|  | 1770 | } | 
|  | 1771 |  | 
|  | 1772 | int encode_get_sensor_reading_req(uint8_t instance_id, uint16_t sensor_id, | 
|  | 1773 | uint8_t rearm_event_state, | 
|  | 1774 | struct pldm_msg *msg) | 
|  | 1775 | { | 
|  | 1776 | if (msg == NULL) { | 
|  | 1777 | return PLDM_ERROR_INVALID_DATA; | 
|  | 1778 | } | 
|  | 1779 |  | 
|  | 1780 | struct pldm_header_info header = {0}; | 
|  | 1781 | header.msg_type = PLDM_REQUEST; | 
|  | 1782 | header.instance = instance_id; | 
|  | 1783 | header.pldm_type = PLDM_PLATFORM; | 
|  | 1784 | header.command = PLDM_GET_SENSOR_READING; | 
|  | 1785 |  | 
|  | 1786 | uint8_t rc = pack_pldm_header(&header, &(msg->hdr)); | 
|  | 1787 | if (rc != PLDM_SUCCESS) { | 
|  | 1788 | return rc; | 
|  | 1789 | } | 
|  | 1790 |  | 
|  | 1791 | struct pldm_get_sensor_reading_req *request = | 
|  | 1792 | (struct pldm_get_sensor_reading_req *)msg->payload; | 
|  | 1793 |  | 
|  | 1794 | request->sensor_id = htole16(sensor_id); | 
|  | 1795 | request->rearm_event_state = rearm_event_state; | 
|  | 1796 |  | 
|  | 1797 | return PLDM_SUCCESS; | 
|  | 1798 | } | 
|  | 1799 |  | 
|  | 1800 | int decode_get_sensor_reading_resp( | 
|  | 1801 | const struct pldm_msg *msg, size_t payload_length, uint8_t *completion_code, | 
|  | 1802 | uint8_t *sensor_data_size, uint8_t *sensor_operational_state, | 
|  | 1803 | uint8_t *sensor_event_message_enable, uint8_t *present_state, | 
|  | 1804 | uint8_t *previous_state, uint8_t *event_state, uint8_t *present_reading) | 
|  | 1805 | { | 
|  | 1806 | if (msg == NULL || completion_code == NULL || | 
|  | 1807 | sensor_data_size == NULL || sensor_operational_state == NULL || | 
|  | 1808 | sensor_event_message_enable == NULL || present_state == NULL || | 
|  | 1809 | previous_state == NULL || event_state == NULL || | 
|  | 1810 | present_reading == NULL) { | 
|  | 1811 | return PLDM_ERROR_INVALID_DATA; | 
|  | 1812 | } | 
|  | 1813 |  | 
|  | 1814 | *completion_code = msg->payload[0]; | 
|  | 1815 | if (PLDM_SUCCESS != *completion_code) { | 
|  | 1816 | return PLDM_SUCCESS; | 
|  | 1817 | } | 
|  | 1818 |  | 
|  | 1819 | if (payload_length < PLDM_GET_SENSOR_READING_MIN_RESP_BYTES) { | 
|  | 1820 | return PLDM_ERROR_INVALID_LENGTH; | 
|  | 1821 | } | 
|  | 1822 |  | 
|  | 1823 | struct pldm_get_sensor_reading_resp *response = | 
|  | 1824 | (struct pldm_get_sensor_reading_resp *)msg->payload; | 
|  | 1825 |  | 
|  | 1826 | if (response->sensor_data_size > PLDM_SENSOR_DATA_SIZE_SINT32) { | 
|  | 1827 | return PLDM_ERROR_INVALID_DATA; | 
|  | 1828 | } | 
|  | 1829 |  | 
|  | 1830 | *sensor_data_size = response->sensor_data_size; | 
|  | 1831 | *sensor_operational_state = response->sensor_operational_state; | 
|  | 1832 | *sensor_event_message_enable = response->sensor_event_message_enable; | 
|  | 1833 | *present_state = response->present_state; | 
|  | 1834 | *previous_state = response->previous_state; | 
|  | 1835 | *event_state = response->event_state; | 
|  | 1836 |  | 
|  | 1837 | if (*sensor_data_size == PLDM_EFFECTER_DATA_SIZE_UINT8 || | 
|  | 1838 | *sensor_data_size == PLDM_EFFECTER_DATA_SIZE_SINT8) { | 
|  | 1839 | if (payload_length != PLDM_GET_SENSOR_READING_MIN_RESP_BYTES) { | 
|  | 1840 | return PLDM_ERROR_INVALID_LENGTH; | 
|  | 1841 | } | 
|  | 1842 | *present_reading = response->present_reading[0]; | 
|  | 1843 |  | 
|  | 1844 | } else if (*sensor_data_size == PLDM_EFFECTER_DATA_SIZE_UINT16 || | 
|  | 1845 | *sensor_data_size == PLDM_EFFECTER_DATA_SIZE_SINT16) { | 
|  | 1846 | if (payload_length != | 
|  | 1847 | PLDM_GET_SENSOR_READING_MIN_RESP_BYTES + 1) { | 
|  | 1848 | return PLDM_ERROR_INVALID_LENGTH; | 
|  | 1849 | } | 
|  | 1850 | memcpy(present_reading, response->present_reading, 2); | 
|  | 1851 | uint16_t *val = (uint16_t *)(present_reading); | 
|  | 1852 | *val = le16toh(*val); | 
|  | 1853 |  | 
|  | 1854 | } else if (*sensor_data_size == PLDM_EFFECTER_DATA_SIZE_UINT32 || | 
|  | 1855 | *sensor_data_size == PLDM_EFFECTER_DATA_SIZE_SINT32) { | 
|  | 1856 | if (payload_length != | 
|  | 1857 | PLDM_GET_SENSOR_READING_MIN_RESP_BYTES + 3) { | 
|  | 1858 | return PLDM_ERROR_INVALID_LENGTH; | 
|  | 1859 | } | 
|  | 1860 | memcpy(present_reading, response->present_reading, 4); | 
|  | 1861 | uint32_t *val = (uint32_t *)(present_reading); | 
|  | 1862 | *val = le32toh(*val); | 
|  | 1863 | } | 
|  | 1864 |  | 
|  | 1865 | return PLDM_SUCCESS; | 
|  | 1866 | } | 
|  | 1867 |  | 
|  | 1868 | int encode_get_sensor_reading_resp( | 
|  | 1869 | uint8_t instance_id, uint8_t completion_code, uint8_t sensor_data_size, | 
|  | 1870 | uint8_t sensor_operational_state, uint8_t sensor_event_message_enable, | 
|  | 1871 | uint8_t present_state, uint8_t previous_state, uint8_t event_state, | 
| Andrew Jeffery | debe6b3 | 2023-04-05 20:30:46 +0930 | [diff] [blame] | 1872 | const uint8_t *present_reading, struct pldm_msg *msg, size_t payload_length) | 
| Andrew Jeffery | 9c76679 | 2022-08-10 23:12:49 +0930 | [diff] [blame] | 1873 | { | 
|  | 1874 | if (msg == NULL || present_reading == NULL) { | 
|  | 1875 | return PLDM_ERROR_INVALID_DATA; | 
|  | 1876 | } | 
|  | 1877 |  | 
|  | 1878 | if (sensor_data_size > PLDM_EFFECTER_DATA_SIZE_SINT32) { | 
|  | 1879 | return PLDM_ERROR_INVALID_DATA; | 
|  | 1880 | } | 
|  | 1881 |  | 
|  | 1882 | struct pldm_header_info header = {0}; | 
|  | 1883 | header.msg_type = PLDM_RESPONSE; | 
|  | 1884 | header.instance = instance_id; | 
|  | 1885 | header.pldm_type = PLDM_PLATFORM; | 
|  | 1886 | header.command = PLDM_GET_SENSOR_READING; | 
|  | 1887 |  | 
|  | 1888 | uint8_t rc = pack_pldm_header(&header, &(msg->hdr)); | 
|  | 1889 | if (rc != PLDM_SUCCESS) { | 
|  | 1890 | return rc; | 
|  | 1891 | } | 
|  | 1892 |  | 
|  | 1893 | struct pldm_get_sensor_reading_resp *response = | 
|  | 1894 | (struct pldm_get_sensor_reading_resp *)msg->payload; | 
|  | 1895 |  | 
|  | 1896 | response->completion_code = completion_code; | 
|  | 1897 | response->sensor_data_size = sensor_data_size; | 
|  | 1898 | response->sensor_operational_state = sensor_operational_state; | 
|  | 1899 | response->sensor_event_message_enable = sensor_event_message_enable; | 
|  | 1900 | response->present_state = present_state; | 
|  | 1901 | response->previous_state = previous_state; | 
|  | 1902 | response->event_state = event_state; | 
|  | 1903 |  | 
|  | 1904 | if (sensor_data_size == PLDM_EFFECTER_DATA_SIZE_UINT8 || | 
|  | 1905 | sensor_data_size == PLDM_EFFECTER_DATA_SIZE_SINT8) { | 
|  | 1906 | if (payload_length != PLDM_GET_SENSOR_READING_MIN_RESP_BYTES) { | 
|  | 1907 | return PLDM_ERROR_INVALID_LENGTH; | 
|  | 1908 | } | 
|  | 1909 | response->present_reading[0] = *present_reading; | 
|  | 1910 |  | 
|  | 1911 | } else if (sensor_data_size == PLDM_EFFECTER_DATA_SIZE_UINT16 || | 
|  | 1912 | sensor_data_size == PLDM_EFFECTER_DATA_SIZE_SINT16) { | 
|  | 1913 | if (payload_length != | 
|  | 1914 | PLDM_GET_SENSOR_READING_MIN_RESP_BYTES + 1) { | 
|  | 1915 | return PLDM_ERROR_INVALID_LENGTH; | 
|  | 1916 | } | 
|  | 1917 | uint16_t val = *(uint16_t *)present_reading; | 
|  | 1918 | val = htole16(val); | 
|  | 1919 | memcpy(response->present_reading, &val, 2); | 
|  | 1920 |  | 
|  | 1921 | } else if (sensor_data_size == PLDM_EFFECTER_DATA_SIZE_UINT32 || | 
|  | 1922 | sensor_data_size == PLDM_EFFECTER_DATA_SIZE_SINT32) { | 
|  | 1923 | if (payload_length != | 
|  | 1924 | PLDM_GET_SENSOR_READING_MIN_RESP_BYTES + 3) { | 
|  | 1925 | return PLDM_ERROR_INVALID_LENGTH; | 
|  | 1926 | } | 
|  | 1927 | uint32_t val = *(uint32_t *)present_reading; | 
|  | 1928 | val = htole32(val); | 
|  | 1929 | memcpy(response->present_reading, &val, 4); | 
|  | 1930 | } | 
|  | 1931 |  | 
|  | 1932 | return PLDM_SUCCESS; | 
|  | 1933 | } | 
|  | 1934 |  | 
|  | 1935 | int decode_get_sensor_reading_req(const struct pldm_msg *msg, | 
|  | 1936 | size_t payload_length, uint16_t *sensor_id, | 
|  | 1937 | uint8_t *rearm_event_state) | 
|  | 1938 | { | 
|  | 1939 | if (msg == NULL || sensor_id == NULL || rearm_event_state == NULL) { | 
|  | 1940 | return PLDM_ERROR_INVALID_DATA; | 
|  | 1941 | } | 
|  | 1942 |  | 
|  | 1943 | if (payload_length != PLDM_GET_SENSOR_READING_REQ_BYTES) { | 
|  | 1944 | return PLDM_ERROR_INVALID_LENGTH; | 
|  | 1945 | } | 
|  | 1946 |  | 
|  | 1947 | struct pldm_get_sensor_reading_req *request = | 
|  | 1948 | (struct pldm_get_sensor_reading_req *)msg->payload; | 
|  | 1949 |  | 
|  | 1950 | *sensor_id = le16toh(request->sensor_id); | 
|  | 1951 | *rearm_event_state = request->rearm_event_state; | 
|  | 1952 |  | 
|  | 1953 | return PLDM_SUCCESS; | 
|  | 1954 | } | 
|  | 1955 |  | 
|  | 1956 | int encode_set_event_receiver_req(uint8_t instance_id, | 
|  | 1957 | uint8_t event_message_global_enable, | 
|  | 1958 | uint8_t transport_protocol_type, | 
|  | 1959 | uint8_t event_receiver_address_info, | 
|  | 1960 | uint16_t heartbeat_timer, | 
|  | 1961 | struct pldm_msg *msg) | 
|  | 1962 | { | 
|  | 1963 | if (msg == NULL) { | 
|  | 1964 | return PLDM_ERROR_INVALID_DATA; | 
|  | 1965 | } | 
|  | 1966 |  | 
|  | 1967 | if (transport_protocol_type != PLDM_TRANSPORT_PROTOCOL_TYPE_MCTP) { | 
|  | 1968 | return PLDM_ERROR_INVALID_DATA; | 
|  | 1969 | } | 
|  | 1970 |  | 
|  | 1971 | struct pldm_header_info header = {0}; | 
|  | 1972 | header.msg_type = PLDM_REQUEST; | 
|  | 1973 | header.instance = instance_id; | 
|  | 1974 | header.pldm_type = PLDM_PLATFORM; | 
|  | 1975 | header.command = PLDM_SET_EVENT_RECEIVER; | 
|  | 1976 |  | 
|  | 1977 | uint8_t rc = pack_pldm_header(&header, &(msg->hdr)); | 
|  | 1978 | if (rc != PLDM_SUCCESS) { | 
|  | 1979 | return rc; | 
|  | 1980 | } | 
|  | 1981 |  | 
|  | 1982 | struct pldm_set_event_receiver_req *request = | 
|  | 1983 | (struct pldm_set_event_receiver_req *)msg->payload; | 
|  | 1984 | request->event_message_global_enable = event_message_global_enable; | 
|  | 1985 |  | 
|  | 1986 | request->transport_protocol_type = transport_protocol_type; | 
|  | 1987 | request->event_receiver_address_info = event_receiver_address_info; | 
|  | 1988 |  | 
|  | 1989 | if (event_message_global_enable == | 
|  | 1990 | PLDM_EVENT_MESSAGE_GLOBAL_ENABLE_ASYNC_KEEP_ALIVE) { | 
|  | 1991 | if (heartbeat_timer == 0) { | 
|  | 1992 | return PLDM_ERROR_INVALID_DATA; | 
|  | 1993 | } | 
|  | 1994 | request->heartbeat_timer = htole16(heartbeat_timer); | 
|  | 1995 | } | 
|  | 1996 |  | 
|  | 1997 | return PLDM_SUCCESS; | 
|  | 1998 | } | 
|  | 1999 |  | 
|  | 2000 | int decode_set_event_receiver_resp(const struct pldm_msg *msg, | 
|  | 2001 | size_t payload_length, | 
|  | 2002 | uint8_t *completion_code) | 
|  | 2003 | { | 
|  | 2004 | if (msg == NULL || completion_code == NULL) { | 
|  | 2005 | return PLDM_ERROR_INVALID_DATA; | 
|  | 2006 | } | 
|  | 2007 |  | 
|  | 2008 | *completion_code = msg->payload[0]; | 
|  | 2009 | if (PLDM_SUCCESS != *completion_code) { | 
|  | 2010 | return PLDM_SUCCESS; | 
|  | 2011 | } | 
|  | 2012 |  | 
|  | 2013 | if (payload_length > PLDM_SET_EVENT_RECEIVER_RESP_BYTES) { | 
|  | 2014 | return PLDM_ERROR_INVALID_LENGTH; | 
|  | 2015 | } | 
|  | 2016 |  | 
|  | 2017 | return PLDM_SUCCESS; | 
|  | 2018 | } | 
|  | 2019 |  | 
|  | 2020 | int decode_set_event_receiver_req(const struct pldm_msg *msg, | 
|  | 2021 | size_t payload_length, | 
|  | 2022 | uint8_t *event_message_global_enable, | 
|  | 2023 | uint8_t *transport_protocol_type, | 
|  | 2024 | uint8_t *event_receiver_address_info, | 
|  | 2025 | uint16_t *heartbeat_timer) | 
|  | 2026 |  | 
|  | 2027 | { | 
|  | 2028 | if (msg == NULL || event_message_global_enable == NULL || | 
|  | 2029 | transport_protocol_type == NULL || | 
|  | 2030 | event_receiver_address_info == NULL || heartbeat_timer == NULL) { | 
|  | 2031 | return PLDM_ERROR_INVALID_DATA; | 
|  | 2032 | } | 
|  | 2033 |  | 
|  | 2034 | if (payload_length != PLDM_SET_EVENT_RECEIVER_REQ_BYTES) { | 
|  | 2035 | return PLDM_ERROR_INVALID_LENGTH; | 
|  | 2036 | } | 
|  | 2037 |  | 
|  | 2038 | struct pldm_set_event_receiver_req *request = | 
|  | 2039 | (struct pldm_set_event_receiver_req *)msg->payload; | 
|  | 2040 |  | 
| Andrew Jeffery | 6ef2aa9 | 2023-04-14 00:21:27 +0930 | [diff] [blame] | 2041 | *event_message_global_enable = request->event_message_global_enable, | 
|  | 2042 | *transport_protocol_type = request->transport_protocol_type, | 
|  | 2043 | *event_receiver_address_info = request->event_receiver_address_info, | 
|  | 2044 | *heartbeat_timer = le16toh(request->heartbeat_timer); | 
|  | 2045 |  | 
| Andrew Jeffery | 9c76679 | 2022-08-10 23:12:49 +0930 | [diff] [blame] | 2046 | if ((*event_message_global_enable == | 
|  | 2047 | PLDM_EVENT_MESSAGE_GLOBAL_ENABLE_ASYNC_KEEP_ALIVE) && | 
|  | 2048 | (*heartbeat_timer == 0)) { | 
|  | 2049 | return PLDM_ERROR_INVALID_DATA; | 
|  | 2050 | } | 
|  | 2051 |  | 
| Andrew Jeffery | 9c76679 | 2022-08-10 23:12:49 +0930 | [diff] [blame] | 2052 | return PLDM_SUCCESS; | 
|  | 2053 | } | 
|  | 2054 |  | 
|  | 2055 | int encode_set_event_receiver_resp(uint8_t instance_id, uint8_t completion_code, | 
|  | 2056 | struct pldm_msg *msg) | 
|  | 2057 |  | 
|  | 2058 | { | 
|  | 2059 | if (msg == NULL) { | 
|  | 2060 | return PLDM_ERROR_INVALID_DATA; | 
|  | 2061 | } | 
|  | 2062 |  | 
|  | 2063 | struct pldm_header_info header = {0}; | 
|  | 2064 | header.instance = instance_id; | 
|  | 2065 | header.msg_type = PLDM_RESPONSE; | 
|  | 2066 | header.pldm_type = PLDM_PLATFORM; | 
|  | 2067 | header.command = PLDM_SET_EVENT_RECEIVER; | 
|  | 2068 |  | 
|  | 2069 | uint8_t rc = pack_pldm_header(&header, &(msg->hdr)); | 
|  | 2070 | if (rc != PLDM_SUCCESS) { | 
|  | 2071 | return rc; | 
|  | 2072 | } | 
|  | 2073 |  | 
|  | 2074 | msg->payload[0] = completion_code; | 
|  | 2075 |  | 
|  | 2076 | return PLDM_SUCCESS; | 
|  | 2077 | } |