?  search:
summary | log | graphiclog1 | graphiclog2 | commit | commitdiff | tree | refs | edit | fork
blame | history | raw | HEAD
grub2: bring back build of aros-side grub2 tools
[AROS.git] / workbench / libs / locale / formatstring.c
blobd960ab8d29c52965274213477e3609c2adccd949
1 /*
2 Copyright © 1995-2012, The AROS Development Team. All rights reserved.
3 $Id$
4
5 Desc:
6 Lang: english
7 */
8
9 #include <stdarg.h>
10 #include <stdlib.h>
11 #include <string.h>
12 #include <exec/types.h>
13 #include <utility/hooks.h>
14 #include <proto/utility.h>
15 #include <libraries/locale.h>
16 #include <aros/asmcall.h>
17 #include "locale_intern.h"
18
19 #include <clib/alib_protos.h>
20
21 #include <aros/debug.h>
22
23 typedef QUAD FMTLARGESTTYPE;
24 typedef UQUAD UFMTLARGESTTYPE;
25
26 static const UBYTE hexarray[] = "0123456789abcdef";
27 static const UBYTE HEXarray[] = "0123456789ABCDEF";
28
29 APTR InternalFormatString(const struct Locale * locale,
30 CONST_STRPTR fmtTemplate, CONST_APTR dataStream,
31 ULONG *indexStream, const struct Hook * putCharFunc)
32 {
33 enum
34 { OUTPUT = 0,
35 FOUND_FORMAT
36 } state;
37
38 #define ARG(x) ((CONST_APTR)((IPTR)dataStream + indexStream[(x) - 1]))
39
40 ULONG template_pos;
41 BOOL end;
42 ULONG max_argpos, max_argpos_datasize;
43 ULONG arg_counter;
44
45 if (!fmtTemplate)
46 return (APTR)dataStream;
47
48 template_pos = 0; /* Current position in the template string */
49 state = OUTPUT; /* current state of parsing */
50 end = FALSE;
51 max_argpos = 1;
52 arg_counter = 0;
53 max_argpos_datasize = 0;
54
55 while (!end)
56 {
57 /*
58 ** A format description starts here?
59 */
60 if (fmtTemplate[template_pos] == '%')
61 {
62 arg_counter++;
63 state = FOUND_FORMAT;
64 }
65
66 switch (state)
67 {
68 case OUTPUT:
69 /*
70 ** Call the hook for this character
71 */
72 AROS_UFC3NR(VOID, putCharFunc->h_Entry,
73 AROS_UFCA(const struct Hook *, putCharFunc, A0),
74 AROS_UFCA(const struct Locale *, locale, A2),
75 AROS_UFCA(UBYTE, fmtTemplate[template_pos], A1));
76
77 /*
78 ** End of template string? -> End of this function.
79 */
80 if (fmtTemplate[template_pos] == '\0')
81 {
82 end = TRUE;
83 }
84 else
85 template_pos++;
86
87 //kprintf("OUTPUT: template_pos: %d\n",template_pos);
88
89 break;
90
91 case FOUND_FORMAT:
92 /*
93 ** The '%' was found in the template string
94 */
95 template_pos++;
96
97 //kprintf("FOUND_FORMAT: template_pos: %d\n",template_pos);
98 /*
99 ** Does the user want the '%' to be printed?
100 */
101 if (fmtTemplate[template_pos] == '%')
102 {
103 AROS_UFC3NR(VOID, putCharFunc->h_Entry,
104 AROS_UFCA(const struct Hook *, putCharFunc, A0),
105 AROS_UFCA(const struct Locale *, locale, A2),
106 AROS_UFCA(UBYTE, fmtTemplate[template_pos], A1));
107 template_pos++;
108 arg_counter--; //stegerg
109 }
110 else
111 {
112 /*
113 ** Now parsing...
114 ** Template format: %[arg_pos$][flags][width][.limit][length]type
115 **
116 ** arg_pos specifies the position of the argument in the dataStream
117 ** flags only '-' is allowed
118 ** width
119 ** .limit
120 ** datasize size of the datatype
121 ** type b,d,D,u,U,x,X,s,c
122 */
123 ULONG arg_pos = 1;
124 BOOL left = FALSE; // no flag was found
125 UBYTE fill = ' ';
126 ULONG minus;
127 ULONG width = 0;
128 ULONG limit = ~0;
129 ULONG buflen = 0;
130 ULONG datasize;
131 UFMTLARGESTTYPE tmp = 0;
132 #define BUFFERSIZE 128
133 UBYTE buf[BUFFERSIZE];
134 UBYTE *buffer = buf;
135
136 /*
137 ** arg_pos
138 */
139
140 //kprintf("next char: %c\n",fmtTemplate[template_pos]);
141
142 if (fmtTemplate[template_pos] >= '0' &&
143 fmtTemplate[template_pos] <= '9')
144 {
145 ULONG old_template_pos = template_pos;
146
147 for (arg_pos = 0; (fmtTemplate[template_pos] >= '0' &&
148 fmtTemplate[template_pos] <= '9');
149 template_pos++)
150 {
151 arg_pos =
152 arg_pos * 10 + fmtTemplate[template_pos] - '0';
153 }
154
155 if (fmtTemplate[template_pos] == '$')
156 template_pos++;
157 else
158 {
159 arg_pos = arg_counter;
160 template_pos = old_template_pos;
161 }
162 }
163 else
164 arg_pos = arg_counter;
165
166 /*
167 ** flags
168 */
169 if (fmtTemplate[template_pos] == '-')
170 {
171 template_pos++;
172 left = TRUE;
173 }
174
175 /*
176 ** fill character a '0'?
177 */
178 if (fmtTemplate[template_pos] == '0')
179 {
180 template_pos++;
181 fill = '0';
182 }
183
184 /*
185 ** width
186 */
187 if (fmtTemplate[template_pos] >= '0' &&
188 fmtTemplate[template_pos] <= '9')
189 {
190 for (width = 0; (fmtTemplate[template_pos] >= '0' &&
191 fmtTemplate[template_pos] <= '9');
192 template_pos++)
193 {
194 width =
195 width * 10 + fmtTemplate[template_pos] - '0';
196 }
197 }
198
199 /*
200 ** limit
201 */
202 if (fmtTemplate[template_pos] == '.')
203 {
204 template_pos++;
205
206 if (fmtTemplate[template_pos] >= '0' &&
207 fmtTemplate[template_pos] <= '9')
208 {
209 for (limit = 0; (fmtTemplate[template_pos] >= '0' &&
210 fmtTemplate[template_pos] <= '9');
211 template_pos++)
212 {
213 limit =
214 limit * 10 + fmtTemplate[template_pos] -
215 '0';
216 }
217 }
218 }
219
220 /*
221 ** Length
222 */
223 switch (fmtTemplate[template_pos])
224 {
225 case 'i':
226 /* IPTR-sized type, can be mixed with %d, %u or %x */
227 datasize = sizeof(IPTR);
228 template_pos++;
229 break;
230 case 'L':
231 datasize = sizeof(UQUAD);
232 template_pos++;
233 break;
234 case 'l':
235 template_pos++;
236 if (fmtTemplate[template_pos] == 'l')
237 {
238 datasize = sizeof(UQUAD);
239 template_pos++;
240 }
241 else
242 datasize = sizeof(ULONG);
243 break;
244
245 default:
246 datasize = sizeof(UWORD);
247 break;
248 }
249
250 /*
251 ** Print it according to the given type info.
252 */
253 switch (fmtTemplate[template_pos])
254 {
255 case 'b': /* BSTR, see autodocs */
256 /*
257 ** Important parameters:
258 ** arg_pos, left, buflen, limit
259 */
260 {
261 datasize = sizeof(IPTR);
262 BSTR s = (BSTR) * (UBYTE **) ARG(arg_pos);
263
264 if (s != (BSTR) BNULL)
265 {
266 buffer = AROS_BSTR_ADDR(s);
267 buflen = AROS_BSTR_strlen(s);
268 }
269 else
270 {
271 buffer = "";
272 buflen = 0;
273 }
274
275 #if !USE_GLOBALLIMIT
276 if (buflen > limit)
277 buflen = limit;
278 #endif /* !USE_GLOBALLIMIT */
279 }
280 break;
281
282 case 'd': /* signed decimal */
283 case 'u': /* unsigned decimal */
284
285 minus = fmtTemplate[template_pos] == 'd';
286
287 {
288 switch (datasize)
289 {
290 case 8:
291 tmp = *(UQUAD *) ARG(arg_pos);
292 //buffer = &buf[16+1];
293 minus *= (FMTLARGESTTYPE) tmp < 0;
294 if (minus)
295 tmp = -tmp;
296 break;
297 case 4:
298 tmp = *(ULONG *) ARG(arg_pos);
299 //buffer = &buf[8+1];
300 minus *= (LONG) tmp < 0;
301 if (minus)
302 tmp = (ULONG) - tmp;
303 break;
304
305 default: /* 2 */
306 tmp = *(UWORD *) ARG(arg_pos);
307 //buffer = &buf[4+1];
308 minus *= (WORD) tmp < 0;
309 if (minus)
310 tmp = (UWORD) - tmp;
311 break;
312 }
313
314 buffer = &buf[BUFFERSIZE];
315 do
316 {
317 *--buffer = (tmp % 10) + '0';
318 tmp /= 10;
319 buflen++;
320 }
321 while (tmp);
322
323 if (minus)
324 {
325 *--buffer = '-';
326 buflen++;
327 }
328
329 }
330 break;
331
332 case 'D': /* signed decimal with locale's formatting conventions */
333 case 'U': /* unsigned decimal with locale's formatting conventions */
334 {
335 UBYTE groupsize;
336 ULONG group_index = 0;
337
338 minus = fmtTemplate[template_pos] == 'D';
339
340 switch (datasize)
341 {
342 case 8:
343 tmp = *(UQUAD *) ARG(arg_pos);
344 minus *= (FMTLARGESTTYPE) tmp < 0;
345 if (minus)
346 tmp = -tmp;
347 break;
348 case 4:
349 tmp = *(ULONG *) ARG(arg_pos);
350 minus *= (LONG) tmp < 0;
351 if (minus)
352 tmp = (ULONG) - tmp;
353 break;
354
355 default: /* 2 */
356 tmp = *(UWORD *) ARG(arg_pos);
357 minus *= (WORD) tmp < 0;
358 if (minus)
359 tmp = (UWORD) - tmp;
360 break;
361 }
362
363 /* BUFFERSIZE should be big enough to format a string
364 ** according to locale's formatting conventions
365 */
366 buffer = &buf[BUFFERSIZE];
367 groupsize =
368 locale ? locale->
369 loc_Grouping[group_index] : 255;
370
371 do
372 {
373 *--buffer = (tmp % 10) + '0';
374 tmp /= 10;
375 buflen++;
376
377 groupsize--;
378
379 if (groupsize == 0 && tmp != 0)
380 {
381 /*
382 ** Write the separator
383 */
384
385 *--buffer =
386 locale->loc_GroupSeparator[group_index];
387
388 groupsize =
389 locale->loc_Grouping[group_index + 1];
390
391 if (groupsize == 0)
392 {
393 /*
394 ** Supposed to use the previous element
395 */
396 groupsize =
397 locale->loc_Grouping[group_index];
398 }
399 else
400 group_index++;
401
402 buflen++;
403 }
404 }
405 while (tmp);
406
407 if (minus)
408 {
409 *--buffer = '-';
410 buflen++;
411 }
412 }
413 break;
414
415 case 'p': /* lower case pointer string */
416 case 'P': /* upper case pointer string */
417 fill = '0';
418 width = sizeof(APTR) * 2;
419 /* %p is always at least natural pointer size */
420 if (datasize < sizeof(APTR))
421 datasize = sizeof(APTR);
422 case 'x': /* upper case hexadecimal string */
423 case 'X': /* lower case hexadecimal string */
424
425 {
426 const UBYTE *hexa;
427
428 switch (datasize)
429 {
430 case 8:
431 tmp = *(UQUAD *) ARG(arg_pos);
432 //buffer = &buf[16+1];
433 break;
434 case 4:
435 tmp = *(ULONG *) ARG(arg_pos);
436 //buffer = &buf[8+1];
437 break;
438
439 default: /* 2 */
440 tmp = *(UWORD *) ARG(arg_pos);
441 //buffer = &buf[4+1];
442 break;
443 }
444
445 buffer = &buf[BUFFERSIZE];
446
447 /* NOTE: x/X is reverse to printf, coz orig RawDoFmt %lx for uppercase. */
448 hexa = (fmtTemplate[template_pos] == 'X' ||
449 fmtTemplate[template_pos] ==
450 'p') ? hexarray : HEXarray;
451 do
452 {
453 *--buffer = hexa[tmp & 0x0f];
454 tmp >>= 4;
455 buflen++;
456 }
457 while (tmp);
458 }
459 break;
460
461 case 's': /* NULL terminated string */
462 {
463 datasize = sizeof(IPTR);
464 {
465 buffer = *(UBYTE **) ARG(arg_pos);
466
467 /*
468 * RawDoFmt() in original AmigaOS(tm) formats NULL pointers as empty strings,
469 * and not something like "(null)". Some software may rely on this behavior.
470 * %b is handled in similar manner.
471 */
472 if (!buffer)
473 buffer = "";
474 buflen = strlen(buffer);
475
476 #if !USE_GLOBALLIMIT
477 if (buflen > limit)
478 buflen = limit;
479 #endif /* !USE_GLOBALLIMIT */
480 }
481 }
482 break;
483
484 case 'c': /* Character */
485 {
486 switch (datasize)
487 {
488 case 8:
489 buf[0] =
490 (UBYTE) * (UQUAD *) ARG(arg_pos);
491 break;
492 case 4:
493 buf[0] =
494 (UBYTE) * (ULONG *) ARG(arg_pos);
495 break;
496
497 default: /* 2 */
498 buf[0] =
499 (UBYTE) * (WORD *) ARG(arg_pos);
500 break;
501 }
502
503 buflen = 1;
504 }
505 break;
506
507 default:
508 /* Ignore the faulty '%' */
509
510 buf[0] = fmtTemplate[template_pos];
511 width = 1;
512 buflen = 1;
513 arg_pos = --arg_counter;
514 break;
515 }
516
517
518 {
519 int i;
520
521 /*
522 Now everything I need is known:
523 buffer - contains the string to be printed
524 buflen - size of the string
525 fill - the pad character
526 left - is 1 if the string should be left aligned
527 width - is the minimal width of the field
528 limit - maximum number of characters to output from a string, default ~0
529 */
530
531 #if USE_GLOBALLIMIT
532 if (buflen > limit)
533 buflen = limit;
534 #endif /* USE_GLOBALLIMIT */
535
536 /* Print padding if right aligned */
537 if (!left)
538 for (i = buflen; i < width; i++)
539 AROS_UFC3NR(VOID, putCharFunc->h_Entry,
540 AROS_UFCA(const struct Hook *, putCharFunc, A0),
541 AROS_UFCA(const struct Locale *, locale, A2),
542 AROS_UFCA(UBYTE, fill, A1));
543
544 /* Print body up to buflen */
545 for (i = 0; i < buflen; i++)
546 {
547 AROS_UFC3NR(VOID, putCharFunc->h_Entry,
548 AROS_UFCA(const struct Hook *, putCharFunc, A0),
549 AROS_UFCA(const struct Locale *, locale, A2),
550 AROS_UFCA(UBYTE, *buffer++, A1));
551 }
552
553 /* Pad right if left aligned */
554 if (left)
555 for (i = buflen; i < width; i++)
556 AROS_UFC3NR(VOID, putCharFunc->h_Entry,
557 AROS_UFCA(const struct Hook *, putCharFunc, A0),
558 AROS_UFCA(const struct Locale *, locale, A2),
559 AROS_UFCA(UBYTE, fill, A1));
560 }
561
562 template_pos++;
563
564 if (arg_pos > max_argpos)
565 {
566 max_argpos = arg_pos;
567 max_argpos_datasize = datasize;
568 }
569
570 }
571 state = OUTPUT;
572 break;
573 }
574 }
575
576 return (APTR)(ARG(max_argpos) + max_argpos_datasize);
577 }
578
579 /*****************************************************************************
580
581 NAME */
582 #include <proto/locale.h>
583
584 AROS_LH4(APTR, FormatString,
585
586 /* SYNOPSIS */
587 AROS_LHA(const struct Locale *, locale, A0),
588 AROS_LHA(CONST_STRPTR, fmtTemplate, A1),
589 AROS_LHA(RAWARG, dataStream, A2),
590 AROS_LHA(const struct Hook *, putCharFunc, A3),
591
592 /* LOCATION */
593 struct LocaleBase *, LocaleBase, 11, Locale)
594
595 /* FUNCTION
596
597 INPUTS
598
599 RESULT
600
601 NOTES
602
603 EXAMPLE
604
605 BUGS
606
607 SEE ALSO
608
609 INTERNALS
610
611 *****************************************************************************/
612 {
613 AROS_LIBFUNC_INIT
614 ULONG *indices;
615 ULONG indexSize = 0;
616 #if defined(__arm__) || defined(__x86_64__)
617 va_list nullarg = {};
618 #else
619 va_list nullarg = 0;
620 #endif
621
622 /* Generate the indexes for the provided datastream */
623 GetDataStreamFromFormat(fmtTemplate, nullarg, NULL, NULL, NULL, &indexSize);
624 indices = alloca(indexSize);
625 GetDataStreamFromFormat(fmtTemplate, nullarg, NULL, NULL, indices, &indexSize);
626
627 return InternalFormatString(locale, fmtTemplate,
628 dataStream, indices, putCharFunc);
629
630 AROS_LIBFUNC_EXIT
631 }
Mirror of AROS' svn.