blob: ec9ffee7e159edf2e1a56b5d502ca06b5e91e23d [file] [log] [blame]
Deepak Kodihalli3b02ed82020-02-06 01:18:25 -06001#include "pdr.h"
2#include "platform.h"
3#include <assert.h>
4#include <stdlib.h>
5#include <string.h>
6
7typedef struct pldm_pdr_record {
8 uint32_t record_handle;
9 uint32_t size;
10 uint8_t *data;
11 struct pldm_pdr_record *next;
Deepak Kodihalli87514cc2020-04-16 09:08:38 -050012 bool is_remote;
Deepak Kodihalli3b02ed82020-02-06 01:18:25 -060013} pldm_pdr_record;
14
15typedef struct pldm_pdr {
16 uint32_t record_count;
17 uint32_t size;
Deepak Kodihalli3b02ed82020-02-06 01:18:25 -060018 pldm_pdr_record *first;
19 pldm_pdr_record *last;
20} pldm_pdr;
21
22static inline uint32_t get_next_record_handle(const pldm_pdr *repo,
23 const pldm_pdr_record *record)
24{
25 assert(repo != NULL);
26 assert(record != NULL);
27
28 if (record == repo->last) {
29 return 0;
30 }
31 return record->next->record_handle;
32}
33
34static void add_record(pldm_pdr *repo, pldm_pdr_record *record)
35{
36 assert(repo != NULL);
37 assert(record != NULL);
38
39 if (repo->first == NULL) {
40 assert(repo->last == NULL);
41 repo->first = record;
42 repo->last = record;
43 } else {
44 repo->last->next = record;
45 repo->last = record;
46 }
47 repo->size += record->size;
Deepak Kodihalli3b02ed82020-02-06 01:18:25 -060048 ++repo->record_count;
49}
50
51static inline uint32_t get_new_record_handle(const pldm_pdr *repo)
52{
53 assert(repo != NULL);
Deepak Kodihallib9848732020-04-21 23:34:01 -050054 uint32_t last_used_hdl =
55 repo->last != NULL ? repo->last->record_handle : 0;
56 assert(last_used_hdl != UINT32_MAX);
Deepak Kodihalli3b02ed82020-02-06 01:18:25 -060057
Deepak Kodihallib9848732020-04-21 23:34:01 -050058 return last_used_hdl + 1;
Deepak Kodihalli3b02ed82020-02-06 01:18:25 -060059}
60
61static pldm_pdr_record *make_new_record(const pldm_pdr *repo,
62 const uint8_t *data, uint32_t size,
Deepak Kodihalli87514cc2020-04-16 09:08:38 -050063 uint32_t record_handle, bool is_remote)
Deepak Kodihalli3b02ed82020-02-06 01:18:25 -060064{
65 assert(repo != NULL);
66 assert(size != 0);
67
68 pldm_pdr_record *record = malloc(sizeof(pldm_pdr_record));
69 assert(record != NULL);
70 record->record_handle =
71 record_handle == 0 ? get_new_record_handle(repo) : record_handle;
72 record->size = size;
Deepak Kodihalli87514cc2020-04-16 09:08:38 -050073 record->is_remote = is_remote;
Deepak Kodihalli3b02ed82020-02-06 01:18:25 -060074 if (data != NULL) {
75 record->data = malloc(size);
76 assert(record->data != NULL);
77 memcpy(record->data, data, size);
78 /* If record handle is 0, that is an indication for this API to
79 * compute a new handle. For that reason, the computed handle
80 * needs to be populated in the PDR header. For a case where the
81 * caller supplied the record handle, it would exist in the
82 * header already.
83 */
84 if (!record_handle) {
85 struct pldm_pdr_hdr *hdr =
86 (struct pldm_pdr_hdr *)(record->data);
Deepak Kodihallifb4dd7b2020-03-17 03:27:22 -050087 hdr->record_handle = htole32(record->record_handle);
Deepak Kodihalli3b02ed82020-02-06 01:18:25 -060088 }
89 }
90 record->next = NULL;
91
92 return record;
93}
94
95uint32_t pldm_pdr_add(pldm_pdr *repo, const uint8_t *data, uint32_t size,
Deepak Kodihalli87514cc2020-04-16 09:08:38 -050096 uint32_t record_handle, bool is_remote)
Deepak Kodihalli3b02ed82020-02-06 01:18:25 -060097{
98 assert(size != 0);
99 assert(data != NULL);
100
101 pldm_pdr_record *record =
Deepak Kodihalli87514cc2020-04-16 09:08:38 -0500102 make_new_record(repo, data, size, record_handle, is_remote);
Deepak Kodihalli3b02ed82020-02-06 01:18:25 -0600103 add_record(repo, record);
104
105 return record->record_handle;
106}
107
108pldm_pdr *pldm_pdr_init()
109{
110 pldm_pdr *repo = malloc(sizeof(pldm_pdr));
111 assert(repo != NULL);
112 repo->record_count = 0;
113 repo->size = 0;
Deepak Kodihalli3b02ed82020-02-06 01:18:25 -0600114 repo->first = NULL;
115 repo->last = NULL;
116
117 return repo;
118}
119
120void pldm_pdr_destroy(pldm_pdr *repo)
121{
122 assert(repo != NULL);
123
124 pldm_pdr_record *record = repo->first;
125 while (record != NULL) {
126 pldm_pdr_record *next = record->next;
127 if (record->data) {
128 free(record->data);
129 record->data = NULL;
130 }
131 free(record);
132 record = next;
133 }
134 free(repo);
135}
136
137const pldm_pdr_record *pldm_pdr_find_record(const pldm_pdr *repo,
138 uint32_t record_handle,
139 uint8_t **data, uint32_t *size,
140 uint32_t *next_record_handle)
141{
142 assert(repo != NULL);
143 assert(data != NULL);
144 assert(size != NULL);
145 assert(next_record_handle != NULL);
146
147 if (!record_handle && (repo->first != NULL)) {
148 record_handle = repo->first->record_handle;
149 }
150 pldm_pdr_record *record = repo->first;
151 while (record != NULL) {
152 if (record->record_handle == record_handle) {
153 *size = record->size;
154 *data = record->data;
155 *next_record_handle =
156 get_next_record_handle(repo, record);
157 return record;
158 }
159 record = record->next;
160 }
161
162 *size = 0;
163 *next_record_handle = 0;
164 return NULL;
165}
166
167const pldm_pdr_record *
168pldm_pdr_get_next_record(const pldm_pdr *repo,
169 const pldm_pdr_record *curr_record, uint8_t **data,
170 uint32_t *size, uint32_t *next_record_handle)
171{
172 assert(repo != NULL);
173 assert(curr_record != NULL);
174 assert(data != NULL);
175 assert(size != NULL);
176 assert(next_record_handle != NULL);
177
178 if (curr_record == repo->last) {
179 *data = NULL;
180 *size = 0;
181 *next_record_handle = get_next_record_handle(repo, curr_record);
182 return NULL;
183 }
184
185 *next_record_handle = get_next_record_handle(repo, curr_record->next);
186 *data = curr_record->next->data;
187 *size = curr_record->next->size;
188 return curr_record->next;
189}
190
191const pldm_pdr_record *
192pldm_pdr_find_record_by_type(const pldm_pdr *repo, uint8_t pdr_type,
193 const pldm_pdr_record *curr_record, uint8_t **data,
194 uint32_t *size)
195{
196 assert(repo != NULL);
Deepak Kodihalli3b02ed82020-02-06 01:18:25 -0600197
198 pldm_pdr_record *record = repo->first;
199 if (curr_record != NULL) {
200 record = curr_record->next;
201 }
202 while (record != NULL) {
203 struct pldm_pdr_hdr *hdr = (struct pldm_pdr_hdr *)record->data;
204 if (hdr->type == pdr_type) {
Pavithra Barithayae8beb892020-04-14 23:24:25 -0500205 if (data && size) {
206 *size = record->size;
207 *data = record->data;
208 }
Deepak Kodihalli3b02ed82020-02-06 01:18:25 -0600209 return record;
210 }
211 record = record->next;
212 }
213
Pavithra Barithayae8beb892020-04-14 23:24:25 -0500214 if (size) {
215 *size = 0;
216 }
Deepak Kodihalli3b02ed82020-02-06 01:18:25 -0600217 return NULL;
218}
219
220uint32_t pldm_pdr_get_record_count(const pldm_pdr *repo)
221{
222 assert(repo != NULL);
223
224 return repo->record_count;
225}
226
227uint32_t pldm_pdr_get_repo_size(const pldm_pdr *repo)
228{
229 assert(repo != NULL);
230
231 return repo->size;
232}
233
234uint32_t pldm_pdr_get_record_handle(const pldm_pdr *repo,
235 const pldm_pdr_record *record)
236{
237 assert(repo != NULL);
238 assert(record != NULL);
239
240 return record->record_handle;
241}
Deepak Kodihallidb914672020-02-07 02:47:45 -0600242
Deepak Kodihalli87514cc2020-04-16 09:08:38 -0500243inline bool pldm_pdr_record_is_remote(const pldm_pdr_record *record)
244{
245 assert(record != NULL);
246
247 return record->is_remote;
248}
249
Deepak Kodihallidb914672020-02-07 02:47:45 -0600250uint32_t pldm_pdr_add_fru_record_set(pldm_pdr *repo, uint16_t terminus_handle,
251 uint16_t fru_rsi, uint16_t entity_type,
252 uint16_t entity_instance_num,
253 uint16_t container_id)
254{
255 uint32_t size = sizeof(struct pldm_pdr_hdr) +
256 sizeof(struct pldm_pdr_fru_record_set);
257 uint8_t data[size];
258
259 struct pldm_pdr_hdr *hdr = (struct pldm_pdr_hdr *)&data;
260 hdr->version = 1;
261 hdr->record_handle = 0;
262 hdr->type = PLDM_PDR_FRU_RECORD_SET;
263 hdr->record_change_num = 0;
Deepak Kodihallifb4dd7b2020-03-17 03:27:22 -0500264 hdr->length = htole16(sizeof(struct pldm_pdr_fru_record_set));
Deepak Kodihallidb914672020-02-07 02:47:45 -0600265 struct pldm_pdr_fru_record_set *fru =
266 (struct pldm_pdr_fru_record_set *)((uint8_t *)hdr +
267 sizeof(struct pldm_pdr_hdr));
Deepak Kodihallifb4dd7b2020-03-17 03:27:22 -0500268 fru->terminus_handle = htole16(terminus_handle);
269 fru->fru_rsi = htole16(fru_rsi);
270 fru->entity_type = htole16(entity_type);
271 fru->entity_instance_num = htole16(entity_instance_num);
272 fru->container_id = htole16(container_id);
Deepak Kodihallidb914672020-02-07 02:47:45 -0600273
Deepak Kodihalli87514cc2020-04-16 09:08:38 -0500274 return pldm_pdr_add(repo, data, size, 0, false);
Deepak Kodihallidb914672020-02-07 02:47:45 -0600275}
276
277const pldm_pdr_record *pldm_pdr_fru_record_set_find_by_rsi(
278 const pldm_pdr *repo, uint16_t fru_rsi, uint16_t *terminus_handle,
279 uint16_t *entity_type, uint16_t *entity_instance_num,
280 uint16_t *container_id)
281{
282 assert(terminus_handle != NULL);
283 assert(entity_type != NULL);
284 assert(entity_instance_num != NULL);
285 assert(container_id != NULL);
286
287 uint8_t *data = NULL;
288 uint32_t size = 0;
289 const pldm_pdr_record *curr_record = pldm_pdr_find_record_by_type(
290 repo, PLDM_PDR_FRU_RECORD_SET, NULL, &data, &size);
291 while (curr_record != NULL) {
292 struct pldm_pdr_fru_record_set *fru =
293 (struct pldm_pdr_fru_record_set
294 *)(data + sizeof(struct pldm_pdr_hdr));
Deepak Kodihallifb4dd7b2020-03-17 03:27:22 -0500295 if (fru->fru_rsi == htole16(fru_rsi)) {
296 *terminus_handle = le16toh(fru->terminus_handle);
297 *entity_type = le16toh(fru->entity_type);
298 *entity_instance_num =
299 le16toh(fru->entity_instance_num);
300 *container_id = le16toh(fru->container_id);
Deepak Kodihallidb914672020-02-07 02:47:45 -0600301 return curr_record;
302 }
303 data = NULL;
304 curr_record = pldm_pdr_find_record_by_type(
305 repo, PLDM_PDR_FRU_RECORD_SET, curr_record, &data, &size);
306 }
307
308 *terminus_handle = 0;
309 *entity_type = 0;
310 *entity_instance_num = 0;
311 *container_id = 0;
312
313 return NULL;
314}
Deepak Kodihalli05787052020-03-10 01:54:08 -0500315
316typedef struct pldm_entity_association_tree {
317 pldm_entity_node *root;
318 uint16_t last_used_container_id;
319} pldm_entity_association_tree;
320
321typedef struct pldm_entity_node {
322 pldm_entity entity;
George Liufe77eea2021-04-28 15:08:07 +0800323 pldm_entity_node *parent;
Deepak Kodihalli05787052020-03-10 01:54:08 -0500324 pldm_entity_node *first_child;
325 pldm_entity_node *next_sibling;
326 uint8_t association_type;
327} pldm_entity_node;
328
329static inline uint16_t next_container_id(pldm_entity_association_tree *tree)
330{
331 assert(tree != NULL);
332 assert(tree->last_used_container_id != UINT16_MAX);
333
334 return ++tree->last_used_container_id;
335}
336
George Liud9855ab2021-05-13 09:41:31 +0800337pldm_entity pldm_entity_extract(pldm_entity_node *node)
338{
339 assert(node != NULL);
340
341 return node->entity;
342}
343
Deepak Kodihalli05787052020-03-10 01:54:08 -0500344pldm_entity_association_tree *pldm_entity_association_tree_init()
345{
346 pldm_entity_association_tree *tree =
347 malloc(sizeof(pldm_entity_association_tree));
348 assert(tree != NULL);
349 tree->root = NULL;
350 tree->last_used_container_id = 0;
351
352 return tree;
353}
354
355static pldm_entity_node *find_insertion_at(pldm_entity_node *start,
356 uint16_t entity_type)
357{
358 assert(start != NULL);
359
360 /* Insert after the the last node that matches the input entity type, or
361 * at the end if no such match occurrs
362 */
363 while (start->next_sibling != NULL) {
364 uint16_t this_type = start->entity.entity_type;
365 pldm_entity_node *next = start->next_sibling;
366 if (this_type == entity_type &&
367 (this_type != next->entity.entity_type)) {
368 break;
369 }
370 start = start->next_sibling;
371 }
372
373 return start;
374}
375
George Liu64a8f0f2021-06-12 10:56:11 +0800376pldm_entity_node *pldm_entity_association_tree_add(
377 pldm_entity_association_tree *tree, pldm_entity *entity,
378 uint16_t entity_instance_number, pldm_entity_node *parent,
379 uint8_t association_type)
Deepak Kodihalli05787052020-03-10 01:54:08 -0500380{
381 assert(tree != NULL);
George Liu64a8f0f2021-06-12 10:56:11 +0800382 assert(entity != NULL);
383
384 if (entity_instance_number != 0xFFFF && parent != NULL) {
385 pldm_entity node;
386 node.entity_type = entity->entity_type;
387 node.entity_instance_num = entity_instance_number;
388 if (pldm_is_current_parent_child(parent, &node)) {
389 return NULL;
390 }
391 }
392
Deepak Kodihalli05787052020-03-10 01:54:08 -0500393 assert(association_type == PLDM_ENTITY_ASSOCIAION_PHYSICAL ||
394 association_type == PLDM_ENTITY_ASSOCIAION_LOGICAL);
395 pldm_entity_node *node = malloc(sizeof(pldm_entity_node));
396 assert(node != NULL);
George Liufe77eea2021-04-28 15:08:07 +0800397 node->parent = NULL;
Deepak Kodihalli05787052020-03-10 01:54:08 -0500398 node->first_child = NULL;
399 node->next_sibling = NULL;
400 node->entity.entity_type = entity->entity_type;
George Liu64a8f0f2021-06-12 10:56:11 +0800401 node->entity.entity_instance_num =
402 entity_instance_number != 0xFFFF ? entity_instance_number : 1;
Deepak Kodihalli05787052020-03-10 01:54:08 -0500403 node->association_type = association_type;
404
405 if (tree->root == NULL) {
406 assert(parent == NULL);
407 tree->root = node;
408 /* container_id 0 here indicates this is the top-most entry */
409 node->entity.entity_container_id = 0;
410 } else if (parent != NULL && parent->first_child == NULL) {
411 parent->first_child = node;
George Liufe77eea2021-04-28 15:08:07 +0800412 node->parent = parent;
Deepak Kodihalli05787052020-03-10 01:54:08 -0500413 node->entity.entity_container_id = next_container_id(tree);
414 } else {
415 pldm_entity_node *start =
416 parent == NULL ? tree->root : parent->first_child;
417 pldm_entity_node *prev =
418 find_insertion_at(start, entity->entity_type);
419 assert(prev != NULL);
420 pldm_entity_node *next = prev->next_sibling;
421 if (prev->entity.entity_type == entity->entity_type) {
422 assert(prev->entity.entity_instance_num != UINT16_MAX);
423 node->entity.entity_instance_num =
George Liu64a8f0f2021-06-12 10:56:11 +0800424 entity_instance_number != 0xFFFF
425 ? entity_instance_number
426 : prev->entity.entity_instance_num + 1;
Deepak Kodihalli05787052020-03-10 01:54:08 -0500427 }
428 prev->next_sibling = node;
George Liufe77eea2021-04-28 15:08:07 +0800429 node->parent = prev->parent;
Deepak Kodihalli05787052020-03-10 01:54:08 -0500430 node->next_sibling = next;
431 node->entity.entity_container_id =
432 prev->entity.entity_container_id;
433 }
434 entity->entity_instance_num = node->entity.entity_instance_num;
435 entity->entity_container_id = node->entity.entity_container_id;
436
437 return node;
438}
439
440static void get_num_nodes(pldm_entity_node *node, size_t *num)
441{
442 if (node == NULL) {
443 return;
444 }
445
446 ++(*num);
447 get_num_nodes(node->next_sibling, num);
448 get_num_nodes(node->first_child, num);
449}
450
451static void entity_association_tree_visit(pldm_entity_node *node,
452 pldm_entity *entities, size_t *index)
453{
454 if (node == NULL) {
455 return;
456 }
457
458 pldm_entity *entity = &entities[*index];
459 ++(*index);
460 entity->entity_type = node->entity.entity_type;
461 entity->entity_instance_num = node->entity.entity_instance_num;
462 entity->entity_container_id = node->entity.entity_container_id;
463
464 entity_association_tree_visit(node->next_sibling, entities, index);
465 entity_association_tree_visit(node->first_child, entities, index);
466}
467
468void pldm_entity_association_tree_visit(pldm_entity_association_tree *tree,
469 pldm_entity **entities, size_t *size)
470{
471 assert(tree != NULL);
472
473 *size = 0;
474 if (tree->root == NULL) {
475 return;
476 }
477
478 get_num_nodes(tree->root, size);
479 *entities = malloc(*size * sizeof(pldm_entity));
480 size_t index = 0;
481 entity_association_tree_visit(tree->root, *entities, &index);
482}
483
484static void entity_association_tree_destroy(pldm_entity_node *node)
485{
486 if (node == NULL) {
487 return;
488 }
489
490 entity_association_tree_destroy(node->next_sibling);
491 entity_association_tree_destroy(node->first_child);
492 free(node);
493}
494
495void pldm_entity_association_tree_destroy(pldm_entity_association_tree *tree)
496{
497 assert(tree != NULL);
498
499 entity_association_tree_destroy(tree->root);
500 free(tree);
501}
502
503inline bool pldm_entity_is_node_parent(pldm_entity_node *node)
504{
505 assert(node != NULL);
506
507 return node->first_child != NULL;
508}
Deepak Kodihalli0a738f02020-03-10 01:56:21 -0500509
George Liufe77eea2021-04-28 15:08:07 +0800510inline pldm_entity_node *pldm_entity_get_parent(pldm_entity_node *node)
511{
512 assert(node != NULL);
513
514 return node->parent;
515}
516
Deepak Kodihalli0a738f02020-03-10 01:56:21 -0500517uint8_t pldm_entity_get_num_children(pldm_entity_node *node,
518 uint8_t association_type)
519{
520 assert(node != NULL);
521 assert(association_type == PLDM_ENTITY_ASSOCIAION_PHYSICAL ||
522 association_type == PLDM_ENTITY_ASSOCIAION_LOGICAL);
523
524 size_t count = 0;
525 pldm_entity_node *curr = node->first_child;
526 while (curr != NULL) {
527 if (curr->association_type == association_type) {
528 ++count;
529 }
530 curr = curr->next_sibling;
531 }
532
533 assert(count < UINT8_MAX);
534 return count;
535}
536
George Liu6a6c3ab2021-06-22 16:12:42 +0800537bool pldm_is_current_parent_child(pldm_entity_node *parent, pldm_entity *node)
538{
539 assert(parent != NULL);
540 assert(node != NULL);
541
542 pldm_entity_node *curr = parent->first_child;
543 while (curr != NULL) {
544 if (node->entity_type == curr->entity.entity_type &&
545 node->entity_instance_num ==
546 curr->entity.entity_instance_num) {
547
548 return true;
549 }
550 curr = curr->next_sibling;
551 }
552
553 return false;
554}
555
Deepak Kodihalli0a738f02020-03-10 01:56:21 -0500556static void _entity_association_pdr_add_entry(pldm_entity_node *curr,
557 pldm_pdr *repo, uint16_t size,
558 uint8_t contained_count,
Deepak Kodihalli87514cc2020-04-16 09:08:38 -0500559 uint8_t association_type,
560 bool is_remote)
Deepak Kodihalli0a738f02020-03-10 01:56:21 -0500561{
562 uint8_t pdr[size];
563 uint8_t *start = pdr;
564
565 struct pldm_pdr_hdr *hdr = (struct pldm_pdr_hdr *)start;
566 hdr->version = 1;
567 hdr->record_handle = 0;
568 hdr->type = PLDM_PDR_ENTITY_ASSOCIATION;
569 hdr->record_change_num = 0;
Deepak Kodihallifb4dd7b2020-03-17 03:27:22 -0500570 hdr->length = htole16(size - sizeof(struct pldm_pdr_hdr));
Deepak Kodihalli0a738f02020-03-10 01:56:21 -0500571 start += sizeof(struct pldm_pdr_hdr);
572
573 uint16_t *container_id = (uint16_t *)start;
Deepak Kodihallifb4dd7b2020-03-17 03:27:22 -0500574 *container_id = htole16(curr->first_child->entity.entity_container_id);
Deepak Kodihalli0a738f02020-03-10 01:56:21 -0500575 start += sizeof(uint16_t);
576 *start = association_type;
577 start += sizeof(uint8_t);
578
579 pldm_entity *entity = (pldm_entity *)start;
Deepak Kodihallifb4dd7b2020-03-17 03:27:22 -0500580 entity->entity_type = htole16(curr->entity.entity_type);
581 entity->entity_instance_num = htole16(curr->entity.entity_instance_num);
582 entity->entity_container_id = htole16(curr->entity.entity_container_id);
Deepak Kodihalli0a738f02020-03-10 01:56:21 -0500583 start += sizeof(pldm_entity);
584
585 *start = contained_count;
586 start += sizeof(uint8_t);
587
588 pldm_entity_node *node = curr->first_child;
589 while (node != NULL) {
590 if (node->association_type == association_type) {
591 pldm_entity *entity = (pldm_entity *)start;
Deepak Kodihallifb4dd7b2020-03-17 03:27:22 -0500592 entity->entity_type = htole16(node->entity.entity_type);
Deepak Kodihalli0a738f02020-03-10 01:56:21 -0500593 entity->entity_instance_num =
Deepak Kodihallifb4dd7b2020-03-17 03:27:22 -0500594 htole16(node->entity.entity_instance_num);
Deepak Kodihalli0a738f02020-03-10 01:56:21 -0500595 entity->entity_container_id =
Deepak Kodihallifb4dd7b2020-03-17 03:27:22 -0500596 htole16(node->entity.entity_container_id);
Deepak Kodihalli0a738f02020-03-10 01:56:21 -0500597 start += sizeof(pldm_entity);
598 }
599 node = node->next_sibling;
600 }
601
Deepak Kodihalli87514cc2020-04-16 09:08:38 -0500602 pldm_pdr_add(repo, pdr, size, 0, is_remote);
Deepak Kodihalli0a738f02020-03-10 01:56:21 -0500603}
604
605static void entity_association_pdr_add_entry(pldm_entity_node *curr,
Deepak Kodihalli87514cc2020-04-16 09:08:38 -0500606 pldm_pdr *repo, bool is_remote)
Deepak Kodihalli0a738f02020-03-10 01:56:21 -0500607{
608 uint8_t num_logical_children =
609 pldm_entity_get_num_children(curr, PLDM_ENTITY_ASSOCIAION_LOGICAL);
610 uint8_t num_physical_children =
611 pldm_entity_get_num_children(curr, PLDM_ENTITY_ASSOCIAION_PHYSICAL);
612
613 if (num_logical_children) {
614 uint16_t logical_pdr_size =
615 sizeof(struct pldm_pdr_hdr) + sizeof(uint16_t) +
616 sizeof(uint8_t) + sizeof(pldm_entity) + sizeof(uint8_t) +
617 (num_logical_children * sizeof(pldm_entity));
618 _entity_association_pdr_add_entry(
619 curr, repo, logical_pdr_size, num_logical_children,
Deepak Kodihalli87514cc2020-04-16 09:08:38 -0500620 PLDM_ENTITY_ASSOCIAION_LOGICAL, is_remote);
Deepak Kodihalli0a738f02020-03-10 01:56:21 -0500621 }
622
623 if (num_physical_children) {
624 uint16_t physical_pdr_size =
625 sizeof(struct pldm_pdr_hdr) + sizeof(uint16_t) +
626 sizeof(uint8_t) + sizeof(pldm_entity) + sizeof(uint8_t) +
627 (num_physical_children * sizeof(pldm_entity));
628 _entity_association_pdr_add_entry(
629 curr, repo, physical_pdr_size, num_physical_children,
Deepak Kodihalli87514cc2020-04-16 09:08:38 -0500630 PLDM_ENTITY_ASSOCIAION_PHYSICAL, is_remote);
Deepak Kodihalli0a738f02020-03-10 01:56:21 -0500631 }
632}
633
Sampa Misra719ed392021-06-04 05:15:13 -0500634bool is_present(pldm_entity entity, pldm_entity **entities, size_t num_entities)
635{
636 if (entities == NULL || num_entities == 0) {
637 return true;
638 }
639 size_t i = 0;
640 while (i < num_entities) {
641 if ((*entities + i)->entity_type == entity.entity_type) {
642 return true;
643 }
644 i++;
645 }
646 return false;
647}
648
Deepak Kodihalli87514cc2020-04-16 09:08:38 -0500649static void entity_association_pdr_add(pldm_entity_node *curr, pldm_pdr *repo,
Sampa Misra719ed392021-06-04 05:15:13 -0500650 pldm_entity **entities,
651 size_t num_entities, bool is_remote)
Deepak Kodihalli0a738f02020-03-10 01:56:21 -0500652{
653 if (curr == NULL) {
654 return;
655 }
Sampa Misra719ed392021-06-04 05:15:13 -0500656 bool to_add = true;
657 to_add = is_present(curr->entity, entities, num_entities);
658 if (to_add) {
659 entity_association_pdr_add_entry(curr, repo, is_remote);
660 }
661 entity_association_pdr_add(curr->next_sibling, repo, entities,
662 num_entities, is_remote);
663 entity_association_pdr_add(curr->first_child, repo, entities,
664 num_entities, is_remote);
Deepak Kodihalli0a738f02020-03-10 01:56:21 -0500665}
666
667void pldm_entity_association_pdr_add(pldm_entity_association_tree *tree,
Deepak Kodihalli87514cc2020-04-16 09:08:38 -0500668 pldm_pdr *repo, bool is_remote)
Deepak Kodihalli0a738f02020-03-10 01:56:21 -0500669{
670 assert(tree != NULL);
671 assert(repo != NULL);
672
Sampa Misra719ed392021-06-04 05:15:13 -0500673 entity_association_pdr_add(tree->root, repo, NULL, 0, is_remote);
674}
675
676void pldm_entity_association_pdr_add_from_node(pldm_entity_node *node,
677 pldm_pdr *repo,
678 pldm_entity **entities,
679 size_t num_entities,
680 bool is_remote)
681{
682 assert(repo != NULL);
683
684 entity_association_pdr_add(node, repo, entities, num_entities,
685 is_remote);
686}
687
688void find_entity_ref_in_tree(pldm_entity_node *tree_node, pldm_entity entity,
689 pldm_entity_node **node)
690{
691 if (tree_node == NULL) {
692 return;
693 }
694
695 if (tree_node->entity.entity_type == entity.entity_type &&
696 tree_node->entity.entity_instance_num ==
697 entity.entity_instance_num) {
698 *node = tree_node;
699 return;
700 }
701
702 find_entity_ref_in_tree(tree_node->first_child, entity, node);
703 find_entity_ref_in_tree(tree_node->next_sibling, entity, node);
704}
705
706void pldm_find_entity_ref_in_tree(pldm_entity_association_tree *tree,
707 pldm_entity entity, pldm_entity_node **node)
708{
709 assert(tree != NULL);
710 find_entity_ref_in_tree(tree->root, entity, node);
Deepak Kodihalli0a738f02020-03-10 01:56:21 -0500711}
Deepak Kodihalli3b28ba82020-03-30 07:39:47 -0500712
Deepak Kodihalli4a680932020-04-22 03:31:17 -0500713void pldm_pdr_remove_remote_pdrs(pldm_pdr *repo)
714{
715 assert(repo != NULL);
716 bool removed = false;
717
718 pldm_pdr_record *record = repo->first;
719 pldm_pdr_record *prev = NULL;
720 while (record != NULL) {
721 pldm_pdr_record *next = record->next;
722 if (record->is_remote == true) {
723 if (repo->first == record) {
724 repo->first = next;
725 } else {
726 prev->next = next;
727 }
728 if (repo->last == record) {
729 repo->last = prev;
730 }
731 if (record->data) {
732 free(record->data);
733 }
734 --repo->record_count;
735 repo->size -= record->size;
736 free(record);
737 removed = true;
738 } else {
739 prev = record;
740 }
741 record = next;
742 }
743
744 if (removed == true) {
745 record = repo->first;
746 uint32_t record_handle = 0;
747 while (record != NULL) {
748 record->record_handle = ++record_handle;
749 if (record->data != NULL) {
750 struct pldm_pdr_hdr *hdr =
751 (struct pldm_pdr_hdr *)(record->data);
752 hdr->record_handle =
753 htole32(record->record_handle);
754 }
755 record = record->next;
756 }
757 }
758}
759
Deepak Kodihalli3b28ba82020-03-30 07:39:47 -0500760void entity_association_tree_find(pldm_entity_node *node, pldm_entity *entity,
761 pldm_entity_node **out)
762{
763 if (node == NULL) {
764 return;
765 }
766
767 if (node->entity.entity_type == entity->entity_type &&
768 node->entity.entity_instance_num == entity->entity_instance_num) {
769 entity->entity_container_id = node->entity.entity_container_id;
770 *out = node;
771 return;
772 }
773
774 entity_association_tree_find(node->next_sibling, entity, out);
775 entity_association_tree_find(node->first_child, entity, out);
776}
777
778pldm_entity_node *
779pldm_entity_association_tree_find(pldm_entity_association_tree *tree,
780 pldm_entity *entity)
781{
782 assert(tree != NULL);
783
784 pldm_entity_node *node = NULL;
785 entity_association_tree_find(tree->root, entity, &node);
786 return node;
787}
788
Sampa Misrac073a202021-05-08 10:56:05 -0500789static void entity_association_tree_copy(pldm_entity_node *org_node,
790 pldm_entity_node **new_node)
791{
792 if (org_node == NULL) {
793 return;
794 }
795 *new_node = malloc(sizeof(pldm_entity_node));
796 (*new_node)->entity = org_node->entity;
797 (*new_node)->association_type = org_node->association_type;
798 (*new_node)->first_child = NULL;
799 (*new_node)->next_sibling = NULL;
800 entity_association_tree_copy(org_node->first_child,
801 &((*new_node)->first_child));
802 entity_association_tree_copy(org_node->next_sibling,
803 &((*new_node)->next_sibling));
804}
805
806void pldm_entity_association_tree_copy_root(
807 pldm_entity_association_tree *org_tree,
808 pldm_entity_association_tree *new_tree)
809{
810 new_tree->last_used_container_id = org_tree->last_used_container_id;
811 entity_association_tree_copy(org_tree->root, &(new_tree->root));
812}
813
814void pldm_entity_association_tree_destroy_root(
815 pldm_entity_association_tree *tree)
816{
817 assert(tree != NULL);
818 entity_association_tree_destroy(tree->root);
819 tree->last_used_container_id = 0;
820 tree->root = NULL;
821}
822
823bool pldm_is_empty_entity_assoc_tree(pldm_entity_association_tree *tree)
824{
825 return ((tree->root == NULL) ? true : false);
826}
827
Deepak Kodihalli3b28ba82020-03-30 07:39:47 -0500828void pldm_entity_association_pdr_extract(const uint8_t *pdr, uint16_t pdr_len,
829 size_t *num_entities,
830 pldm_entity **entities)
831{
832 assert(pdr != NULL);
833 assert(pdr_len >= sizeof(struct pldm_pdr_hdr) +
834 sizeof(struct pldm_pdr_entity_association));
835
836 struct pldm_pdr_hdr *hdr = (struct pldm_pdr_hdr *)pdr;
837 assert(hdr->type == PLDM_PDR_ENTITY_ASSOCIATION);
838
839 const uint8_t *start = (uint8_t *)pdr;
840 const uint8_t *end =
841 start + sizeof(struct pldm_pdr_hdr) + le16toh(hdr->length);
842 start += sizeof(struct pldm_pdr_hdr);
843 struct pldm_pdr_entity_association *entity_association_pdr =
844 (struct pldm_pdr_entity_association *)start;
845 *num_entities = entity_association_pdr->num_children + 1;
846 assert(*num_entities >= 2);
847 *entities = malloc(sizeof(pldm_entity) * *num_entities);
848 assert(*entities != NULL);
849 assert(start + sizeof(struct pldm_pdr_entity_association) +
850 sizeof(pldm_entity) * (*num_entities - 2) ==
851 end);
852 (*entities)->entity_type =
853 le16toh(entity_association_pdr->container.entity_type);
854 (*entities)->entity_instance_num =
855 le16toh(entity_association_pdr->container.entity_instance_num);
856 (*entities)->entity_container_id =
857 le16toh(entity_association_pdr->container.entity_container_id);
858 pldm_entity *curr_entity = entity_association_pdr->children;
859 size_t i = 1;
860 while (i < *num_entities) {
861 (*entities + i)->entity_type =
862 le16toh(curr_entity->entity_type);
863 (*entities + i)->entity_instance_num =
864 le16toh(curr_entity->entity_instance_num);
865 (*entities + i)->entity_container_id =
866 le16toh(curr_entity->entity_container_id);
867 ++curr_entity;
868 ++i;
869 }
870}