static int if_sdio_wakeup_card(struct if_sdio_card *card)
{
	struct rda5890_private *priv = card->priv;
	int ret = 0;

#ifdef WIFI_TEST_MODE
    if(rda_5990_wifi_in_test_mode())
        return 0;
#endif
    
#ifdef WIFI_CLOCK_ALWAYS_ON
	export_msdc_clk_always_on();
#endif	

	ret = mtk_wcn_hif_sdio_writeb(priv->cltCtx, IF_SDIO_FUN1_INT_TO_DEV,1);
	if (ret) {
		RDA5890_ERRP("if_sdio_wakeup_card write FUN1_INT_TO_DEV reg fail\n");
		goto out;
	}
    atomic_set(&priv->sleep_flag, 0);
      
	RDA5890_DBGLAP(RDA5890_DA_PM, RDA5890_DL_CRIT, "wake up \n");
	// wait 15ms, hardware need 13ms to wakeup
    rda5890_shedule_timeout(8);
out:
	return ret;
}
Пример #2
0
/*----------------------------------------------------------------------------*/
BOOL kalDevWriteWithSdioCmd52(IN P_GLUE_INFO_T prGlueInfo, IN UINT_32 u4Addr, IN UINT_8 ucData)
{
	int ret = 0;

#if (MTK_WCN_HIF_SDIO == 0)
	if (!in_interrupt) {
		sdio_claim_host(prGlueInfo->rHifInfo.func);
	}

	sdio_writeb(prGlueInfo->rHifInfo.func, ucData, u4Addr, &ret);

	if (!in_interrupt) {
		sdio_release_host(prGlueInfo->rHifInfo.func);
	}
#else
	ret = mtk_wcn_hif_sdio_writeb(prGlueInfo->rHifInfo.cltCtx, u4Addr, ucData);
#endif

	if (ret) {
		kalSendAeeWarning(HIF_SDIO_ERR_TITLE_STR,
				  HIF_SDIO_ERR_DESC_STR "sdio_writeb() reports error: %x", ret);
		DBGLOG(HAL, ERROR, ("sdio_writeb() reports error: %x", ret));
	}

	return (ret) ? FALSE : TRUE;

}				/* end of kalDevWriteWithSdioCmd52() */
void if_sdio_sleep_worker(struct work_struct *work)
{
	struct if_sdio_card *card = NULL;
	int ret = 0;
    struct rda5890_private *priv = NULL;

	card = container_of(work, struct if_sdio_card,
                sleep_work.work);
	
	if(card)
		priv = card->priv;
	else
		goto out;

	if(!priv)
		goto out;

	RDA5890_DBGLAP(RDA5890_DA_PM, RDA5890_DL_CRIT, "Sleep\n");

	/* clear IF_SDIO_FUN1_INT_PEND, this allow device to sleep */
	ret = mtk_wcn_hif_sdio_writeb(priv->cltCtx, IF_SDIO_FUN1_INT_PEND, IF_SDIO_HOST_TX_FLAG);
	if (ret)
	{
		RDA5890_ERRP("clear IF_SDIO_HOST_TX_FLAG failed\n");
	}
	atomic_inc(&card->priv->sleep_flag); 

out:

    atomic_set(&card->sleep_work_is_active, 0);
#ifdef WIFI_UNLOCK_SYSTEM
    rda5990_wakeUnlock();
#endif
	return;
}
void unmask_all_sdio_irq(MTK_WCN_HIF_SDIO_CLTCTX cltCtx)
{
	if(mask_irq_flag)
	{
		mtk_wcn_hif_sdio_writeb(cltCtx, IF_SDIO_FUN1_INT_MASK, 0x7);
		mask_irq_flag = 0;
	}
}
u32 rda_hif_sdio_irq(MTK_WCN_HIF_SDIO_CLTCTX cltCtx)
{ 
    int ret = 0;
    struct if_sdio_card *card;
    struct rda5890_private *priv;
    u8 status;

    RDA5890_DBGLAP(RDA5890_DA_SDIO, RDA5890_DL_DEBUG,
    	"%s >>>\n", __func__); 

    if(!gCard)
    {
	    return -EIO;
    }  
   
    card = gCard;
    priv = card->priv;
	
    ret = mtk_wcn_hif_sdio_readb(priv->cltCtx, IF_SDIO_FUN1_INT_STAT, &status);
    if (ret)
    	goto out;
    
    RDA5890_DBGLAP(RDA5890_DA_SDIO, RDA5890_DL_VERB,
    	"if_sdio_interrupt, status = 0x%02x\n", status);

    if (status & IF_SDIO_INT_AHB2SDIO)
    	if_sdio_card_to_host(card);

    if (status & IF_SDIO_INT_ERROR) {
    	ret = mtk_wcn_hif_sdio_writeb(priv->cltCtx, IF_SDIO_FUN1_INT_PEND ,IF_SDIO_INT_ERROR);
    	if (ret) {
    		RDA5890_ERRP("write FUN1_INT_STAT reg fail\n");
    		goto out;
    	}

    	RDA5890_DBGLAP(RDA5890_DA_SDIO, RDA5890_DL_TRACE,
    		"%s, INT_ERROR\n", __func__);
    }

#ifdef WIFI_CLOCK_ALWAYS_ON
	export_msdc_clk_always_on_off();
#endif

    out:
    RDA5890_DBGLAP(RDA5890_DA_SDIO, RDA5890_DL_DEBUG,
    	"%s <<< ret=%d \n", __func__, ret);   
    return ret;
}
int if_sdio_card_to_host(struct if_sdio_card *card)
{
	int ret = 0;
	struct rda5890_private *priv = card->priv;
	u8 size_l = 0, size_h = 0;
	u16 size, chunk;

	RDA5890_DBGLAP(RDA5890_DA_SDIO, RDA5890_DL_DEBUG,
		"%s <<< \n", __func__);

	ret = mtk_wcn_hif_sdio_readb(priv->cltCtx, IF_SDIO_AHB2SDIO_PKTLEN_L, &size_l);
	if (ret) {
		RDA5890_ERRP("read PKTLEN_L reg fail\n");
		goto out;
	}
	else
		RDA5890_DBGLAP(RDA5890_DA_SDIO, RDA5890_DL_NORM,"read PKTLEN_L reg size_l:%d \n", size_l);

	ret = mtk_wcn_hif_sdio_readb(priv->cltCtx, IF_SDIO_AHB2SDIO_PKTLEN_H, &size_h);
	if (ret) {
		RDA5890_ERRP("read PKTLEN_H reg fail\n");
		goto out;
	}
	else
		RDA5890_DBGLAP(RDA5890_DA_SDIO, RDA5890_DL_NORM,"read PKTLEN_H reg size_h:%d\n",size_h);	

	size = (size_l | ((size_h & 0x7f) << 8)) * 4;
	if (size < 4) {
		RDA5890_ERRP("invalid packet size (%d bytes) from firmware\n", size);
		ret = -EINVAL;
		goto out;
	}

	/* alignment is handled on firmside */
	//chunk = sdio_align_size(card->func, size);
	chunk = size;

	RDA5890_DBGLAP(RDA5890_DA_SDIO, RDA5890_DL_NORM,
		"if_sdio_card_to_host, size = %d, aligned size = %d\n", size, chunk);

	/* TODO: handle multiple packets here */
	ret = mtk_wcn_hif_sdio_read_buf(priv->cltCtx, IF_SDIO_FUN1_FIFO_RD, (u32)card->buffer, chunk);
	if (ret) {
		RDA5890_ERRP("sdio_readsb fail, ret = %d, size = %d, aligned size = %d\n", ret, size, chunk);
		goto out;
	}

#if 1
    if(priv->version == 7)
    {
        mtk_wcn_hif_sdio_writeb(priv->cltCtx, IF_SDIO_FUN1_INT_PEND, 0x20);
        if(ret) {
           RDA5890_ERRP("clear SDIO Tx Complete flag failed\n");
           goto out;
        }
    }
#endif

	RDA5890_DBGLAP(RDA5890_DA_SDIO, RDA5890_DL_VERB,
		"if_sdio_card_to_host, read done\n");

    if(ret) 
    {
        RDA5890_ERRP("clear SDIO Tx Complete flag failed\n");
        goto out;
    }

	if (sdio_test_flag) {
		rda5890_sdio_test_card_to_host(card->buffer, chunk);
		goto out;
	}

	/* TODO: this chunk size need to be handled here */
	rda5890_card_to_host(priv, card->buffer, chunk);

out:
	RDA5890_DBGLAP(RDA5890_DA_SDIO, RDA5890_DL_DEBUG,
		"if_sdio_card_to_host >>>\n");
	return ret;
}
u32 rda_hif_sdio_probe(MTK_WCN_HIF_SDIO_CLTCTX cltCtx, MTK_WCN_HIF_SDIO_FUNCINFO* funcInfo)
{   
    struct if_sdio_card *card = NULL;
    struct rda5890_private *priv = NULL;
    struct if_sdio_packet *packet = NULL; 
    int ret = -1;
    unsigned long flags;

    RDA5890_DBGLAP(RDA5890_DA_SDIO, RDA5890_DL_DEBUG,
    	"%s >>>\n", __func__);

    printk(KERN_INFO "20120905 RDA5890: SDIO card attached func num %d block size %d \n", funcInfo->func_num, funcInfo->blk_sz);

    if(gCard)
    {
	    RDA5890_ERRP("rda5890 sdio has probed \n");
	    return 0;
    }
    card = kzalloc(sizeof(struct if_sdio_card), GFP_KERNEL);
    if (!card) {
    	RDA5890_ERRP("kzalloc fail\n");
    	return -ENOMEM;
    }
    

    card->func = NULL;
    spin_lock_init(&card->lock);  
    atomic_set(&card->wid_complete_flag, 0);
    INIT_WORK(&card->packet_worker, if_sdio_host_to_card_worker);
    card->work_thread = create_singlethread_workqueue("rda5890_if_sdio_worker");
    
#ifdef WIFI_POWER_MANAGER   
    atomic_set(&card->sleep_work_is_active, 0);
    INIT_DELAYED_WORK(&card->sleep_work, if_sdio_sleep_worker); 
#endif

#ifdef WIFI_UNLOCK_SYSTEM 
    atomic_set(&wake_lock_counter, 0);
    wake_lock_init(&sleep_worker_wake_lock, WAKE_LOCK_SUSPEND, "RDA_sleep_worker_wake_lock");
#endif
    
    priv = rda5890_add_card(card);
	if (!priv) {
		RDA5890_ERRP("rda5890_add_card fail\n");
		ret = -ENOMEM;
		goto remove_card;
	}
    rda5890_debugfs_init_one(priv);

    card->priv = priv;
    priv->card = card;
    priv->hw_host_to_card = if_sdio_host_to_card;
    priv->cltCtx = cltCtx;
    
    priv->version = rda_wlan_version();
    priv->version &= 0x1f;
    if(priv->version  != 4 && priv->version  != 7
    	&& priv->version != 5)
    {
        RDA5890_ERRP("no correct version exit wlan initiate \n");
        goto remove_card;
    }

    /*
     * Enable interrupts now that everything is set up
     */
    printk(KERN_INFO " mtk_wcn_hif_sdio_writeb IF_SDIO_FUN1_INT_MASK \n");
    ret = mtk_wcn_hif_sdio_writeb(cltCtx, IF_SDIO_FUN1_INT_MASK, 0x07); 
    if (ret) {
    	RDA5890_ERRP("enable func interrupt fail\n");
    	goto remove_card;
    }

#ifdef WIFI_TEST_MODE
    if(!rda_5990_wifi_in_test_mode())
        {
#endif        
            ret = rda5890_sdio_init(priv);
            if(ret < 0)
                goto remove_card;
			
            gCard = card;
        	ret=rda5890_disable_self_cts(priv);   
            if(ret < 0)
                goto remove_card;

        	ret=rda5890_disable_block_bt(priv);
            if(ret < 0)
                goto remove_card;

            ret = rda5890_set_scan_timeout(priv);
            if (ret) {
                	RDA5890_ERRP("rda5890_set_scan_timeout fail, ret = %d\n", ret);
                	goto remove_card;
            }
        		
            ret= rda5890_set_listen_interval(priv, WIFI_LISTEN_INTERVAL);
            if(ret < 0)
                goto remove_card;

            ret = rda5890_set_link_loss_threshold(priv, WIFI_LINK_LOSS_THRESHOLD);
            if(ret < 0)
                goto remove_card;
            
            ret = rda5890_init_pm(priv);
            if(ret < 0)
                goto remove_card;
            
#ifdef WIFI_TEST_MODE            
        }
    else
        {
            ret = rda5890_set_test_mode(priv);
            if(ret < 0)
                goto remove_card;

			gCard = card;
		}
#endif
#ifdef WIFI_SELECT_CHANNEL    
    // Add for choose operation band, 3rd parameter indicate which band will be used.
    // 0/1: channel1-11, 2:channel1-13, 3:channel1-14, other values: channel1-13
#ifdef  CHANNEL_11
    if (rda5890_generic_set_uchar(priv, 0x0047, 1) < 0)
#elif defined CHANNEL_14
    if (rda5890_generic_set_uchar(priv, 0x0047, 3) < 0)    	
#else /* CHANNEL_13 && others */
    if (rda5890_generic_set_uchar(priv, 0x0047, 2) < 0)    
#endif   		
    {
        RDA5890_ERRP("set op_band failed!\n");
        goto remove_card;
    }
    else
    {
#ifdef  CHANNEL_11    	
		channel_nums = 11;
#elif defined CHANNEL_12
		channel_nums = 12;
#elif defined CHANNEL_14
		channel_nums = 14;
#else /* CHANNEL_13 && others */
		channel_nums = 13;
#endif  		
    }
#endif  
    if (sdio_test_flag) {
        unsigned char mac_addr[6];
        RDA5890_DBGLAP(RDA5890_DA_SDIO, RDA5890_DL_TRACE,
        "SDIO TESTING MODE\n");


        ret = rda5890_get_mac_addr(priv, mac_addr);
        printk(KERN_INFO "Test rda5890_get_mac_addr %x:%x:%x:%x:%x:%x", mac_addr[0],mac_addr[1],mac_addr[2],mac_addr[3],mac_addr[4],mac_addr[5]);
        goto done;
    }

    ret = rda5890_start_card(priv);
    if (ret) {
    	RDA5890_ERRP("rda5890_start_card fail, ret = %d\n", ret);
    	goto remove_card;
    }
done:
    printk(KERN_INFO "RDA5890: SDIO card started\n");

out:
    RDA5890_DBGLAP(RDA5890_DA_SDIO, RDA5890_DL_DEBUG,
    	"%s ret:%d <<<\n", __func__, ret);
    return ret;

remove_card:   
    
    if (atomic_read(&card->wid_complete_flag) && priv)
    {
        complete(&priv->wid_done);
        printk(KERN_INFO "*****RDA5890: probe send wid complete\n");
    }
    flush_work(&card->packet_worker);
    cancel_work_sync(&card->packet_worker);
    
#ifdef WIFI_POWER_MANAGER
    cancel_delayed_work(&card->sleep_work);
#endif
    destroy_workqueue(card->work_thread);
    
    if(priv)
        rda5890_remove_card(priv);

    while (card->packets) {
    	packet = card->packets;
    	card->packets = card->packets->next;
    	kfree(packet);	
    }
    
    kfree(card);
    gCard = NULL;
    goto out;
}
static void if_sdio_host_to_card_worker(struct work_struct *work)
{
	struct if_sdio_card *card = NULL;
	struct rda5890_private *priv = NULL;
	struct if_sdio_packet *packet = NULL;
	int ret;
	unsigned long flags;
	u16 size;
	u32 retries = 500;
	u8 size_l, size_h, write_status = 0;
#define SDIO_HOST_WRITE_BATCH_SIZE   512
	u16 bytes_left, offset, batch;

	card = container_of(work, struct if_sdio_card, packet_worker);
	priv = card->priv;

	//mask_all_sdio_irq(priv->cltCtx);
#ifdef WIFI_POWER_MANAGER    
	if(is_sdio_init_complete())
	{   
		if(atomic_read(&card->sleep_work_is_active))
		{
		    cancel_delayed_work(&card->sleep_work);
#ifdef WIFI_UNLOCK_SYSTEM    
		    rda5990_wakeUnlock();
#endif 
		    atomic_set(&card->sleep_work_is_active, 0);
		}
	}
#endif

	while (1) 
	{  
		retries = 500;
		  
		spin_lock_irqsave(&card->lock, flags);
		packet = card->packets;
		if (packet)
			card->packets = packet->next;
		spin_unlock_irqrestore(&card->lock, flags);

		if (!packet)
			break;
		
#ifdef WIFI_POWER_MANAGER		
		if (atomic_read(&priv->sleep_flag)) 
		{
			/* Deivce maybe sleep, wakeup it. */
			RDA5890_DBGLAP(RDA5890_DA_SDIO, RDA5890_DL_NORM, "Wakeup\n");
			ret = if_sdio_wakeup_card(card);
			if (ret) 
			{
				RDA5890_ERRP("wakeup card fail\n");
				goto out;
			}
		}
#endif
		while(retries && is_sdio_patch_complete()) //check write flow ctrl
		{
			ret = mtk_wcn_hif_sdio_readb(priv->cltCtx, IF_SDIO_FUN1_INT_PEND, &write_status);
			if(ret)
			{
				RDA5890_ERRP("read IF_SDIO_FUN1_INT_PEND failed\n");
				goto release;
			}
			if((write_status & IF_SDIO_INT_RXCMPL) == 0)
			{
				//RDA5890_ERRP("**** sdio is busy retry next time \n ");
				retries --;
				schedule();
			}
		    	else
			{
				ret = mtk_wcn_hif_sdio_writeb(priv->cltCtx, IF_SDIO_FUN1_INT_PEND, IF_SDIO_INT_RXCMPL);
				if(ret)
				{
					RDA5890_ERRP("write IF_SDIO_FUN1_INT_PEND failed\n");
					goto release;
				}
				break;
			}
		}
	      
		RDA5890_DBGLAP(RDA5890_DA_SDIO, RDA5890_DL_DEBUG,
		"if_sdio_host_to_card_worker, send one packet, size = %d\n", packet->nb);
		/* write length */
		size = packet->nb/4;
		size_l = (u8)(size & 0xff);
		size_h = (u8)((size >> 8) & 0x7f);
		size_h |= 0x80;

		ret = mtk_wcn_hif_sdio_writeb(priv->cltCtx, IF_SDIO_SDIO2AHB_PKTLEN_L, size_l);
		if (ret) {
			RDA5890_ERRP("write PKTLEN_L reg fail\n");
			goto release;
		}
		ret = mtk_wcn_hif_sdio_writeb(priv->cltCtx, IF_SDIO_SDIO2AHB_PKTLEN_H, size_h);
		if (ret) {
			RDA5890_ERRP("write PKTLEN_H reg fail\n");
			goto release;
		}

		/* write data */
		bytes_left = packet->nb;
		offset = 0;
		while(bytes_left) 
		{
			batch = (bytes_left < SDIO_HOST_WRITE_BATCH_SIZE)?
			bytes_left:SDIO_HOST_WRITE_BATCH_SIZE;
			ret = mtk_wcn_hif_sdio_write_buf(priv->cltCtx, IF_SDIO_FUN1_FIFO_WR,
			packet->buffer + offset, batch);
			if (ret) {
				RDA5890_ERRP("sdio_writesb fail, ret = %d\n", ret);
				goto release;
			}
			RDA5890_DBGLAP(RDA5890_DA_SDIO, RDA5890_DL_DEBUG,
			"write batch %d, offset = %d\n", batch, offset);
			offset += batch;
			bytes_left -= batch;
		}

		RDA5890_DBGLAP(RDA5890_DA_SDIO, RDA5890_DL_DEBUG,
		"if_sdio_host_to_card_worker, send one packet done\n");

		release:

		kfree(packet);
		packet = NULL;
	}

	out:

	if(is_sdio_init_complete()) //init complete should start sleep_work
	{
#ifdef WIFI_UNLOCK_SYSTEM    
		rda5990_wakeLock();
#endif   

#ifdef WIFI_POWER_MANAGER
#ifdef WIFI_TEST_MODE
		if(rda_5990_wifi_in_test_mode())
		    return;
#endif  //end WIFI_TEST_MODE
		atomic_set(&card->sleep_work_is_active, 1);
	    queue_delayed_work(priv->work_thread, &card->sleep_work, rda5890_assoc_in_progress ? 30 * HZ : HZ/5);  // 100ms
		//queue_delayed_work(priv->work_thread, &card->sleep_work, HZ/5);  // 100ms
#endif	    
	}
}
Пример #9
0
static long
mt6620_ioctl(struct file *filp, unsigned int cmd, unsigned long arg) {
	int err = 0;
	int retval = 0;
	u8 data;
	unsigned int tmp;

	if(_IOC_TYPE(cmd) != MT6620_IOC_MAGIC) 
		return -ENOTTY;
	else if(_IOC_NR(cmd) > MT6620_IOC_MAXNR) return -ENOTTY;

	if(_IOC_DIR(cmd) & _IOC_READ)
		err = !access_ok(VERIFY_WRITE, (void __user *)arg, _IOC_SIZE(cmd));
	else if (_IOC_DIR(cmd) & _IOC_WRITE)
		err =  !access_ok(VERIFY_READ, (void __user *)arg, _IOC_SIZE(cmd));
	if (err) 
		return -EFAULT;

	switch(cmd) {
	case MT6620_IOC_GET_FUNC_FOCUS:
	case MT6620_IOC_SET_FUNC_FOCUS:
	case MT6620_IOC_GET_SDBUS_WIDTH:
	case MT6620_IOC_SET_SDBUS_WIDTH:
	case MT6620_IOC_GET_BUS_CLOCK:
	case MT6620_IOC_SET_BUS_CLOCK:
        retval = -EINVAL;
		break;

	case MT6620_IOC_READ_DIRECT:
		if(down_interruptible(&mt6620_sem)) {
			return -ERESTARTSYS;
		}

		retval = mtk_wcn_hif_sdio_readb(mt6620_t.cltCtx, mt6620_t.addr, &data);

		up(&mt6620_sem);

		if(retval == 0)
			retval = __put_user(data, (u8 __user *)arg);

		break;

	case MT6620_IOC_WRITE_DIRECT:
		__get_user(data, (u8 __user *)arg);

		if(down_interruptible(&mt6620_sem)) {
			return -ERESTARTSYS;
		}

		retval = mtk_wcn_hif_sdio_writeb(mt6620_t.cltCtx, mt6620_t.addr, data);

		up(&mt6620_sem);

		break;

	case MT6620_IOC_GET_ADDR:
		tmp = mt6620_t.addr;
		__put_user(tmp, (u32 __user *)arg);
		break;

	case MT6620_IOC_SET_ADDR:
		__get_user(tmp, (u32 __user *)arg);
		if(tmp <= 0xFF)
			mt6620_t.addr = tmp;
		else
			retval = -EINVAL;
		break;

	case MT6620_IOC_SET_FIFO_MODE:
	case MT6620_IOC_SET_INCR_MODE:
	case MT6620_IOC_GET_BLOCK_SIZE:
	case MT6620_IOC_SET_BLOCK_SIZE:
        retval = -EINVAL;
		break;

	case MT6620_IOC_QUERY_IRQ_LEVEL:
		if(down_interruptible(&mt6620_sem))
			retval = -ERESTARTSYS;
		else if(mt6620_t.irq.irq == 1) {
			unsigned char buffer[88];

			if(mt6620_t.enhance_int.totalBytes != 0) {
				int i, offset = 0;

				if(mtk_wcn_hif_sdio_read_buf(mt6620_t.cltCtx, MCR_WHISR, 
						(PUINT32)(buffer), mt6620_t.enhance_int.totalBytes + sizeof(unsigned int))) {
                    /* I/O error */
        			up(&mt6620_sem);
                    return -EIO;
                }

				mt6620_t.irq.u4HISR |= *(uint32_t *)(&(buffer[offset]));
				offset += sizeof(uint32_t);

				// WTSR0/WTSR1
				if(mt6620_t.enhance_int.totalBytes >= (12)) {
					int tqStatus[2];
					memcpy(&(tqStatus[0]), &(buffer[offset]), 8);

					// increase
					mt6620_t.irq.rTxInfo.u.ucTQ0Cnt += ((tqStatus[0] >>  0) & 0xff);
					mt6620_t.irq.rTxInfo.u.ucTQ1Cnt += ((tqStatus[0] >>  8) & 0xff);
					mt6620_t.irq.rTxInfo.u.ucTQ2Cnt += ((tqStatus[0] >> 16) & 0xff);
					mt6620_t.irq.rTxInfo.u.ucTQ3Cnt += ((tqStatus[0] >> 24) & 0xff);
					mt6620_t.irq.rTxInfo.u.ucTQ4Cnt += ((tqStatus[1] >>  0) & 0xff);
					mt6620_t.irq.rTxInfo.u.ucTQ5Cnt += ((tqStatus[1] >>  8) & 0xff);

					offset += 8;
				}

				// RX0NUM/RX1NUM
				if(mt6620_t.enhance_int.totalBytes >= (16)) {
					memcpy(&(mt6620_t.irq.rRxInfo.au4RxStatusRaw[0]), &(buffer[offset]), 4);
					offset += 4;
				}

				// RX0 LEN0-15 / RX1 LEN0-15
				if(mt6620_t.enhance_int.totalBytes >= (16 + mt6620_t.enhance_int.rxNum * 4)) {
					for(i = 0 ; i < mt6620_t.enhance_int.rxNum ; i++) {
						mt6620_t.irq.rRxInfo.u.au2Rx0Len[i] = *(uint16_t *)(&(buffer[offset]));
						offset += sizeof(uint16_t);
					}

					for(i = 0 ; i < mt6620_t.enhance_int.rxNum ; i++) {
						mt6620_t.irq.rRxInfo.u.au2Rx1Len[i] = *(uint16_t *)(&(buffer[offset]));
						offset += sizeof(uint16_t);
					}
				}

				// D2HRM0R / D2HRM1R
				if(mt6620_t.enhance_int.totalBytes >= (16 + mt6620_t.enhance_int.rxNum * 4 + 8)) {
					memcpy(&(mt6620_t.irq.u4RcvMailbox0), &(buffer[offset]), 4);
					offset += 4;

					memcpy(&(mt6620_t.irq.u4RcvMailbox1), &(buffer[offset]), 4);
					offset += 4;
				}

				//@FIXME: WHISR could be configured as write-1-clear .... 
				//if so, we need to clear WHISR here ..
			}