1b528cefcSMark Murray /*
2*ae771770SStanislav Sedov * Copyright (c) 1997 - 2001 Kungliga Tekniska Högskolan
3b528cefcSMark Murray * (Royal Institute of Technology, Stockholm, Sweden).
4b528cefcSMark Murray * All rights reserved.
5b528cefcSMark Murray *
6b528cefcSMark Murray * Redistribution and use in source and binary forms, with or without
7b528cefcSMark Murray * modification, are permitted provided that the following conditions
8b528cefcSMark Murray * are met:
9b528cefcSMark Murray *
10b528cefcSMark Murray * 1. Redistributions of source code must retain the above copyright
11b528cefcSMark Murray * notice, this list of conditions and the following disclaimer.
12b528cefcSMark Murray *
13b528cefcSMark Murray * 2. Redistributions in binary form must reproduce the above copyright
14b528cefcSMark Murray * notice, this list of conditions and the following disclaimer in the
15b528cefcSMark Murray * documentation and/or other materials provided with the distribution.
16b528cefcSMark Murray *
17b528cefcSMark Murray * 3. Neither the name of the Institute nor the names of its contributors
18b528cefcSMark Murray * may be used to endorse or promote products derived from this software
19b528cefcSMark Murray * without specific prior written permission.
20b528cefcSMark Murray *
21b528cefcSMark Murray * THIS SOFTWARE IS PROVIDED BY THE INSTITUTE AND CONTRIBUTORS ``AS IS'' AND
22b528cefcSMark Murray * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
23b528cefcSMark Murray * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
24b528cefcSMark Murray * ARE DISCLAIMED. IN NO EVENT SHALL THE INSTITUTE OR CONTRIBUTORS BE LIABLE
25b528cefcSMark Murray * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
26b528cefcSMark Murray * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
27b528cefcSMark Murray * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
28b528cefcSMark Murray * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
29b528cefcSMark Murray * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
30b528cefcSMark Murray * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
31b528cefcSMark Murray * SUCH DAMAGE.
32b528cefcSMark Murray */
33b528cefcSMark Murray
34b528cefcSMark Murray #include <config.h>
35b528cefcSMark Murray
36b528cefcSMark Murray #include <stdio.h>
37b528cefcSMark Murray #include <ctype.h>
38b528cefcSMark Murray #include <string.h>
39c19800e8SDoug Rabson #include "roken.h"
40b528cefcSMark Murray #include "parse_units.h"
41b528cefcSMark Murray
42b528cefcSMark Murray /*
43b528cefcSMark Murray * Parse string in `s' according to `units' and return value.
44b528cefcSMark Murray * def_unit defines the default unit.
45b528cefcSMark Murray */
46b528cefcSMark Murray
47b528cefcSMark Murray static int
parse_something(const char * s,const struct units * units,const char * def_unit,int (* func)(int res,int val,unsigned mult),int init,int accept_no_val_p)48b528cefcSMark Murray parse_something (const char *s, const struct units *units,
49b528cefcSMark Murray const char *def_unit,
50b528cefcSMark Murray int (*func)(int res, int val, unsigned mult),
51b528cefcSMark Murray int init,
52b528cefcSMark Murray int accept_no_val_p)
53b528cefcSMark Murray {
54b528cefcSMark Murray const char *p;
55b528cefcSMark Murray int res = init;
56b528cefcSMark Murray unsigned def_mult = 1;
57b528cefcSMark Murray
58b528cefcSMark Murray if (def_unit != NULL) {
59b528cefcSMark Murray const struct units *u;
60b528cefcSMark Murray
61b528cefcSMark Murray for (u = units; u->name; ++u) {
62b528cefcSMark Murray if (strcasecmp (u->name, def_unit) == 0) {
63b528cefcSMark Murray def_mult = u->mult;
64b528cefcSMark Murray break;
65b528cefcSMark Murray }
66b528cefcSMark Murray }
67b528cefcSMark Murray if (u->name == NULL)
68b528cefcSMark Murray return -1;
69b528cefcSMark Murray }
70b528cefcSMark Murray
71b528cefcSMark Murray p = s;
72b528cefcSMark Murray while (*p) {
73*ae771770SStanislav Sedov int val;
74b528cefcSMark Murray char *next;
75b528cefcSMark Murray const struct units *u, *partial_unit;
76b528cefcSMark Murray size_t u_len;
77b528cefcSMark Murray unsigned partial;
78b528cefcSMark Murray int no_val_p = 0;
79b528cefcSMark Murray
80b528cefcSMark Murray while(isspace((unsigned char)*p) || *p == ',')
81b528cefcSMark Murray ++p;
82b528cefcSMark Murray
83*ae771770SStanislav Sedov val = strtol(p, &next, 0);
84adb0ddaeSAssar Westerlund if (p == next) {
85adb0ddaeSAssar Westerlund val = 0;
86b528cefcSMark Murray if(!accept_no_val_p)
87b528cefcSMark Murray return -1;
88b528cefcSMark Murray no_val_p = 1;
89b528cefcSMark Murray }
90b528cefcSMark Murray p = next;
91b528cefcSMark Murray while (isspace((unsigned char)*p))
92b528cefcSMark Murray ++p;
93b528cefcSMark Murray if (*p == '\0') {
94b528cefcSMark Murray res = (*func)(res, val, def_mult);
95b528cefcSMark Murray if (res < 0)
96b528cefcSMark Murray return res;
97b528cefcSMark Murray break;
98b528cefcSMark Murray } else if (*p == '+') {
99b528cefcSMark Murray ++p;
100b528cefcSMark Murray val = 1;
101b528cefcSMark Murray } else if (*p == '-') {
102b528cefcSMark Murray ++p;
103b528cefcSMark Murray val = -1;
104b528cefcSMark Murray }
105b528cefcSMark Murray if (no_val_p && val == 0)
106b528cefcSMark Murray val = 1;
107b528cefcSMark Murray u_len = strcspn (p, ", \t");
108b528cefcSMark Murray partial = 0;
109b528cefcSMark Murray partial_unit = NULL;
110b528cefcSMark Murray if (u_len > 1 && p[u_len - 1] == 's')
111b528cefcSMark Murray --u_len;
112b528cefcSMark Murray for (u = units; u->name; ++u) {
113b528cefcSMark Murray if (strncasecmp (p, u->name, u_len) == 0) {
114b528cefcSMark Murray if (u_len == strlen (u->name)) {
115b528cefcSMark Murray p += u_len;
116b528cefcSMark Murray res = (*func)(res, val, u->mult);
117b528cefcSMark Murray if (res < 0)
118b528cefcSMark Murray return res;
119b528cefcSMark Murray break;
120b528cefcSMark Murray } else {
121b528cefcSMark Murray ++partial;
122b528cefcSMark Murray partial_unit = u;
123b528cefcSMark Murray }
124b528cefcSMark Murray }
125b528cefcSMark Murray }
126b528cefcSMark Murray if (u->name == NULL) {
127b528cefcSMark Murray if (partial == 1) {
128b528cefcSMark Murray p += u_len;
129b528cefcSMark Murray res = (*func)(res, val, partial_unit->mult);
130b528cefcSMark Murray if (res < 0)
131b528cefcSMark Murray return res;
132b528cefcSMark Murray } else {
133b528cefcSMark Murray return -1;
134b528cefcSMark Murray }
135b528cefcSMark Murray }
136b528cefcSMark Murray if (*p == 's')
137b528cefcSMark Murray ++p;
138b528cefcSMark Murray }
139b528cefcSMark Murray return res;
140b528cefcSMark Murray }
141b528cefcSMark Murray
142b528cefcSMark Murray /*
143b528cefcSMark Murray * The string consists of a sequence of `n unit'
144b528cefcSMark Murray */
145b528cefcSMark Murray
146b528cefcSMark Murray static int
acc_units(int res,int val,unsigned mult)147b528cefcSMark Murray acc_units(int res, int val, unsigned mult)
148b528cefcSMark Murray {
149b528cefcSMark Murray return res + val * mult;
150b528cefcSMark Murray }
151b528cefcSMark Murray
152*ae771770SStanislav Sedov ROKEN_LIB_FUNCTION int ROKEN_LIB_CALL
parse_units(const char * s,const struct units * units,const char * def_unit)153b528cefcSMark Murray parse_units (const char *s, const struct units *units,
154b528cefcSMark Murray const char *def_unit)
155b528cefcSMark Murray {
156b528cefcSMark Murray return parse_something (s, units, def_unit, acc_units, 0, 0);
157b528cefcSMark Murray }
158b528cefcSMark Murray
159b528cefcSMark Murray /*
160b528cefcSMark Murray * The string consists of a sequence of `[+-]flag'. `orig' consists
161b528cefcSMark Murray * the original set of flags, those are then modified and returned as
162b528cefcSMark Murray * the function value.
163b528cefcSMark Murray */
164b528cefcSMark Murray
165b528cefcSMark Murray static int
acc_flags(int res,int val,unsigned mult)166b528cefcSMark Murray acc_flags(int res, int val, unsigned mult)
167b528cefcSMark Murray {
168b528cefcSMark Murray if(val == 1)
169b528cefcSMark Murray return res | mult;
170b528cefcSMark Murray else if(val == -1)
171b528cefcSMark Murray return res & ~mult;
172b528cefcSMark Murray else if (val == 0)
173b528cefcSMark Murray return mult;
174b528cefcSMark Murray else
175b528cefcSMark Murray return -1;
176b528cefcSMark Murray }
177b528cefcSMark Murray
178*ae771770SStanislav Sedov ROKEN_LIB_FUNCTION int ROKEN_LIB_CALL
parse_flags(const char * s,const struct units * units,int orig)179b528cefcSMark Murray parse_flags (const char *s, const struct units *units,
180b528cefcSMark Murray int orig)
181b528cefcSMark Murray {
182b528cefcSMark Murray return parse_something (s, units, NULL, acc_flags, orig, 1);
183b528cefcSMark Murray }
184b528cefcSMark Murray
185b528cefcSMark Murray /*
186b528cefcSMark Murray * Return a string representation according to `units' of `num' in `s'
187b528cefcSMark Murray * with maximum length `len'. The actual length is the function value.
188b528cefcSMark Murray */
189b528cefcSMark Murray
1904137ff4cSJacques Vidrine static int
unparse_something(int num,const struct units * units,char * s,size_t len,int (* print)(char *,size_t,int,const char *,int),int (* update)(int,unsigned),const char * zero_string)191b528cefcSMark Murray unparse_something (int num, const struct units *units, char *s, size_t len,
192c19800e8SDoug Rabson int (*print) (char *, size_t, int, const char *, int),
193c19800e8SDoug Rabson int (*update) (int, unsigned),
194b528cefcSMark Murray const char *zero_string)
195b528cefcSMark Murray {
196b528cefcSMark Murray const struct units *u;
1974137ff4cSJacques Vidrine int ret = 0, tmp;
198b528cefcSMark Murray
199b528cefcSMark Murray if (num == 0)
200b528cefcSMark Murray return snprintf (s, len, "%s", zero_string);
201b528cefcSMark Murray
202b528cefcSMark Murray for (u = units; num > 0 && u->name; ++u) {
203c19800e8SDoug Rabson int divisor;
204b528cefcSMark Murray
205c19800e8SDoug Rabson divisor = num / u->mult;
206c19800e8SDoug Rabson if (divisor) {
207b528cefcSMark Murray num = (*update) (num, u->mult);
208c19800e8SDoug Rabson tmp = (*print) (s, len, divisor, u->name, num);
2094137ff4cSJacques Vidrine if (tmp < 0)
2104137ff4cSJacques Vidrine return tmp;
211*ae771770SStanislav Sedov if (tmp > (int) len) {
212c19800e8SDoug Rabson len = 0;
213c19800e8SDoug Rabson s = NULL;
214c19800e8SDoug Rabson } else {
215b528cefcSMark Murray len -= tmp;
216b528cefcSMark Murray s += tmp;
217c19800e8SDoug Rabson }
218b528cefcSMark Murray ret += tmp;
219b528cefcSMark Murray }
220b528cefcSMark Murray }
221b528cefcSMark Murray return ret;
222b528cefcSMark Murray }
223b528cefcSMark Murray
224b528cefcSMark Murray static int
print_unit(char * s,size_t len,int divisor,const char * name,int rem)225c19800e8SDoug Rabson print_unit (char *s, size_t len, int divisor, const char *name, int rem)
226b528cefcSMark Murray {
227b528cefcSMark Murray return snprintf (s, len, "%u %s%s%s",
228c19800e8SDoug Rabson divisor, name,
229c19800e8SDoug Rabson divisor == 1 ? "" : "s",
230b528cefcSMark Murray rem > 0 ? " " : "");
231b528cefcSMark Murray }
232b528cefcSMark Murray
233b528cefcSMark Murray static int
update_unit(int in,unsigned mult)234b528cefcSMark Murray update_unit (int in, unsigned mult)
235b528cefcSMark Murray {
236b528cefcSMark Murray return in % mult;
237b528cefcSMark Murray }
238b528cefcSMark Murray
239b528cefcSMark Murray static int
update_unit_approx(int in,unsigned mult)240b528cefcSMark Murray update_unit_approx (int in, unsigned mult)
241b528cefcSMark Murray {
242b528cefcSMark Murray if (in / mult > 0)
243b528cefcSMark Murray return 0;
244b528cefcSMark Murray else
245b528cefcSMark Murray return update_unit (in, mult);
246b528cefcSMark Murray }
247b528cefcSMark Murray
248*ae771770SStanislav Sedov ROKEN_LIB_FUNCTION int ROKEN_LIB_CALL
unparse_units(int num,const struct units * units,char * s,size_t len)249b528cefcSMark Murray unparse_units (int num, const struct units *units, char *s, size_t len)
250b528cefcSMark Murray {
251b528cefcSMark Murray return unparse_something (num, units, s, len,
252b528cefcSMark Murray print_unit,
253b528cefcSMark Murray update_unit,
254b528cefcSMark Murray "0");
255b528cefcSMark Murray }
256b528cefcSMark Murray
257*ae771770SStanislav Sedov ROKEN_LIB_FUNCTION int ROKEN_LIB_CALL
unparse_units_approx(int num,const struct units * units,char * s,size_t len)258b528cefcSMark Murray unparse_units_approx (int num, const struct units *units, char *s, size_t len)
259b528cefcSMark Murray {
260b528cefcSMark Murray return unparse_something (num, units, s, len,
261b528cefcSMark Murray print_unit,
262b528cefcSMark Murray update_unit_approx,
263b528cefcSMark Murray "0");
264b528cefcSMark Murray }
265b528cefcSMark Murray
266*ae771770SStanislav Sedov ROKEN_LIB_FUNCTION void ROKEN_LIB_CALL
print_units_table(const struct units * units,FILE * f)267b528cefcSMark Murray print_units_table (const struct units *units, FILE *f)
268b528cefcSMark Murray {
269b528cefcSMark Murray const struct units *u, *u2;
270*ae771770SStanislav Sedov size_t max_sz = 0;
271b528cefcSMark Murray
272b528cefcSMark Murray for (u = units; u->name; ++u) {
273b528cefcSMark Murray max_sz = max(max_sz, strlen(u->name));
274b528cefcSMark Murray }
275b528cefcSMark Murray
276b528cefcSMark Murray for (u = units; u->name;) {
277b528cefcSMark Murray char buf[1024];
278b528cefcSMark Murray const struct units *next;
279b528cefcSMark Murray
280b528cefcSMark Murray for (next = u + 1; next->name && next->mult == u->mult; ++next)
281b528cefcSMark Murray ;
282b528cefcSMark Murray
283b528cefcSMark Murray if (next->name) {
284b528cefcSMark Murray for (u2 = next;
285b528cefcSMark Murray u2->name && u->mult % u2->mult != 0;
286b528cefcSMark Murray ++u2)
287b528cefcSMark Murray ;
288b528cefcSMark Murray if (u2->name == NULL)
289b528cefcSMark Murray --u2;
290b528cefcSMark Murray unparse_units (u->mult, u2, buf, sizeof(buf));
291*ae771770SStanislav Sedov fprintf (f, "1 %*s = %s\n", (int)max_sz, u->name, buf);
292b528cefcSMark Murray } else {
293b528cefcSMark Murray fprintf (f, "1 %s\n", u->name);
294b528cefcSMark Murray }
295b528cefcSMark Murray u = next;
296b528cefcSMark Murray }
297b528cefcSMark Murray }
298b528cefcSMark Murray
299b528cefcSMark Murray static int
print_flag(char * s,size_t len,int divisor,const char * name,int rem)300c19800e8SDoug Rabson print_flag (char *s, size_t len, int divisor, const char *name, int rem)
301b528cefcSMark Murray {
302b528cefcSMark Murray return snprintf (s, len, "%s%s", name, rem > 0 ? ", " : "");
303b528cefcSMark Murray }
304b528cefcSMark Murray
305b528cefcSMark Murray static int
update_flag(int in,unsigned mult)306b528cefcSMark Murray update_flag (int in, unsigned mult)
307b528cefcSMark Murray {
308b528cefcSMark Murray return in - mult;
309b528cefcSMark Murray }
310b528cefcSMark Murray
311*ae771770SStanislav Sedov ROKEN_LIB_FUNCTION int ROKEN_LIB_CALL
unparse_flags(int num,const struct units * units,char * s,size_t len)312b528cefcSMark Murray unparse_flags (int num, const struct units *units, char *s, size_t len)
313b528cefcSMark Murray {
314b528cefcSMark Murray return unparse_something (num, units, s, len,
315b528cefcSMark Murray print_flag,
316b528cefcSMark Murray update_flag,
317b528cefcSMark Murray "");
318b528cefcSMark Murray }
319b528cefcSMark Murray
320*ae771770SStanislav Sedov ROKEN_LIB_FUNCTION void ROKEN_LIB_CALL
print_flags_table(const struct units * units,FILE * f)321b528cefcSMark Murray print_flags_table (const struct units *units, FILE *f)
322b528cefcSMark Murray {
323b528cefcSMark Murray const struct units *u;
324b528cefcSMark Murray
325b528cefcSMark Murray for(u = units; u->name; ++u)
326b528cefcSMark Murray fprintf(f, "%s%s", u->name, (u+1)->name ? ", " : "\n");
327b528cefcSMark Murray }
328