|
@@ -2,6 +2,7 @@
|
|
|
|
|
|
|
|
|
#include "printk.h"
|
|
|
+#include <math.h>
|
|
|
|
|
|
int skip_and_atoi(const char **s)
|
|
|
{
|
|
@@ -17,7 +18,7 @@ int skip_and_atoi(const char **s)
|
|
|
}
|
|
|
return ans;
|
|
|
}
|
|
|
-int vsprintf(char *buf, const char *fmt, va_list args)
|
|
|
+static int vsprintf(char *buf, const char *fmt, va_list args)
|
|
|
{
|
|
|
|
|
|
* 将字符串按照fmt和args中的内容进行格式化,然后保存到buf中
|
|
@@ -45,6 +46,7 @@ int vsprintf(char *buf, const char *fmt, va_list args)
|
|
|
{
|
|
|
*str = *fmt;
|
|
|
++str;
|
|
|
+ continue;
|
|
|
}
|
|
|
|
|
|
|
|
@@ -164,6 +166,7 @@ int vsprintf(char *buf, const char *fmt, va_list args)
|
|
|
}
|
|
|
|
|
|
break;
|
|
|
+
|
|
|
|
|
|
case 's':
|
|
|
s = va_arg(args, char *);
|
|
@@ -188,7 +191,7 @@ int vsprintf(char *buf, const char *fmt, va_list args)
|
|
|
*str = ' ';
|
|
|
++str;
|
|
|
}
|
|
|
-
|
|
|
+
|
|
|
for (int i = 0; i < len; i++)
|
|
|
{
|
|
|
*str = *s;
|
|
@@ -196,17 +199,183 @@ int vsprintf(char *buf, const char *fmt, va_list args)
|
|
|
++str;
|
|
|
}
|
|
|
|
|
|
- while (len<field_width--)
|
|
|
+ while (len < field_width--)
|
|
|
{
|
|
|
*str = ' ';
|
|
|
++str;
|
|
|
}
|
|
|
-
|
|
|
-
|
|
|
+
|
|
|
+ break;
|
|
|
+
|
|
|
+ case 'o':
|
|
|
+ if (qualifier == 'l')
|
|
|
+ write_num(str, va_arg(args, long long), 8, field_width, precision, flags);
|
|
|
+ else
|
|
|
+ write_num(str, va_arg(args, int), 8, field_width, precision, flags);
|
|
|
+ break;
|
|
|
+
|
|
|
+
|
|
|
+ case 'p':
|
|
|
+ if (field_width == 0)
|
|
|
+ {
|
|
|
+ field_width = 2 * sizeof(void *);
|
|
|
+ flags |= PAD_ZERO;
|
|
|
+ }
|
|
|
+
|
|
|
+ write_num(str, (unsigned long)va_arg(args, void *), 16, field_width, precision, flags);
|
|
|
+
|
|
|
break;
|
|
|
|
|
|
+
|
|
|
+ case 'x':
|
|
|
+ flags |= SMALL;
|
|
|
+ case 'X':
|
|
|
+ if (qualifier == 'l')
|
|
|
+ write_num(str, va_arg(args, long long), 16, field_width, precision, flags);
|
|
|
+ else
|
|
|
+ write_num(str, va_arg(args, int), 16, field_width, precision, flags);
|
|
|
+ break;
|
|
|
+
|
|
|
+
|
|
|
+ case 'i':
|
|
|
+ case 'd':
|
|
|
+ case 'ld':
|
|
|
+ flags |= SIGN;
|
|
|
+ if (qualifier == 'l')
|
|
|
+ write_num(str, va_arg(args, long long), 10, field_width, precision, flags);
|
|
|
+ else
|
|
|
+ write_num(str, va_arg(args, int), 10, field_width, precision, flags);
|
|
|
+ break;
|
|
|
+
|
|
|
+
|
|
|
+ case 'u':
|
|
|
+ if (qualifier == 'l')
|
|
|
+ write_num(str, va_arg(args, unsigned long long), 10, field_width, precision, flags);
|
|
|
+ else
|
|
|
+ write_num(str, va_arg(args, unsigned int), 10, field_width, precision, flags);
|
|
|
+ break;
|
|
|
+
|
|
|
+
|
|
|
+ case 'n':
|
|
|
+ long long *ip;
|
|
|
+ if (qualifier == 'l')
|
|
|
+ ip = va_arg(args, long long *);
|
|
|
+ else
|
|
|
+ ip = va_arg(args, int *);
|
|
|
+
|
|
|
+ *ip = str - buf;
|
|
|
+ break;
|
|
|
+
|
|
|
+
|
|
|
default:
|
|
|
+ *str++ = '%';
|
|
|
+ if(*fmt)
|
|
|
+ *str++ = *fmt;
|
|
|
+ else --fmt;
|
|
|
break;
|
|
|
}
|
|
|
}
|
|
|
+ *str = '\0';
|
|
|
+
|
|
|
+ return str-buf;
|
|
|
+}
|
|
|
+
|
|
|
+static void write_num(char *str, long long num, int base, int field_width, int precision, int flags)
|
|
|
+{
|
|
|
+
|
|
|
+ * @brief 将数字按照指定的要求转换成对应的字符串
|
|
|
+ *
|
|
|
+ * @param str 要返回的字符串
|
|
|
+ * @param num 要打印的数值
|
|
|
+ * @param base 基数
|
|
|
+ * @param field_width 区域宽度
|
|
|
+ * @param precision 精度
|
|
|
+ * @param flags 标志位
|
|
|
+ */
|
|
|
+
|
|
|
+
|
|
|
+ if (base < 2 || base > 36)
|
|
|
+ return 0;
|
|
|
+
|
|
|
+ char pad, sign, tmp_num[100];
|
|
|
+
|
|
|
+ const char *digits = "0123456789ABCDEFGHIJKLMNOPQRSTUVWXYZ";
|
|
|
+
|
|
|
+ if (flags & SMALL)
|
|
|
+ digits = "0123456789abcdefghijklmnopqrstuvwxyz";
|
|
|
+
|
|
|
+
|
|
|
+ pad = (flags & PAD_ZERO) ? '0' : ' ';
|
|
|
+
|
|
|
+ sign = 0;
|
|
|
+ if (flags & SIGN && num < 0)
|
|
|
+ {
|
|
|
+ sign = '-';
|
|
|
+ num = -num;
|
|
|
+ }
|
|
|
+ else
|
|
|
+ {
|
|
|
+
|
|
|
+ sign = (flags & PLUS) ? '+' : ((flags & SPACE) ? ' ' : 0);
|
|
|
+ }
|
|
|
+
|
|
|
+
|
|
|
+ if (sign)
|
|
|
+ --field_width;
|
|
|
+
|
|
|
+ if (flags & SPECIAL)
|
|
|
+ if (base == 16)
|
|
|
+ field_width -= 2;
|
|
|
+ else if (base == 8)
|
|
|
+ --field_width;
|
|
|
+
|
|
|
+ int js_num = 0;
|
|
|
+
|
|
|
+ if (num == 0)
|
|
|
+ tmp_num[js_num++] = '0';
|
|
|
+ else
|
|
|
+ {
|
|
|
+ num = abs(num);
|
|
|
+
|
|
|
+ while (num)
|
|
|
+ {
|
|
|
+ tmp_num[js_num++] = num % base;
|
|
|
+ num /= base;
|
|
|
+ }
|
|
|
+ }
|
|
|
+
|
|
|
+ if (js_num > precision)
|
|
|
+ precision = js_num;
|
|
|
+
|
|
|
+ field_width -= precision;
|
|
|
+
|
|
|
+
|
|
|
+ if (!(flags & LEFT))
|
|
|
+ while (field_width--)
|
|
|
+ *str++ = pad;
|
|
|
+
|
|
|
+ if (sign)
|
|
|
+ *str++ = sign;
|
|
|
+ if (flags & SPECIAL)
|
|
|
+ if (base == 16)
|
|
|
+ {
|
|
|
+ *str++ = '0';
|
|
|
+ *str++ = digits[33];
|
|
|
+ }
|
|
|
+ else if (base == 8)
|
|
|
+ *str++ = digits[24];
|
|
|
+
|
|
|
+ while (js_num < precision)
|
|
|
+ {
|
|
|
+ --precision;
|
|
|
+ *str++ = '0';
|
|
|
+ }
|
|
|
+
|
|
|
+ while (js_num--)
|
|
|
+ *str++ = tmp_num[js_num];
|
|
|
+
|
|
|
+ while (field_width--)
|
|
|
+ *str++ = ' ';
|
|
|
+
|
|
|
+ return str;
|
|
|
}
|