julhal01 | 2c18fbf | 2021-02-01 08:29:28 +0000 | [diff] [blame] | 1 | /* |
| 2 | * Copyright (c) 2021, Arm Limited and Contributors. All rights reserved. |
| 3 | * |
| 4 | * SPDX-License-Identifier: BSD-3-Clause |
| 5 | */ |
| 6 | |
| 7 | #include "config_ramstore.h" |
Julian Hall | 7048d30 | 2021-06-03 16:07:28 +0100 | [diff] [blame] | 8 | #include <config/interface/config_store.h> |
julhal01 | 2c18fbf | 2021-02-01 08:29:28 +0000 | [diff] [blame] | 9 | #include <stdlib.h> |
| 10 | #include <string.h> |
| 11 | #include <stdint.h> |
| 12 | |
| 13 | /** |
| 14 | * Variable length container for a configuration object. |
| 15 | */ |
| 16 | struct config_container |
| 17 | { |
Julian Hall | 7048d30 | 2021-06-03 16:07:28 +0100 | [diff] [blame] | 18 | enum config_classifier classifier; |
| 19 | char name[32]; |
| 20 | unsigned int instance; |
julhal01 | 2c18fbf | 2021-02-01 08:29:28 +0000 | [diff] [blame] | 21 | size_t size; |
| 22 | struct config_container *next; |
| 23 | }; |
| 24 | |
Julian Hall | 7048d30 | 2021-06-03 16:07:28 +0100 | [diff] [blame] | 25 | static struct config_container *config_container_create(enum config_classifier classifier, |
| 26 | const char *name, unsigned int instance, |
| 27 | const void *data, size_t size) |
julhal01 | 2c18fbf | 2021-02-01 08:29:28 +0000 | [diff] [blame] | 28 | { |
| 29 | struct config_container *container = malloc(sizeof(struct config_container) + size); |
| 30 | |
| 31 | if (container) { |
| 32 | |
Julian Hall | 7048d30 | 2021-06-03 16:07:28 +0100 | [diff] [blame] | 33 | container->classifier = classifier; |
| 34 | strncpy(container->name, name, sizeof(container->name)); |
| 35 | container->name[sizeof(container->name) - 1] = '\0'; |
| 36 | container->instance = instance; |
julhal01 | 2c18fbf | 2021-02-01 08:29:28 +0000 | [diff] [blame] | 37 | container->size = size; |
| 38 | container->next = NULL; |
| 39 | |
| 40 | memcpy((uint8_t*)container + sizeof(struct config_container), data, size); |
| 41 | } |
| 42 | |
| 43 | return container; |
| 44 | } |
| 45 | |
| 46 | static void config_container_destroy(struct config_container *container) |
| 47 | { |
| 48 | free(container); |
| 49 | } |
| 50 | |
| 51 | static const void *config_container_data(const struct config_container *container) |
| 52 | { |
| 53 | return (const uint8_t*)container + sizeof(struct config_container); |
| 54 | } |
| 55 | |
| 56 | /** |
| 57 | * Singleton config_ramstore instance |
| 58 | */ |
| 59 | static struct config_ramstore |
| 60 | { |
Julian Hall | 7048d30 | 2021-06-03 16:07:28 +0100 | [diff] [blame] | 61 | struct config_container *object_list; |
julhal01 | 2c18fbf | 2021-02-01 08:29:28 +0000 | [diff] [blame] | 62 | } ramstore = {0}; |
| 63 | |
| 64 | |
| 65 | void config_ramstore_init(void) |
| 66 | { |
Julian Hall | 7048d30 | 2021-06-03 16:07:28 +0100 | [diff] [blame] | 67 | |
julhal01 | 2c18fbf | 2021-02-01 08:29:28 +0000 | [diff] [blame] | 68 | } |
| 69 | |
| 70 | void config_ramstore_deinit(void) |
| 71 | { |
Julian Hall | 7048d30 | 2021-06-03 16:07:28 +0100 | [diff] [blame] | 72 | while (ramstore.object_list) { |
julhal01 | 2c18fbf | 2021-02-01 08:29:28 +0000 | [diff] [blame] | 73 | |
Julian Hall | 7048d30 | 2021-06-03 16:07:28 +0100 | [diff] [blame] | 74 | struct config_container *next = ramstore.object_list->next; |
| 75 | free(ramstore.object_list); |
| 76 | ramstore.object_list = next; |
julhal01 | 2c18fbf | 2021-02-01 08:29:28 +0000 | [diff] [blame] | 77 | } |
| 78 | } |
| 79 | |
Julian Hall | 7048d30 | 2021-06-03 16:07:28 +0100 | [diff] [blame] | 80 | bool config_store_add(enum config_classifier classifier, |
| 81 | const char *name, |
| 82 | unsigned int instance, |
| 83 | const void *data, |
| 84 | size_t data_len) |
julhal01 | 2c18fbf | 2021-02-01 08:29:28 +0000 | [diff] [blame] | 85 | { |
| 86 | struct config_container *container; |
| 87 | |
Julian Hall | 7048d30 | 2021-06-03 16:07:28 +0100 | [diff] [blame] | 88 | container = config_container_create(classifier, name, instance, data, data_len); |
| 89 | if (!container) return false; |
julhal01 | 2c18fbf | 2021-02-01 08:29:28 +0000 | [diff] [blame] | 90 | |
Julian Hall | 7048d30 | 2021-06-03 16:07:28 +0100 | [diff] [blame] | 91 | container->next = ramstore.object_list; |
| 92 | ramstore.object_list = container; |
julhal01 | 2c18fbf | 2021-02-01 08:29:28 +0000 | [diff] [blame] | 93 | |
Julian Hall | 7048d30 | 2021-06-03 16:07:28 +0100 | [diff] [blame] | 94 | return true; |
julhal01 | 2c18fbf | 2021-02-01 08:29:28 +0000 | [diff] [blame] | 95 | } |
| 96 | |
Julian Hall | 7048d30 | 2021-06-03 16:07:28 +0100 | [diff] [blame] | 97 | bool config_store_query(enum config_classifier classifier, |
| 98 | const char *name, |
| 99 | unsigned int instance, |
| 100 | void *data, |
| 101 | size_t data_buf_size) |
julhal01 | 2c18fbf | 2021-02-01 08:29:28 +0000 | [diff] [blame] | 102 | { |
Julian Hall | 7048d30 | 2021-06-03 16:07:28 +0100 | [diff] [blame] | 103 | bool success = false; |
| 104 | const struct config_container *container = ramstore.object_list; |
julhal01 | 2c18fbf | 2021-02-01 08:29:28 +0000 | [diff] [blame] | 105 | |
| 106 | while (container) { |
| 107 | |
Julian Hall | 7048d30 | 2021-06-03 16:07:28 +0100 | [diff] [blame] | 108 | if ((container->classifier == classifier) && |
| 109 | (strcmp(container->name, name) == 0) && |
| 110 | (container->instance == instance)) { |
julhal01 | 2c18fbf | 2021-02-01 08:29:28 +0000 | [diff] [blame] | 111 | |
Julian Hall | 7048d30 | 2021-06-03 16:07:28 +0100 | [diff] [blame] | 112 | if (data_buf_size == container->size) { |
julhal01 | 2c18fbf | 2021-02-01 08:29:28 +0000 | [diff] [blame] | 113 | |
Julian Hall | 7048d30 | 2021-06-03 16:07:28 +0100 | [diff] [blame] | 114 | memcpy(data, config_container_data(container), container->size); |
| 115 | success = true; |
julhal01 | 2c18fbf | 2021-02-01 08:29:28 +0000 | [diff] [blame] | 116 | } |
| 117 | |
| 118 | break; |
| 119 | } |
| 120 | |
| 121 | container = container->next; |
| 122 | } |
| 123 | |
Julian Hall | 7048d30 | 2021-06-03 16:07:28 +0100 | [diff] [blame] | 124 | return success; |
julhal01 | 2c18fbf | 2021-02-01 08:29:28 +0000 | [diff] [blame] | 125 | } |
| 126 | |
Julian Hall | 7048d30 | 2021-06-03 16:07:28 +0100 | [diff] [blame] | 127 | unsigned int config_store_count(enum config_classifier classifier) |
julhal01 | 37e1aea | 2021-02-09 15:22:20 +0000 | [diff] [blame] | 128 | { |
| 129 | unsigned int count = 0; |
| 130 | |
Julian Hall | 7048d30 | 2021-06-03 16:07:28 +0100 | [diff] [blame] | 131 | const struct config_container *container = ramstore.object_list; |
julhal01 | 37e1aea | 2021-02-09 15:22:20 +0000 | [diff] [blame] | 132 | |
| 133 | while (container) { |
| 134 | |
Julian Hall | 7048d30 | 2021-06-03 16:07:28 +0100 | [diff] [blame] | 135 | if (container->classifier == classifier) ++count; |
julhal01 | 37e1aea | 2021-02-09 15:22:20 +0000 | [diff] [blame] | 136 | container = container->next; |
| 137 | } |
| 138 | |
| 139 | return count; |
| 140 | } |