/* mbed Microcontroller Library
 * (C)Copyright TOSHIBA ELECTRONIC DEVICES & STORAGE CORPORATION 2018 All rights reserved
 * SPDX-License-Identifier: Apache-2.0
 * Licensed under the Apache License, Version 2.0 (the "License");
 * you may not use this file except in compliance with the License.
 * You may obtain a copy of the License at
 *
 *     http://www.apache.org/licenses/LICENSE-2.0
 *
 * Unless required by applicable law or agreed to in writing, software
 * distributed under the License is distributed on an "AS IS" BASIS,
 * WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied.
 * See the License for the specific language governing permissions and
 * limitations under the License.
 */
#include "port_api.h"
#include "mbed_assert.h"
#include "mbed_error.h"
#include "txz_gpio.h"
#include "pinmap.h"

#define PORT_PIN_NUM                 (8)
#define ALT_FUNC_GPIO                (0U)

extern _gpio_t gpio_port_add;
static void gpio_pin_dir(port_t *obj, PinDirection dir, uint32_t pin_num);

PinName port_pin(PortName port, int pin_n)
{
    PinName pin = NC;
    pin = (PinName)((port << 3) | pin_n);
    return pin;
}

void port_init(port_t *obj, PortName port, int mask, PinDirection dir)
{
    uint8_t i = 0;

    // Assert that port is valid
    MBED_ASSERT(port <= PortY);

    // Store port and port mask for future use
    obj->port = port;
    obj->mask = mask;
    //Enable the clock for particular port
    _gpio_init(&gpio_port_add, obj->port);
    // Set port function and port direction
    for (i = 0; i < PORT_PIN_NUM; i++) {
        // If the pin is used
        if (obj->mask & (1 << i)) {
            pin_function(port_pin(obj->port, i), dir);
        }
    }
}

void port_mode(port_t *obj, PinMode mode)
{
    uint8_t i = 0;

    // Assert that port is valid
    MBED_ASSERT(obj->port <= PortY);

    // Set mode for masked pins
    for (i = 0; i < PORT_PIN_NUM; i++) {
        // If the pin is used
        if (obj->mask & (1 << i)) {
            pin_mode(port_pin(obj->port, i), mode);
        }
    }
}

void port_dir(port_t *obj, PinDirection dir)
{
    uint8_t i = 0;
    // Assert that port is valid
    MBED_ASSERT(obj->port <= PortY);

    for (i = 0; i < PORT_PIN_NUM; i++) {
        // Set direction for masked pins
        if (obj->mask & (1 << i)) {
            gpio_pin_dir(obj, dir, i);
        }
    }
}

void port_write(port_t *obj, int value)
{
    uint32_t port_data = 0;
    uint32_t data = 0;

    // Assert that port is valid
    MBED_ASSERT(obj->port <= PortY);

    // Get current data of port
    gpio_read_mode(&gpio_port_add, obj->port, GPIO_Mode_DATA, &port_data);

    // Calculate data to write to masked pins
    data = (port_data & ~obj->mask) | (value & obj->mask);

    // Write data to masked pins of the port
    gpio_write_mode(&gpio_port_add, obj->port, GPIO_Mode_DATA, data);
}

int port_read(port_t *obj)
{
    uint32_t port_data = 0;
    uint32_t data = 0;

    // Assert that port is valid
    MBED_ASSERT(obj->port <= PortY);

    // Get current data of port
    gpio_read_mode(&gpio_port_add, obj->port, GPIO_Mode_DATA, &port_data);

    // Calculate data of masked pins
    data = port_data & obj->mask;

    return data;
}

static void gpio_pin_dir(port_t *obj, PinDirection dir, uint32_t pin_num)
{
    switch (dir) {
        case PIN_INPUT:
            // Set pin input
            gpio_func(&gpio_port_add, (gpio_gr_t)obj->port, (gpio_num_t)pin_num, (uint32_t)ALT_FUNC_GPIO, GPIO_PIN_INPUT);
            break;
        case PIN_OUTPUT:
            // Set pin output
            gpio_func(&gpio_port_add, (gpio_gr_t)obj->port, (gpio_num_t)pin_num, (uint32_t)ALT_FUNC_GPIO, GPIO_PIN_OUTPUT);
            break;
        case PIN_INOUT:
            // Set pin both input and output
            gpio_func(&gpio_port_add, (gpio_gr_t)obj->port, (gpio_num_t)pin_num, (uint32_t)ALT_FUNC_GPIO, GPIO_PIN_INOUT);
            break;
        default:
            //error("Invalid direction\n");
            break;
    }
}