This is convenient for efi_loader which deals a lot with utf16.

Signed-off-by: Rob Clark <robdcl...@gmail.com>
---
 lib/vsprintf.c | 39 +++++++++++++++++++++++++++++++++++++--
 1 file changed, 37 insertions(+), 2 deletions(-)

diff --git a/lib/vsprintf.c b/lib/vsprintf.c
index 874a2951f7..84e157ecb1 100644
--- a/lib/vsprintf.c
+++ b/lib/vsprintf.c
@@ -270,6 +270,35 @@ static char *string(char *buf, char *end, char *s, int 
field_width,
        return buf;
 }
 
+static size_t strnlen16(const u16* s, size_t count)
+{
+       const u16 *sc;
+
+       for (sc = s; count-- && *sc; ++sc)
+               /* nothing */;
+       return sc - s;
+}
+
+static char *string16(char *buf, char *end, u16 *s, int field_width,
+               int precision, int flags)
+{
+       int len, i;
+
+       if (s == NULL)
+               s = L"<NULL>";
+
+       len = strnlen16(s, precision);
+
+       if (!(flags & LEFT))
+               while (len < field_width--)
+                       ADDCH(buf, ' ');
+       for (i = 0; i < len; ++i)
+               ADDCH(buf, *s++);
+       while (len < field_width--)
+               ADDCH(buf, ' ');
+       return buf;
+}
+
 #ifdef CONFIG_CMD_NET
 static const char hex_asc[] = "0123456789abcdef";
 #define hex_asc_lo(x)  hex_asc[((x) & 0x0f)]
@@ -528,8 +557,14 @@ repeat:
                        continue;
 
                case 's':
-                       str = string(str, end, va_arg(args, char *),
-                                    field_width, precision, flags);
+                       if (qualifier == 'l') {
+                               str = string16(str, end, va_arg(args, u16 *),
+                                              field_width, precision, flags);
+
+                       } else {
+                               str = string(str, end, va_arg(args, char *),
+                                            field_width, precision, flags);
+                       }
                        continue;
 
                case 'p':
-- 
2.13.0

_______________________________________________
U-Boot mailing list
U-Boot@lists.denx.de
https://lists.denx.de/listinfo/u-boot

Reply via email to