/*
 * Copyright (c) 2019-2023 Beijing Hanwei Innovation Technology Ltd. Co. and
 * its subsidiaries and affiliates (collectly called MKSEMI).
 *
 * All rights reserved.
 *
 * Redistribution and use in source and binary forms, with or without
 * modification, are permitted provided that the following conditions are met:
 *
 * 1. Redistributions of source code must retain the above copyright notice,
 *    this list of conditions and the following disclaimer.
 *
 * 2. Redistributions in binary form, except as embedded into an MKSEMI
 *    integrated circuit in a product or a software update for such product,
 *    must reproduce the above copyright notice, this list of conditions and
 *    the following disclaimer in the documentation and/or other materials
 *    provided with the distribution.
 *
 * 3. Neither the name of MKSEMI nor the names of its contributors may be used
 *    to endorse or promote products derived from this software without
 *    specific prior written permission.
 *
 * 4. This software, with or without modification, must only be used with a
 *    MKSEMI integrated circuit.
 *
 * 5. Any software provided in binary form under this license must not be
 *    reverse engineered, decompiled, modified and/or disassembled.
 *
 * THIS SOFTWARE IS PROVIDED BY MKSEMI "AS IS" AND ANY EXPRESS OR IMPLIED
 * WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES OF
 * MERCHANTABILITY, NONINFRINGEMENT, AND FITNESS FOR A PARTICULAR PURPOSE ARE
 * DISCLAIMED. IN NO EVENT SHALL MKSEMI OR CONTRIBUTORS BE LIABLE FOR ANY
 * DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES
 * (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES;
 * LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND
 * ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
 * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF
 * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
 */

#include "mk_io.h"

void io_pin_mux_set(enum IO_PIN_T pin, enum IO_FUNC_T func)
{
    if (pin < IO_PIN_8)
    {
        SYSCON->PIN_MUX_0 = SET_BIT_FIELD(SYSCON->PIN_MUX_0, (SYSCON_PIN_MUX_FUNC_MSK << (pin << 2)), (pin << 2), func);
    }
    else if (pin < IO_PIN_16)
    {
        SYSCON->PIN_MUX_1 = SET_BIT_FIELD(SYSCON->PIN_MUX_1, (SYSCON_PIN_MUX_FUNC_MSK << ((pin - IO_PIN_8) << 2)), ((pin - IO_PIN_8) << 2), func);
    }
    else
    {
        SYSCON->PIN_MUX_2 = SET_BIT_FIELD(SYSCON->PIN_MUX_2, (SYSCON_PIN_MUX_FUNC_MSK << ((pin - IO_PIN_16) << 2)), ((pin - IO_PIN_16) << 2), func);
    }
}

void io_open_drain_set(enum IO_PIN_T pin, bool en)
{
    if (en)
    {
        SYSCON->IO_OD |= (1U << pin);
    }
    else
    {
        SYSCON->IO_OD &= ~(1U << pin);
    }
}

void io_drive_set(enum IO_PIN_T pin, enum IO_DRV_T strength)
{
    if (strength == IO_DRV_HIGH)
    {
        SYSCON->IO_DRV |= (1U << pin);
    }
    else
    {
        SYSCON->IO_DRV &= ~(1U << pin);
    }
}

void io_pull_set(enum IO_PIN_T pin, enum IO_PULL_MODE_T pull_mode, enum IO_PULL_UP_LEVEL_T pull_up_level)
{
    uint32_t val = SYSCON->IO_PUP[pin / 8] & (~(0x7U << ((pin % 8) * 4)));

    if (pull_mode == IO_PULL_UP)
    {
        SYSCON->IO_PDN &= ~(1U << pin);
        val |= ((uint32_t)pull_up_level << ((pin % 8) * 4));
        SYSCON->IO_PUP[pin / 8] = val;
    }
    else if (pull_mode == IO_PULL_DOWN)
    {
        SYSCON->IO_PUP[pin / 8] = val;
        SYSCON->IO_PDN |= (1U << pin);
    }
    else
    {
        SYSCON->IO_PUP[pin / 8] = val;
        SYSCON->IO_PDN &= ~(1U << pin);
    }
}