mirror of
https://github.com/grub4dos/ntloader.git
synced 2025-05-11 04:51:33 +08:00
97 lines
2.3 KiB
C
97 lines
2.3 KiB
C
/*
|
|
* ntloader -- Microsoft Windows NT6+ loader
|
|
* Copyright (C) 2023 A1ive.
|
|
*
|
|
* This program is free software; you can redistribute it and/or
|
|
* modify it under the terms of the GNU General Public License as
|
|
* published by the Free Software Foundation; either version 2 of the
|
|
* License, or (at your option) any later version.
|
|
*
|
|
* This program is distributed in the hope that it will be useful, but
|
|
* WITHOUT ANY WARRANTY; without even the implied warranty of
|
|
* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU
|
|
* General Public License for more details.
|
|
*
|
|
* You should have received a copy of the GNU General Public License
|
|
* along with this program; if not, write to the Free Software
|
|
* Foundation, Inc., 51 Franklin Street, Fifth Floor, Boston, MA
|
|
* 02110-1301, USA.
|
|
*/
|
|
|
|
#include <charset.h>
|
|
|
|
static inline int
|
|
is_utf8_trailing_octet (uint8_t c)
|
|
{
|
|
/* 10 00 00 00 - 10 11 11 11 */
|
|
return (c >= 0x80 && c <= 0xBF);
|
|
}
|
|
|
|
/* Convert UTF-8 to UCS-2. */
|
|
uint16_t *
|
|
utf8_to_ucs2 (uint16_t *dest, size_t destsize,
|
|
const uint8_t *src)
|
|
{
|
|
size_t i;
|
|
for (i = 0; src[0] && i < destsize; i++)
|
|
{
|
|
if (src[0] <= 0x7F)
|
|
{
|
|
*dest++ = 0x007F & src[0];
|
|
src += 1;
|
|
}
|
|
else if (src[0] <= 0xDF
|
|
&& is_utf8_trailing_octet (src[1]))
|
|
{
|
|
*dest++ = ((0x001F & src[0]) << 6)
|
|
| (0x003F & src[1]);
|
|
src += 2;
|
|
}
|
|
else if (src[0] <= 0xEF
|
|
&& is_utf8_trailing_octet (src[1])
|
|
&& is_utf8_trailing_octet (src[2]))
|
|
{
|
|
*dest++ = ((0x000F & src[0]) << 12)
|
|
| ((0x003F & src[1]) << 6)
|
|
| (0x003F & src[2]);
|
|
src += 3;
|
|
}
|
|
else
|
|
{
|
|
*dest++ = 0;
|
|
break;
|
|
}
|
|
}
|
|
return dest;
|
|
}
|
|
|
|
/* Convert UCS-2 to UTF-8. */
|
|
uint8_t *
|
|
ucs2_to_utf8 (uint8_t *dest, const uint16_t *src,
|
|
size_t size)
|
|
{
|
|
size_t i;
|
|
for (i = 0; i < size; i++)
|
|
{
|
|
if (src[i] <= 0x007F)
|
|
*dest++ = src[i];
|
|
else if (src[i] <= 0x07FF)
|
|
{
|
|
*dest++ = (src[i] >> 6) | 0xC0;
|
|
*dest++ = (src[i] & 0x3F) | 0x80;
|
|
}
|
|
else if (src[i] >= 0xD800 && src[i] <= 0xDFFF)
|
|
{
|
|
*dest++ = 0;
|
|
break;
|
|
}
|
|
else
|
|
{
|
|
*dest++ = (src[i] >> 12) | 0xE0;
|
|
*dest++ = ((src[i] >> 6) & 0x3F) | 0x80;
|
|
*dest++ = (src[i] & 0x3F) | 0x80;
|
|
}
|
|
}
|
|
return dest;
|
|
}
|