/* mbed Microcontroller Library
 * (C)Copyright TOSHIBA ELECTRONIC DEVICES & STORAGE CORPORATION 2017 All rights reserved
 *
 * 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 "gpio_irq_api.h"
#include "mbed_error.h"
#include "PeripheralNames.h"
#include "pinmap.h"
#include "gpio_include.h"
#include "mbed_critical.h"

#define CHANNEL_NUM            32

const PinMap PinMap_GPIO_IRQ[] = {
    {PC0, GPIO_IRQ_00, PIN_DATA(0, 0)},
    {PC1, GPIO_IRQ_01, PIN_DATA(0, 0)},
    {PC2, GPIO_IRQ_02, PIN_DATA(0, 0)},
    {PB1, GPIO_IRQ_03, PIN_DATA(0, 0)},
    {PJ4, GPIO_IRQ_04, PIN_DATA(0, 0)},
    {PK1, GPIO_IRQ_05, PIN_DATA(0, 0)},
    {PH3, GPIO_IRQ_06, PIN_DATA(0, 0)},
    {PA6, GPIO_IRQ_07, PIN_DATA(0, 0)},
    {PL3, GPIO_IRQ_08, PIN_DATA(0, 0)},
    {PM2, GPIO_IRQ_09, PIN_DATA(0, 0)},
    {PN3, GPIO_IRQ_10, PIN_DATA(0, 0)},
    {PA7, GPIO_IRQ_11, PIN_DATA(0, 0)},
    {PL4, GPIO_IRQ_12, PIN_DATA(0, 0)},
    {PK7, GPIO_IRQ_13, PIN_DATA(0, 0)},
    {PP3, GPIO_IRQ_14, PIN_DATA(0, 0)},
    {PM6, GPIO_IRQ_15, PIN_DATA(0, 0)},
    {PB7, GPIO_IRQ_16, PIN_DATA(0, 0)},
    {PV2, GPIO_IRQ_17_18, PIN_DATA(0, 0)},
    {PH4, GPIO_IRQ_19_22, PIN_DATA(0, 0)},
    {PT0, GPIO_IRQ_23_26, PIN_DATA(0, 0)},
    {PT1, GPIO_IRQ_23_26, PIN_DATA(0, 0)},
    {PG2, GPIO_IRQ_27_28, PIN_DATA(0, 0)},
    {PT7, GPIO_IRQ_29, PIN_DATA(0, 0)},
    {PU0, GPIO_IRQ_30_31, PIN_DATA(0, 0)},
    {NC,  NC, 0}
};

static uint32_t channel_ids[CHANNEL_NUM] = {0};
static gpio_irq_handler hal_irq_handler[CHANNEL_NUM] = {NULL};
static void SetSTBYReleaseINTSrc(cg_intsrc, cg_intactivestate, FunctionalState );
cg_intactivestate CurrentState;
static void INT_IRQHandler(PinName pin, uint32_t index);
static uint32_t CheckPinNameIRQSRC(PinName pin);

// Initialize gpio IRQ pin
int gpio_irq_init(gpio_irq_t *obj, PinName pin, gpio_irq_handler handler, uint32_t id)
{
    uint8_t bit  = 0;
    uint32_t port_base = 0;

    // Get gpio interrupt ID
    obj->irq_id = pinmap_peripheral(pin, PinMap_GPIO_IRQ);

    // Disable interrupt by CPU
    core_util_critical_section_enter();

    // Calculate port and pin position
    obj->port = (PortName)PIN_PORT(pin);
    obj->pin = pin;
    bit  = PIN_POS(pin);

    port_base = BITBAND_PORT_BASE(obj->port);
    port_base = BITBAND_PORT_MODE_BASE(port_base, GPIO_Mode_DATA);
    BITBAND_PORT_CLR(port_base, bit);
    // Enable gpio interrupt function
    pinmap_pinout(pin, PinMap_GPIO_IRQ);

    // Get GPIO irq source
    switch (obj->irq_id) {
        case GPIO_IRQ_00:
            obj->irq_src = CG_INT_SRC_01;
            break;
        case GPIO_IRQ_01:
            obj->irq_src = CG_INT_SRC_02;
            break;
        case GPIO_IRQ_02:
            obj->irq_src = CG_INT_SRC_03;
            break;
        case GPIO_IRQ_03:
            obj->irq_src = CG_INT_SRC_04;
            break;
        case GPIO_IRQ_04:
            obj->irq_src = CG_INT_SRC_05;
            break;
        case GPIO_IRQ_05:
            obj->irq_src = CG_INT_SRC_06;
            break;
        case GPIO_IRQ_06:
            obj->irq_src = CG_INT_SRC_07;
            break;
        case GPIO_IRQ_07:
            obj->irq_src = CG_INT_SRC_08;
            break;
        case GPIO_IRQ_08:
            obj->irq_src = CG_INT_SRC_09;
            break;
        case GPIO_IRQ_09:
            obj->irq_src = CG_INT_SRC_0A;
            break;
        case GPIO_IRQ_10:
            obj->irq_src = CG_INT_SRC_0B;
            break;
        case GPIO_IRQ_11:
            obj->irq_src = CG_INT_SRC_0C;
            break;
        case GPIO_IRQ_12:
            obj->irq_src = CG_INT_SRC_0D;
            break;
        case GPIO_IRQ_13:
            obj->irq_src = CG_INT_SRC_0E;
            break;
        case GPIO_IRQ_14:
            obj->irq_src = CG_INT_SRC_0F;
            break;
        case GPIO_IRQ_15:
            obj->irq_src = CG_INT_SRC_10;
            break;
        case GPIO_IRQ_16:
            obj->irq_src = CG_INT_SRC_11;
            break;
        case GPIO_IRQ_17_18:
            obj->irq_src = CG_INT_SRC_12;
            break;
        case GPIO_IRQ_19_22:
            obj->irq_src = CG_INT_SRC_14;
            break;
        case GPIO_IRQ_23_26:
            obj->irq_src = CheckPinNameIRQSRC(pin);
            break;
        case GPIO_IRQ_27_28:
            obj->irq_src = CG_INT_SRC_1C;
            break;
        case GPIO_IRQ_29:
            obj->irq_src = CG_INT_SRC_1E;
            break;
        case GPIO_IRQ_30_31:
            obj->irq_src = CG_INT_SRC_1F;
            break;
        default:
            break;
    }

    // Save irq handler
    hal_irq_handler[obj->irq_src] = handler;

    // Save irq id
    channel_ids[obj->irq_src] = id;

    // Initialize interrupt event as both edges detection
    obj->event = CG_INT_ACTIVE_STATE_BOTH_EDGES;
    CurrentState = CG_INT_ACTIVE_STATE_BOTH_EDGES;
    // Set interrupt event and enable INTx clear
    SetSTBYReleaseINTSrc(obj->irq_src, (cg_intactivestate)obj->event, ENABLE);

    // Clear gpio pending interrupt
    NVIC_ClearPendingIRQ((IRQn_Type) obj->irq_id);

    core_util_critical_section_exit();

    return 0;
}

void gpio_irq_free(gpio_irq_t *obj)
{
    // Clear gpio_irq
    NVIC_ClearPendingIRQ((IRQn_Type)obj->irq_id);
    // Reset interrupt handler
    hal_irq_handler[obj->irq_src] = NULL;
    // Reset interrupt id
    channel_ids[obj->irq_src] = 0;
}

// Set interrupt event of gpio_irq object
void gpio_irq_set(gpio_irq_t *obj, gpio_irq_event event, uint32_t enable)
{
    uint8_t bit  = 0;
    uint32_t port_base = 0;

    //Disable GPIO interrupt on obj
    gpio_irq_disable(obj);
    if (enable) {
        // Get gpio interrupt event
        if (event == IRQ_RISE) {
            if ((obj->event == CG_INT_ACTIVE_STATE_FALLING) || (obj->event == CG_INT_ACTIVE_STATE_BOTH_EDGES)) {
                obj->event = CG_INT_ACTIVE_STATE_BOTH_EDGES;
            } else {
                obj->event = CG_INT_ACTIVE_STATE_RISING;
            }
        } else if (event == IRQ_FALL) {
            if ((obj->event == CG_INT_ACTIVE_STATE_RISING) || (obj->event == CG_INT_ACTIVE_STATE_BOTH_EDGES)) {
                obj->event = CG_INT_ACTIVE_STATE_BOTH_EDGES;
            } else {
                obj->event = CG_INT_ACTIVE_STATE_FALLING;
            }
        } else {
            error("Not supported event\n");
        }
    } else {
        // Get gpio interrupt event
        if (event == IRQ_RISE) {
            if ((obj->event == CG_INT_ACTIVE_STATE_RISING) || (obj->event == CG_INT_ACTIVE_STATE_INVALID)) {
                obj->event = CG_INT_ACTIVE_STATE_INVALID;
            } else {
                obj->event = CG_INT_ACTIVE_STATE_FALLING;
            }
        } else if (event == IRQ_FALL) {
            if ((obj->event == CG_INT_ACTIVE_STATE_FALLING) || (obj->event == CG_INT_ACTIVE_STATE_INVALID)) {
                obj->event = CG_INT_ACTIVE_STATE_INVALID;
            } else {
                obj->event = CG_INT_ACTIVE_STATE_RISING;
            }
        } else {
            error("Not supported event\n");
        }
    }
    CurrentState = obj->event;
    // Calculate port and pin position
    bit  = PIN_POS(obj->pin);

    port_base = BITBAND_PORT_BASE(obj->port);
    port_base = BITBAND_PORT_MODE_BASE(port_base, GPIO_Mode_DATA);

    if(obj->event != CG_INT_ACTIVE_STATE_INVALID ) {
        // Set interrupt event and enable INTx clear
        SetSTBYReleaseINTSrc(obj->irq_src, (cg_intactivestate) obj->event, ENABLE);
        BITBAND_PORT_CLR(port_base, bit);
    } else {
        BITBAND_PORT_SET(port_base, bit);
    }
    //Enable GPIO interrupt on obj
    gpio_irq_enable(obj);
}

// Enable gpio_irq object
void gpio_irq_enable(gpio_irq_t *obj)
{
    // Clear and Enable gpio_irq object
    NVIC_ClearPendingIRQ((IRQn_Type)obj->irq_id);
    NVIC_EnableIRQ((IRQn_Type)obj->irq_id);
}

// Disable gpio_irq object
void gpio_irq_disable(gpio_irq_t *obj)
{
    // Disable gpio_irq object
    NVIC_DisableIRQ((IRQn_Type)obj->irq_id);
}

static void INT_IRQHandler(PinName pin, uint32_t index)
{
    int port     = 0;
    uint8_t bit  = 0;
    uint32_t data = 0;
    uint32_t port_base = 0;

    // Calculate port and pin position
    port = PIN_PORT(pin);
    bit  = PIN_POS(pin);

    // Clear interrupt request
    SetSTBYReleaseINTSrc((cg_intsrc)(CG_INT_SRC_01 + index), CurrentState, DISABLE);

    port_base = BITBAND_PORT_BASE(port);
    port_base = BITBAND_PORT_MODE_BASE(port_base, GPIO_Mode_DATA);
    BITBAND_PORT_READ(data, port_base, bit);

    switch (data) {
        // Falling edge detection
        case 0:
            hal_irq_handler[index](channel_ids[index], IRQ_FALL);
            break;
        // Rising edge detection
        case 1:
            hal_irq_handler[index](channel_ids[index], IRQ_RISE);
            break;
        default:
            break;
    }
    // Clear gpio pending interrupt
    NVIC_ClearPendingIRQ((IRQn_Type)(CG_INT_SRC_01 + index));

    // Enable interrupt request
    SetSTBYReleaseINTSrc((cg_intsrc)(CG_INT_SRC_01 + index), CurrentState, ENABLE);
}

void INT00_IRQHandler(void)
{
    INT_IRQHandler(PC0, 0);
}

void INT01_IRQHandler(void)
{
    INT_IRQHandler(PC1, 1);
}

void INT02_IRQHandler(void)
{
    INT_IRQHandler(PC2, 2);
}

void INT03_IRQHandler(void)
{
    INT_IRQHandler(PB1, 3);
}

void INT04_IRQHandler(void)
{
    INT_IRQHandler(PJ4, 4);
}

void INT05_IRQHandler(void)
{
    INT_IRQHandler(PK1, 5);
}

void INT06_IRQHandler(void)
{
    INT_IRQHandler(PH3, 6);
}

void INT07_IRQHandler(void)
{
    INT_IRQHandler(PA6, 7);
}

void INT08_IRQHandler(void)
{
    INT_IRQHandler(PL3, 8);
}

void INT09_IRQHandler(void)
{
    INT_IRQHandler(PM2, 9);
}

void INT10_IRQHandler(void)
{
    INT_IRQHandler(PN3, 10);
}

void INT11_IRQHandler(void)
{
    INT_IRQHandler(PA7, 11);
}

void INT12_IRQHandler(void)
{
    INT_IRQHandler(PL4, 12);
}

void INT13_IRQHandler(void)
{
    INT_IRQHandler(PK7, 13);
}

void INT14_IRQHandler(void)
{
    INT_IRQHandler(PP3, 14);
}

void INT15_IRQHandler(void)
{
    INT_IRQHandler(PM6, 15);
}

void INT16_IRQHandler(void)
{
    INT_IRQHandler(PB7, 16);
}

void INT17_18_IRQHandler(void)
{
    INT_IRQHandler(PV2, 17);
}

void INT19_22_IRQHandler(void)
{
    INT_IRQHandler(PH4, 19);
}

#define BIT22 (0x1 << 22)
#define BIT21 (0x1 << 21)
void INT23_26_IRQHandler(void)
{
    uint32_t int_num = TSB_IMN->FLG5;
    if( int_num & BIT22) {
        INT_IRQHandler(PT1, 24);
    } else if(int_num & BIT21) {
        INT_IRQHandler(PT0, 23);
    }
}

void INT27_28_IRQHandler(void)
{
    INT_IRQHandler(PG2, 27);
}

void INT29_IRQHandler(void)
{
    INT_IRQHandler(PT7, 29);
}

void INT30_31_IRQHandler(void)
{
    INT_IRQHandler(PU0, 30);
}

static void SetSTBYReleaseINTSrc(cg_intsrc intsource, cg_intactivestate ActiveState, FunctionalState NewState)
{
    __IO uint8_t *p_imc;

    if(intsource < 3U || intsource == 13U) {
        if(intsource == 13U) {
            intsource = (cg_intsrc)3U;
        }
        p_imc = (__IO uint8_t *)(&TSB_IA->IMC00 + (intsource));
        *p_imc = (uint8_t)(0xC0 | ActiveState | NewState);
    } else {
        if(intsource > 13U) {
            intsource -= 4;
        } else {
            intsource -= 3;
        }
        p_imc = (__IO uint8_t *)(&TSB_IB->IMC066 + (intsource));
        *p_imc = (uint8_t)(0xC0 | ActiveState | NewState);
    }
    // Dummy read is need
    {
        __IO uint8_t imc = *p_imc;
    }
}

/**
 * @brief Return INTSRC for gpio INT that enable more than one pin.
 * @param  pin PinName.
 * @return  GPIO IRQn_Type .
 * @note You can expand func CheckPinNameIRQSRC if need to add other GPIO INT.
 */
static uint32_t CheckPinNameIRQSRC(PinName pin)
{
    switch(pin)
    {
        case PT0:
            return CG_INT_SRC_18;
        case PT1:
            return CG_INT_SRC_19;
        default:
            break;
    }
    return -1;
}