/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 | 1.80k | { |
17 | 1.80k | size_t i, j; |
18 | 1.80k | uint32_t c; |
19 | 1.80k | uint16_t c2; |
20 | | |
21 | 461k | for (j = i = 0; i < count; i++) { |
22 | 460k | if (enc == UL_ENCODE_UTF16LE) { |
23 | 425k | if (i+2 > count) |
24 | 23 | break; |
25 | 425k | c = (src[i+1] << 8) | src[i]; |
26 | 425k | i++; |
27 | 425k | } else if (enc == UL_ENCODE_UTF16BE) { |
28 | 27.9k | if (i+2 > count) |
29 | 31 | break; |
30 | 27.9k | c = (src[i] << 8) | src[i+1]; |
31 | 27.9k | i++; |
32 | 27.9k | } else if (enc == UL_ENCODE_LATIN1) { |
33 | 6.78k | c = src[i]; |
34 | 6.78k | } else { |
35 | 0 | return 0; |
36 | 0 | } |
37 | 460k | if ((enc == UL_ENCODE_UTF16LE || enc == UL_ENCODE_UTF16BE) && |
38 | 453k | c >= 0xD800 && c <= 0xDBFF && i+2 < count) { |
39 | 13.0k | if (enc == UL_ENCODE_UTF16LE) |
40 | 10.8k | c2 = (src[i+2] << 8) | src[i+1]; |
41 | 2.18k | else |
42 | 2.18k | c2 = (src[i+1] << 8) | src[i+2]; |
43 | 13.0k | if (c2 >= 0xDC00 && c2 <= 0xDFFF) { |
44 | 1.06k | c = 0x10000 + ((c - 0xD800) << 10) + (c2 - 0xDC00); |
45 | 1.06k | i += 2; |
46 | 1.06k | } |
47 | 13.0k | } |
48 | 460k | if (c == 0) { |
49 | 565 | dest[j] = '\0'; |
50 | 565 | break; |
51 | 565 | } |
52 | | |
53 | 459k | if (c < 0x80) { |
54 | 24.0k | if (j+1 >= len) |
55 | 60 | break; |
56 | 23.9k | dest[j++] = (uint8_t) c; |
57 | 435k | } else if (c < 0x800) { |
58 | 9.41k | if (j+2 >= len) |
59 | 9 | break; |
60 | 9.40k | dest[j++] = (uint8_t) (0xc0 | (c >> 6)); |
61 | 9.40k | dest[j++] = (uint8_t) (0x80 | (c & 0x3f)); |
62 | 426k | } else if (c < 0x10000) { |
63 | 425k | if (j+3 >= len) |
64 | 77 | break; |
65 | 424k | dest[j++] = (uint8_t) (0xe0 | (c >> 12)); |
66 | 424k | dest[j++] = (uint8_t) (0x80 | ((c >> 6) & 0x3f)); |
67 | 424k | dest[j++] = (uint8_t) (0x80 | (c & 0x3f)); |
68 | 424k | } else { |
69 | 1.06k | if (j+4 >= len) |
70 | 0 | break; |
71 | 1.06k | dest[j++] = (uint8_t) (0xf0 | (c >> 18)); |
72 | 1.06k | dest[j++] = (uint8_t) (0x80 | ((c >> 12) & 0x3f)); |
73 | 1.06k | dest[j++] = (uint8_t) (0x80 | ((c >> 6) & 0x3f)); |
74 | 1.06k | dest[j++] = (uint8_t) (0x80 | (c & 0x3f)); |
75 | 1.06k | } |
76 | 459k | } |
77 | 1.80k | dest[j] = '\0'; |
78 | 1.80k | return j; |
79 | 1.80k | } |