1 /*        $NetBSD: citrus_db_factory.c,v 1.11 2021/10/29 10:54:56 nia Exp $     */
2 
3 /*-
4  * Copyright (c)2003 Citrus Project,
5  * All rights reserved.
6  *
7  * Redistribution and use in source and binary forms, with or without
8  * modification, are permitted provided that the following conditions
9  * are met:
10  * 1. Redistributions of source code must retain the above copyright
11  *    notice, this list of conditions and the following disclaimer.
12  * 2. Redistributions in binary form must reproduce the above copyright
13  *    notice, this list of conditions and the following disclaimer in the
14  *    documentation and/or other materials provided with the distribution.
15  *
16  * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND
17  * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
18  * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
19  * ARE DISCLAIMED.  IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE
20  * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
21  * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
22  * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
23  * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
24  * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
25  * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
26  * SUCH DAMAGE.
27  */
28 
29 #if HAVE_NBTOOL_CONFIG_H
30 #include "nbtool_config.h"
31 #endif
32 
33 #include <sys/cdefs.h>
34 #if defined(LIBC_SCCS) && !defined(lint)
35 __RCSID("$NetBSD: citrus_db_factory.c,v 1.11 2021/10/29 10:54:56 nia Exp $");
36 #endif /* LIBC_SCCS and not lint */
37 
38 #include <assert.h>
39 #include <stdio.h>
40 #include <stdlib.h>
41 #include <string.h>
42 #include <errno.h>
43 #include <arpa/inet.h>
44 #include <sys/types.h>
45 #include <sys/queue.h>
46 
47 #include "citrus_namespace.h"
48 #include "citrus_region.h"
49 #include "citrus_db_file.h"
50 #include "citrus_db_factory.h"
51 
52 struct _citrus_db_factory_entry {
53           SIMPLEQ_ENTRY(_citrus_db_factory_entry) de_entry;
54           struct _citrus_db_factory_entry *de_next;
55           uint32_t de_hashvalue;
56           struct _region de_key;
57           int de_key_free;
58           struct _region de_data;
59           int de_data_free;
60           int de_idx;
61 };
62 
63 struct _citrus_db_factory {
64           size_t df_num_entries;
65           SIMPLEQ_HEAD(, _citrus_db_factory_entry) df_entries;
66           size_t df_total_key_size;
67           size_t df_total_data_size;
68           uint32_t (*df_hashfunc)(void *, struct _citrus_region *);
69           void *df_hashfunc_closure;
70 };
71 
72 #define DB_ALIGN 16
73 
74 int
_citrus_db_factory_create(struct _citrus_db_factory ** rdf,_citrus_db_hash_func_t hashfunc,void * hashfunc_closure)75 _citrus_db_factory_create(struct _citrus_db_factory **rdf,
76                                 _citrus_db_hash_func_t hashfunc,
77                                 void *hashfunc_closure)
78 {
79           struct _citrus_db_factory *df;
80 
81           df = malloc(sizeof(*df));
82           if (df == NULL)
83                     return errno;
84           df->df_num_entries = 0;
85           df->df_total_key_size = df->df_total_data_size = 0;
86           SIMPLEQ_INIT(&df->df_entries);
87           df->df_hashfunc = hashfunc;
88           df->df_hashfunc_closure = hashfunc_closure;
89 
90           *rdf = df;
91 
92           return 0;
93 }
94 
95 void
_citrus_db_factory_free(struct _citrus_db_factory * df)96 _citrus_db_factory_free(struct _citrus_db_factory *df)
97 {
98           struct _citrus_db_factory_entry *de;
99 
100           while ((de = SIMPLEQ_FIRST(&df->df_entries)) != NULL) {
101                     SIMPLEQ_REMOVE_HEAD(&df->df_entries, de_entry);
102                     if (de->de_key_free)
103                               free(_region_head(&de->de_key));
104                     if (de->de_data_free)
105                               free(_region_head(&de->de_data));
106                     free(de);
107           }
108           free(df);
109 }
110 
111 static __inline size_t
ceilto(size_t sz)112 ceilto(size_t sz)
113 {
114           return (sz+DB_ALIGN-1) & ~(DB_ALIGN-1);
115 }
116 
117 int
_citrus_db_factory_add(struct _citrus_db_factory * df,struct _region * key,int keyfree,struct _region * data,int datafree)118 _citrus_db_factory_add(struct _citrus_db_factory *df,
119                            struct _region *key, int keyfree,
120                            struct _region *data, int datafree)
121 {
122           struct _citrus_db_factory_entry *de;
123 
124           de = malloc(sizeof(*de));
125           if (de == NULL)
126                     return -1;
127 
128           de->de_hashvalue = df->df_hashfunc(df->df_hashfunc_closure, key);
129           de->de_key = *key;
130           de->de_key_free = keyfree;
131           de->de_data = *data;
132           de->de_data_free = datafree;
133           de->de_idx = -1;
134 
135           SIMPLEQ_INSERT_TAIL(&df->df_entries, de, de_entry);
136           df->df_total_key_size += _region_size(key);
137           df->df_total_data_size += ceilto(_region_size(data));
138           df->df_num_entries++;
139 
140           return 0;
141 
142 }
143 
144 int
_citrus_db_factory_add_by_string(struct _citrus_db_factory * df,const char * key,struct _citrus_region * data,int datafree)145 _citrus_db_factory_add_by_string(struct _citrus_db_factory *df,
146                                          const char *key,
147                                          struct _citrus_region *data, int datafree)
148 {
149           struct _region r;
150           char *tmp;
151           tmp = strdup(key);
152           if (tmp == NULL)
153                     return errno;
154           _region_init(&r, tmp, strlen(key));
155           return _citrus_db_factory_add(df, &r, 1, data, datafree);
156 }
157 
158 int
_citrus_db_factory_add8_by_string(struct _citrus_db_factory * df,const char * key,uint8_t val)159 _citrus_db_factory_add8_by_string(struct _citrus_db_factory *df,
160                                           const char *key, uint8_t val)
161 {
162           struct _region r;
163           uint8_t *p;
164 
165           p = malloc(sizeof(*p));
166           if (p == NULL)
167                     return errno;
168           *p = val;
169           _region_init(&r, p, 1);
170           return _citrus_db_factory_add_by_string(df, key, &r, 1);
171 }
172 
173 int
_citrus_db_factory_add16_by_string(struct _citrus_db_factory * df,const char * key,uint16_t val)174 _citrus_db_factory_add16_by_string(struct _citrus_db_factory *df,
175                                            const char *key, uint16_t val)
176 {
177           struct _region r;
178           uint16_t *p;
179 
180           p = malloc(sizeof(*p));
181           if (p == NULL)
182                     return errno;
183           *p = htons(val);
184           _region_init(&r, p, 2);
185           return _citrus_db_factory_add_by_string(df, key, &r, 1);
186 }
187 
188 int
_citrus_db_factory_add32_by_string(struct _citrus_db_factory * df,const char * key,uint32_t val)189 _citrus_db_factory_add32_by_string(struct _citrus_db_factory *df,
190                                            const char *key, uint32_t val)
191 {
192           struct _region r;
193           uint32_t *p;
194 
195           p = malloc(sizeof(*p));
196           if (p == NULL)
197                     return errno;
198           *p = htonl(val);
199           _region_init(&r, p, 4);
200           return _citrus_db_factory_add_by_string(df, key, &r, 1);
201 }
202 
203 int
_citrus_db_factory_add_string_by_string(struct _citrus_db_factory * df,const char * key,const char * data)204 _citrus_db_factory_add_string_by_string(struct _citrus_db_factory *df,
205                                                   const char *key, const char *data)
206 {
207           char *p;
208           struct _region r;
209 
210           p = strdup(data);
211           if (p == NULL)
212                     return errno;
213           _region_init(&r, p, strlen(p)+1);
214           return _citrus_db_factory_add_by_string(df, key, &r, 1);
215 }
216 
217 size_t
_citrus_db_factory_calc_size(struct _citrus_db_factory * df)218 _citrus_db_factory_calc_size(struct _citrus_db_factory *df)
219 {
220           size_t sz;
221 
222           sz = ceilto(_CITRUS_DB_HEADER_SIZE);
223           sz += ceilto(_CITRUS_DB_ENTRY_SIZE * df->df_num_entries);
224           sz += ceilto(df->df_total_key_size);
225           sz += df->df_total_data_size;
226 
227           return sz;
228 }
229 
230 static __inline void
put8(struct _region * r,size_t * rofs,uint8_t val)231 put8(struct _region *r, size_t *rofs, uint8_t val)
232 {
233           *(uint8_t *)_region_offset(r, *rofs) = val;
234           *rofs += 1;
235 }
236 
237 static __inline void
put32(struct _region * r,size_t * rofs,uint32_t val)238 put32(struct _region *r, size_t *rofs, uint32_t val)
239 {
240           val = htonl(val);
241           memcpy(_region_offset(r, *rofs), &val, 4);
242           *rofs += 4;
243 }
244 
245 static __inline void
putpad(struct _region * r,size_t * rofs)246 putpad(struct _region *r, size_t *rofs)
247 {
248           size_t i;
249           for (i = ceilto(*rofs) - *rofs; i > 0; i--)
250                     put8(r, rofs, 0);
251 }
252 
253 static __inline void
dump_header(struct _region * r,const char * magic,size_t * rofs,size_t num_entries)254 dump_header(struct _region *r, const char *magic, size_t *rofs,
255               size_t num_entries)
256 {
257           while (*rofs<_CITRUS_DB_MAGIC_SIZE)
258                     put8(r, rofs, *magic++);
259           put32(r, rofs, num_entries);
260           put32(r, rofs, _CITRUS_DB_HEADER_SIZE);
261 }
262 
263 int
_citrus_db_factory_serialize(struct _citrus_db_factory * df,const char * magic,struct _region * r)264 _citrus_db_factory_serialize(struct _citrus_db_factory *df, const char *magic,
265                                    struct _region *r)
266 {
267           size_t i, ofs, keyofs, dataofs, nextofs;
268           struct _citrus_db_factory_entry *de, **depp, *det;
269 
270           ofs = 0;
271           /* check whether more than 0 entries exist */
272           if (df->df_num_entries == 0) {
273                     dump_header(r, magic, &ofs, 0);
274                     return 0;
275           }
276           /* allocate hash table */
277           depp = calloc(df->df_num_entries, sizeof(*depp));
278           if (depp == NULL)
279                     return -1;
280 
281           /* step1: store the entries which are not conflicting */
282           SIMPLEQ_FOREACH(de, &df->df_entries, de_entry) {
283                     de->de_hashvalue %= df->df_num_entries;
284                     de->de_idx = -1;
285                     de->de_next = NULL;
286                     if (depp[de->de_hashvalue] == NULL) {
287                               depp[de->de_hashvalue] = de;
288                               de->de_idx = (int)de->de_hashvalue;
289                     }
290           }
291 
292           /* step2: resolve conflicts */
293           i = 0;
294           SIMPLEQ_FOREACH(de, &df->df_entries, de_entry) {
295                     if (de->de_idx == -1) {
296                               det = depp[de->de_hashvalue];
297                               while (det->de_next != NULL)
298                                         det = det->de_next;
299                               det->de_next = de;
300                               while (depp[i] != NULL)
301                                         i++;
302                               depp[i] = de;
303                               de->de_idx = (int)i;
304                     }
305           }
306 
307           keyofs =
308               _CITRUS_DB_HEADER_SIZE +
309               ceilto(df->df_num_entries*_CITRUS_DB_ENTRY_SIZE);
310           dataofs = keyofs + ceilto(df->df_total_key_size);
311 
312           /* dump header */
313           dump_header(r, magic, &ofs, df->df_num_entries);
314 
315           /* dump entries */
316           for (i = 0; i < df->df_num_entries; i++) {
317                     de = depp[i];
318                     nextofs = 0;
319                     if (de->de_next) {
320                               nextofs =
321                                   _CITRUS_DB_HEADER_SIZE +
322                                   de->de_next->de_idx * _CITRUS_DB_ENTRY_SIZE;
323                     }
324                     put32(r, &ofs, de->de_hashvalue);
325                     put32(r, &ofs, nextofs);
326                     put32(r, &ofs, keyofs);
327                     put32(r, &ofs, _region_size(&de->de_key));
328                     put32(r, &ofs, dataofs);
329                     put32(r, &ofs, _region_size(&de->de_data));
330                     memcpy(_region_offset(r, keyofs),
331                            _region_head(&de->de_key), _region_size(&de->de_key));
332                     keyofs += _region_size(&de->de_key);
333                     memcpy(_region_offset(r, dataofs),
334                            _region_head(&de->de_data), _region_size(&de->de_data));
335                     dataofs += _region_size(&de->de_data);
336                     putpad(r, &dataofs);
337           }
338           putpad(r, &ofs);
339           putpad(r, &keyofs);
340           free(depp);
341 
342           return 0;
343 }
344