1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
|
template <endianness big_endian>
std::pair<const char16_t *, char *>
lasx_convert_utf16_to_latin1(const char16_t *buf, size_t len,
char *latin1_output) {
const char16_t *end = buf + len;
while (buf + 16 <= end) {
__m128i in = __lsx_vld(reinterpret_cast<const uint16_t *>(buf), 0);
__m128i in1 = __lsx_vld(reinterpret_cast<const uint16_t *>(buf), 16);
if (!match_system(big_endian)) {
in = lsx_swap_bytes(in);
in1 = lsx_swap_bytes(in1);
}
if (__lsx_bz_v(__lsx_vpickod_b(in1, in))) {
// 1. pack the bytes
__m128i latin1_packed = __lsx_vpickev_b(in1, in);
// 2. store (8 bytes)
__lsx_vst(latin1_packed, reinterpret_cast<uint8_t *>(latin1_output), 0);
// 3. adjust pointers
buf += 16;
latin1_output += 16;
} else {
return std::make_pair(nullptr, reinterpret_cast<char *>(latin1_output));
}
} // while
return std::make_pair(buf, latin1_output);
}
template <endianness big_endian>
std::pair<result, char *>
lasx_convert_utf16_to_latin1_with_errors(const char16_t *buf, size_t len,
char *latin1_output) {
const char16_t *start = buf;
const char16_t *end = buf + len;
while (buf + 16 <= end) {
__m128i in = __lsx_vld(reinterpret_cast<const uint16_t *>(buf), 0);
__m128i in1 = __lsx_vld(reinterpret_cast<const uint16_t *>(buf), 16);
if (!match_system(big_endian)) {
in = lsx_swap_bytes(in);
in1 = lsx_swap_bytes(in1);
}
if (__lsx_bz_v(__lsx_vpickod_b(in1, in))) {
// 1. pack the bytes
__m128i latin1_packed = __lsx_vpickev_b(in1, in);
// 2. store (8 bytes)
__lsx_vst(latin1_packed, reinterpret_cast<uint8_t *>(latin1_output), 0);
// 3. adjust pointers
buf += 16;
latin1_output += 16;
} else {
// Let us do a scalar fallback.
for (int k = 0; k < 16; k++) {
uint16_t word = !match_system(big_endian)
? scalar::utf16::swap_bytes(buf[k])
: buf[k];
if (word <= 0xff) {
*latin1_output++ = char(word);
} else {
return std::make_pair(result(error_code::TOO_LARGE, buf - start + k),
latin1_output);
}
}
}
} // while
return std::make_pair(result(error_code::SUCCESS, buf - start),
latin1_output);
}
|
