/**
 * Copyright (c) 2011-2022 Bill Greiman
 * This file is part of the SdFat library for SD memory cards.
 *
 * MIT License
 *
 * Permission is hereby granted, free of charge, to any person obtaining a
 * copy of this software and associated documentation files (the "Software"),
 * to deal in the Software without restriction, including without limitation
 * the rights to use, copy, modify, merge, publish, distribute, sublicense,
 * and/or sell copies of the Software, and to permit persons to whom the
 * Software is furnished to do so, subject to the following conditions:
 *
 * The above copyright notice and this permission notice shall be included
 * in all copies or substantial portions of the Software.
 *
 * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS
 * OR IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
 * FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL THE
 * AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER
 * LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING
 * FROM, OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER
 * DEALINGS IN THE SOFTWARE.
 */
#include "FsUtf.h"
namespace FsUtf
{
//----------------------------------------------------------------------------
char *cpToMb(uint32_t cp, char *str, const char *end)
{
    size_t n = end - str;
    if (cp < 0X80)
    {
        if (n < 1)
            goto fail;
        *(str++) = static_cast<uint8_t>(cp);
    }
    else if (cp < 0X800)
    {
        if (n < 2)
            goto fail;
        *(str++) = static_cast<uint8_t>((cp >> 6) | 0XC0);
        *(str++) = static_cast<uint8_t>((cp & 0X3F) | 0X80);
    }
    else if (cp < 0X10000)
    {
        if (n < 3)
            goto fail;
        *(str++) = static_cast<uint8_t>((cp >> 12) | 0XE0);
        *(str++) = static_cast<uint8_t>(((cp >> 6) & 0X3F) | 0X80);
        *(str++) = static_cast<uint8_t>((cp & 0X3F) | 0X80);
    }
    else
    {
        if (n < 4)
            goto fail;
        *(str++) = static_cast<uint8_t>((cp >> 18) | 0XF0);
        *(str++) = static_cast<uint8_t>(((cp >> 12) & 0X3F) | 0X80);
        *(str++) = static_cast<uint8_t>(((cp >> 6) & 0X3F) | 0X80);
        *(str++) = static_cast<uint8_t>((cp & 0X3F) | 0X80);
    }
    return str;

fail:
    return nullptr;
}
//----------------------------------------------------------------------------
// to do?  improve error check
const char *mbToCp(const char *str, const char *end, uint32_t *rtn)
{
    size_t n;
    uint32_t cp;
    if (str >= end)
    {
        return nullptr;
    }
    uint8_t ch = str[0];
    if ((ch & 0X80) == 0)
    {
        *rtn = ch;
        return str + 1;
    }
    if ((ch & 0XE0) == 0XC0)
    {
        cp = ch & 0X1F;
        n = 2;
    }
    else if ((ch & 0XF0) == 0XE0)
    {
        cp = ch & 0X0F;
        n = 3;
    }
    else if ((ch & 0XF8) == 0XF0)
    {
        cp = ch & 0X07;
        n = 4;
    }
    else
    {
        return nullptr;
    }
    if ((str + n) > end)
    {
        return nullptr;
    }
    for (size_t i = 1; i < n; i++)
    {
        ch = str[i];
        if ((ch & 0XC0) != 0X80)
        {
            return nullptr;
        }
        cp <<= 6;
        cp |= ch & 0X3F;
    }
    // Don't allow over long as ASCII.
    if (cp < 0X80 || !isValidCp(cp))
    {
        return nullptr;
    }
    *rtn = cp;
    return str + n;
}
//----------------------------------------------------------------------------
const char *mbToU16(const char *str, const char *end, uint16_t *hs, uint16_t *ls)
{
    uint32_t cp;
    const char *ptr = mbToCp(str, end, &cp);
    if (!ptr)
    {
        return nullptr;
    }
    if (cp <= 0XFFFF)
    {
        *hs = cp;
        *ls = 0;
    }
    else
    {
        *hs = highSurrogate(cp);
        *ls = lowSurrogate(cp);
    }
    return ptr;
}
} // namespace FsUtf
