123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171 |
- #include "printk.h"
- int skip_and_atoi(const char **s)
- {
-
- int ans = 0;
- while (is_digit(**s))
- {
- ans = ans * 10 + (**s) - '0';
- ++(*s);
- }
- return ans;
- }
- int vsprintf(char *buf, const char *fmt, va_list args)
- {
-
- char *str, *s;
- str = buf;
- int flags;
- int field_width;
- int precision;
- int qualifier;
- int len;
-
- for (; *fmt; ++fmt)
- {
-
- if (*fmt != '%')
- {
- *str = *fmt;
- ++str;
- }
-
-
- field_width = flags = 0;
- ++fmt;
- bool flag_tmp = true;
- bool flag_break = false;
- while (flag_tmp)
- {
- switch (*fmt)
- {
- case '\0':
-
- flag_break = true;
- flag_tmp = false;
- break;
- case '%':
-
- *str = '%';
- ++str;
- ++fmt;
- flag_break = true;
- break;
- case '-':
-
- flags |= LEFT;
- ++fmt;
- break;
- case '+':
-
- flags |= PLUS;
- ++fmt;
- break;
- case ' ':
- flags |= SPACE;
- ++fmt;
- break;
- case '#':
-
- flags |= SPECIAL;
- ++fmt;
- break;
- case '0':
-
- flags |= PAD_ZERO;
- ++fmt;
- break;
- default:
- flag_tmp = false;
- break;
- }
- }
- if (flag_break)
- break;
-
- if (*fmt == '*')
- {
- field_width = va_arg(args, int);
- ++fmt;
- }
- else if (is_digit(*fmt))
- field_width = skip_and_atoi(&fmt);
-
- if (*fmt == '.')
- {
- ++fmt;
- if (*fmt == '*')
- {
- precision = va_arg(args, int);
- ++fmt;
- }
- else if is_digit (*fmt)
- {
- precision = skip_and_atoi(&fmt);
- }
- }
-
- if (*fmt == 'h' || *fmt == 'l' || *fmt == 'L' || *fmt == 'Z')
- {
- qualifier = *fmt;
- ++fmt;
- }
-
- switch (*fmt)
- {
-
- case 'c':
-
- if (!(flags & LEFT))
- {
- while (--field_width)
- {
- *str = ' ';
- ++str;
- }
- }
- else
- {
- *str = (char)va_arg(args, int);
- ++str;
- --field_width;
- }
- while (--field_width)
- {
- *str = ' ';
- ++str;
- }
- break;
- default:
- break;
- }
- }
- }
|