#include "xmbox.h"

#include "wlan_mac_common.h"
#include "wlan_mac_high.h"
#include "wlan_mac_high_mailbox_util.h"
#include "wlan_mac_mailbox_util.h"
#include "wlan_platform_common.h"
#include "wlan_platform_high.h"
#include "wlan_mac_schedule.h"


#define MAILBOX_RIT 0 /* mailbox receive interrupt threshold */
#define MAILBOX_SIT 0 /* mailbox send interrupt threshold */

static XMbox* xmbox_ptr;
static platform_common_dev_info_t platform_common_dev_info;
static platform_high_dev_info_t platform_high_dev_info;

// IPC variables
static wlan_ipc_msg_t ipc_msg_from_low;                                           ///< IPC message from lower-level
static u32 ipc_msg_from_low_payload[MAILBOX_MSG_MAX_NUM_WORDS];     ///< Buffer space for IPC message from lower-level

void _mailbox_rx_watchdog(u32 timer_id);

void wlan_mac_high_init_mailbox(){

	xmbox_ptr = init_mailbox();

	//Create IPC message to receive into
	ipc_msg_from_low.payload_ptr = &(ipc_msg_from_low_payload[0]);

	platform_common_dev_info = wlan_platform_common_get_dev_info();
	platform_high_dev_info   = wlan_platform_high_get_dev_info();
}

/**
 * @brief WLAN MAC IPC receive
 *
 * IPC receive function that will poll the mailbox for as many messages as are
 * available and then call the CPU high IPC processing function on each message
 *
 * @param  None
 * @return None
 */
void wlan_mac_high_ipc_rx(){
	while (read_mailbox_msg(&ipc_msg_from_low) == IPC_MBOX_SUCCESS) {
		wlan_mac_high_process_ipc_msg(&ipc_msg_from_low, ipc_msg_from_low_payload);
	}
}

/*****************************************************************************/
/**
 * Setup mailbox interrupt
 *
 * @return  int              - Status:
 *                                 WLAN_SUCCESS - Command completed successfully
 *                                 WLAN_FAILURE - Command failed
 *****************************************************************************/
int setup_mailbox_interrupt() {
    int status;

    // Set Send / Receive threshold for interrupts
    XMbox_SetSendThreshold(xmbox_ptr, MAILBOX_SIT);
    XMbox_SetReceiveThreshold(xmbox_ptr, MAILBOX_RIT);

    // Connect interrupt handler
	status = wlan_platform_interrupt_connect(platform_high_dev_info.mailbox_int_id, (wlan_intr_handler_t)mailbox_int_handler, xmbox_ptr);

    if (status != WLAN_SUCCESS) {
        return WLAN_FAILURE;
    }

    // Enable interrupt
    XMbox_SetInterruptEnable(xmbox_ptr, XMB_IX_RTA);
    wlan_platform_interrupt_enable(platform_high_dev_info.mailbox_int_id);

    // Enable watchdog - checks for (unlikely but not impossible) mailbox messages received without
    //  interrupt assertion
	wlan_mac_schedule_add_event(SCHEDULE_ID_COARSE, 200000, SCHEDULE_REPEAT_FOREVER, (void*)_mailbox_rx_watchdog);

    return WLAN_SUCCESS;
}


/*****************************************************************************/
/**
 * Mailbox interrupt handler
 *
 * @param   callback_ref     - Callback reference (set by interrupt framework)
 *
 *****************************************************************************/
void mailbox_int_handler(void* callback_ref){
    u32 mask;
    XMbox* mbox_ptr = (XMbox *)callback_ref;

#ifdef _ISR_PERF_MON_EN_
    wlan_mac_set_dbg_hdr_out(ISR_PERF_MON_GPIO_MASK);
#endif

    // First, we raise the receive threshold to its maximum value. The argument to the function
    // is a u32, but only the lower log2(FIFO Depth) bits are used
    XMbox_SetReceiveThreshold(xmbox_ptr, 0xFFFFFFFF);

    // Get the interrupt status
    mask = XMbox_GetInterruptStatus(mbox_ptr);

    // If this is a receive interrupt, then call the callback function
    if (mask & XMB_IX_RTA) {
    	wlan_mac_high_ipc_rx();
    }

	// It is technically possible that the mailbox could become full and
	// abandoned if the FIFO transitions from empty to completely full
    // at this part of the code before the following XMbox_ClearInterrupt
    // call. Under normal circumstanced, this is impossible. However, if
    // the debugger were to pause operation of the processor at this point,
    // it is conceivable that the bug could be exercised. The fix for this
    // event is the periodic call to the _mailbox_rx_watchdog() function.

    // Clear the interrupt
    //     - Since only the XMB_IX_RTA interrupt was enabled in setup_mailbox_interrupt()
    //       that is the only interrupt that will ever need to be cleared
    XMbox_ClearInterrupt(mbox_ptr, XMB_IX_RTA);

    // Drop the receive threshold to its correct value. The purpose of this is to avoid a race condition
    // that could occur if a reception occurs in between the call to wlan_mac_high_ipc_rx() and XMbox_ClearInterrupt().
    // By lowering the threshold, we will force another interrupt in that scenario.
    XMbox_SetReceiveThreshold(xmbox_ptr, MAILBOX_RIT);

#ifdef _ISR_PERF_MON_EN_
    wlan_mac_clear_dbg_hdr_out(ISR_PERF_MON_GPIO_MASK);
#endif
}


void _mailbox_rx_watchdog(u32 timer_id){
	wlan_mac_high_ipc_rx();
}