/src/util-linux/lib/encode.c
Line | Count | Source |
1 | | /* |
2 | | * Based on code from libblkid, |
3 | | * |
4 | | * Copyright (C) 2008 Kay Sievers <kay.sievers@vrfy.org> |
5 | | * Copyright (C) 2009 Karel Zak <kzak@redhat.com> |
6 | | * Copyright (C) 2020 Pali Rohár <pali.rohar@gmail.com> |
7 | | * |
8 | | * This file may be redistributed under the terms of the |
9 | | * GNU Lesser General Public License. |
10 | | */ |
11 | | #include "c.h" |
12 | | #include "encode.h" |
13 | | |
14 | | size_t ul_encode_to_utf8(int enc, unsigned char *dest, size_t len, |
15 | | const unsigned char *src, size_t count) |
16 | 35 | { |
17 | 35 | size_t i, j; |
18 | 35 | uint32_t c; |
19 | 35 | uint16_t c2; |
20 | | |
21 | 190 | for (j = i = 0; i < count; i++) { |
22 | 184 | if (enc == UL_ENCODE_UTF16LE) { |
23 | 0 | if (i+2 > count) |
24 | 0 | break; |
25 | 0 | c = (src[i+1] << 8) | src[i]; |
26 | 0 | i++; |
27 | 184 | } else if (enc == UL_ENCODE_UTF16BE) { |
28 | 184 | if (i+2 > count) |
29 | 0 | break; |
30 | 184 | c = (src[i] << 8) | src[i+1]; |
31 | 184 | i++; |
32 | 184 | } else if (enc == UL_ENCODE_LATIN1) { |
33 | 0 | c = src[i]; |
34 | 0 | } else { |
35 | 0 | return 0; |
36 | 0 | } |
37 | 184 | if ((enc == UL_ENCODE_UTF16LE || enc == UL_ENCODE_UTF16BE) && |
38 | 184 | c >= 0xD800 && c <= 0xDBFF && i+2 < count) { |
39 | 0 | if (enc == UL_ENCODE_UTF16LE) |
40 | 0 | c2 = (src[i+2] << 8) | src[i+1]; |
41 | 0 | else |
42 | 0 | c2 = (src[i+1] << 8) | src[i+2]; |
43 | 0 | if (c2 >= 0xDC00 && c2 <= 0xDFFF) { |
44 | 0 | c = 0x10000 + ((c - 0xD800) << 10) + (c2 - 0xDC00); |
45 | 0 | i += 2; |
46 | 0 | } |
47 | 0 | } |
48 | 184 | if (c == 0) { |
49 | 11 | dest[j] = '\0'; |
50 | 11 | break; |
51 | 11 | } |
52 | | |
53 | 173 | if (c < 0x80) { |
54 | 21 | if (j+1 >= len) |
55 | 3 | break; |
56 | 18 | dest[j++] = (uint8_t) c; |
57 | 152 | } else if (c < 0x800) { |
58 | 43 | if (j+2 >= len) |
59 | 3 | break; |
60 | 40 | dest[j++] = (uint8_t) (0xc0 | (c >> 6)); |
61 | 40 | dest[j++] = (uint8_t) (0x80 | (c & 0x3f)); |
62 | 109 | } else if (c < 0x10000) { |
63 | 109 | if (j+3 >= len) |
64 | 12 | break; |
65 | 97 | dest[j++] = (uint8_t) (0xe0 | (c >> 12)); |
66 | 97 | dest[j++] = (uint8_t) (0x80 | ((c >> 6) & 0x3f)); |
67 | 97 | dest[j++] = (uint8_t) (0x80 | (c & 0x3f)); |
68 | 97 | } else { |
69 | 0 | if (j+4 >= len) |
70 | 0 | break; |
71 | 0 | dest[j++] = (uint8_t) (0xf0 | (c >> 18)); |
72 | 0 | dest[j++] = (uint8_t) (0x80 | ((c >> 12) & 0x3f)); |
73 | 0 | dest[j++] = (uint8_t) (0x80 | ((c >> 6) & 0x3f)); |
74 | 0 | dest[j++] = (uint8_t) (0x80 | (c & 0x3f)); |
75 | 0 | } |
76 | 173 | } |
77 | 35 | dest[j] = '\0'; |
78 | 35 | return j; |
79 | 35 | } |