/* Plx9054_diag.c: Plx9054 PCI橋片驅動測試維護模塊*/
/* author: Wang.qi Jilin Univ. 2004512025*/

/*
modification history
------------------
2006-09-19
*/

#ifdef __cplusplus
extern "C" {
#endif

/* includes (header file) 頭包含文件 */
#include "vxWorks.h"
#include "vme.h"
#include "memLib.h"
#include "sysLib.h"
#include "string.h"
#include "intLib.h"
#include "config.h"
#include "logLib.h"
#include "taskLib.h"
#include "vxLib.h"
#include "errnoLib.h"
#include "dosFsLib.h"
#include "stdio.h"
#include "cacheLib.h"
#include "private/vmLibP.h"
#include "arch/i86/pentiumLib.h"
#include <ctype.h>

#include "drv/pci/pciConfigLib.h"
#include "drv/pci/pciIntLib.h"

#include "plx9054.h"

/* define 宏定義 */

/* global */

/* local */
static char line[256];

/* import */

/* function declarations*/
STATUS PLX9054_TestInit(void);
STATUS PLX9054_EditConfigReg(int index);
STATUS PLX9054_EditLocalReg(int index);
void PLX9054_SpaceAccess(int index);
void PLX9054_EnableDisableInt(int index);
void PLX9054_EepromAccess(int index);
void PLX9054_ShowSpaceInfo(int index);
void PLX9054_FIFORead(int index, UINT32 * pData);
void PLX9054_WriteDsp(int index, UINT32 dwData);
LOCAL void PLX9054_DmaTest(int index);

/* function */
/*
PLX9054_diag
PLX9054測試維護模塊入口函數
*/
void PLX9054_diag(void)
{
    int cmd, index = 0;
    PLX9054_DRVCTRL * pDrvCtrl;
    
    printf ("PLX 9054 diagnostic utility.\n");
    printf ("Write by Wang.qi Jilin Univ.\n");

    #ifdef PLX_DEBUG
        PLX9054_TestInit();
    #endif
    
    pDrvCtrl = PLX9054_GetDrvCtrl( ); /*獲取驅動控制指針*/

    do
    {
        printf ("\n");
        printf ("PLX 9054 main menu\n");
        printf ("-------------------\n");
        printf ("1. Scan PCI bus\n");
        if (pDrvCtrl->plxCardNum > 0)  /* 系統中存在PLX9054擴展卡*/
        {
            printf ("2. Choose PLX 9054 board\n");
            printf ("3. PCI configuration registers\n");
            printf ("4. PLX 9054 local registers\n");
            printf ("5. Read the DSP board's FIFO or Write Data to DSP\n");
            printf ("6. Enable / Disable interrupts\n");
            printf ("7. Access serial EEPROM on the board\n");
            printf ("8. Show Space Info\n");
            printf ("9. Soft Reset PLX9054 Board\n");
            printf ("10. DMA Read FIFO Test\n");
        }
        printf ("99. Exit\n");
        printf ("Enter option: ");
        cmd = 0;
        fgets(line, sizeof(line), stdin);
        sscanf (line, "%d",&cmd);
        switch (cmd)
        {
        case 1: /* Scan PCI bus */
            PLX9054_Pci_Show();
            break;
        case 2: /* Choose PLX 9054 board */
            if(0 == pDrvCtrl->plxCardNum)
            {
                printf("No Plx9054 Cards.\n");
            }
            else
            {
                index = 0;
                printf("Input Cards Index(0..%d):", pDrvCtrl->plxCardNum - 1);
                fgets(line, sizeof(line), stdin);
                sscanf (line, "%d",&index);
                if((index < 0 ) || (index > (pDrvCtrl->plxCardNum - 1)))
                {
                    printf("Out of Range.\n");
                    index = 0;
                }
            }
            break;
        case 3: /* PCI configuration registers */
            if (pDrvCtrl->plxCardNum > 0)
            {
                PLX9054_EditConfigReg(index);
            }
            break;
        case 4: /* PLX 9054 local registers */
            if (pDrvCtrl->plxCardNum > 0)
            {
                /*PLX9054_EditLocalReg(index);*/
                PLX9054_EditLocalReg(0);
            }
            break;
        case 5: /* Access address spaces on the board */
            if (pDrvCtrl->plxCardNum > 0)
            {
                PLX9054_SpaceAccess(index);
            }
            break;
        case 6: /* Enable / Disable interrupts */
            if (pDrvCtrl->plxCardNum > 0)
            {
                PLX9054_EnableDisableInt(index);
            }
            break;
        case 7: /* Access serial EEPROM on the board */
             if (pDrvCtrl->plxCardNum > 0)
            {
                PLX9054_EepromAccess(index);
            }
            break;
        case 8: /* Show Space Infomation.*/
            if (pDrvCtrl->plxCardNum > 0)
            {
                PLX9054_ShowSpaceInfo(index);
            }
        case 9: /* soft reset board */
            PLX9054_SoftReset(index);
            break;
        case 10: /* DMA 方式讀取FIFO 測試*/
            PLX9054_DmaTest(index);
        default:
            break;
        }
    } while (cmd!=99);

    return;
}

/* 
 PLX9054_TestInit
脫離硬件環境時，對結構體做初始化，
實現驅動程序無硬件環境下的單元測試。
*/
STATUS PLX9054_TestInit(void)
{

    int 		unit;
    int 		plx9054Units = 0;
    
    PLX9054_PCI_RESOURCES plx9054PciResrcs [] = /*默認分配給PLX 的PCI資源，測試用*/
    {
    {PLX9054_MEM_ADR0, PLX9054_IO_ADR0, PLX9054_INT_LVL0, PLX9054_INT_VEC0,
     PCI_CFG_TYPE, 0, 1, 0},
    {PLX9054_MEM_ADR1, PLX9054_IO_ADR1, PLX9054_INT_LVL1, PLX9054_INT_VEC1,
     PCI_CFG_TYPE, 0, 2, 0},
    {PLX9054_MEM_ADR2, PLX9054_IO_ADR2, PLX9054_INT_LVL2, PLX9054_INT_VEC2,
     PCI_CFG_TYPE, 0, 3, 0},
    {PLX9054_MEM_ADR3, PLX9054_IO_ADR3, PLX9054_INT_LVL3, PLX9054_INT_VEC3,
     PCI_CFG_TYPE, 0, 4, 0}
    };

    PLX9054_SPACE_DESC lSpaceDesc[PLX9054_MAX_DEV][AD_PCI_BARS] =
    {
        {
            {"PCI Configuration Mem"},
            {"PCI Configuration I/O"},
            {"PLX9054 Local Space 0", 0xEF000000, 0x100000, 0x10000000, TRUE, TRUE, FALSE},
            {"PLX9054 Local Space 1", 0xEE000000, 0x100000, 0x20000000, TRUE, TRUE, FALSE},
            {"PLX9054 Local Eeprom", 0, 0x100000, 0x10000000, TRUE, FALSE, FALSE},
            {},
            {}
        }
    };

    PLX9054_DRVCTRL *  pDrvCtrl = NULL;
    PLX9054_DEVICE * pDevCtrl = NULL;

    /* 為驅動結構體申請內存空間*/
    pDrvCtrl = (PLX9054_DRVCTRL *)malloc(sizeof(PLX9054_DRVCTRL));
    if(NULL == pDrvCtrl)
    {
        printf("Malloc return NULL File:%s, Line:%d.\n", __FILE__, __LINE__);
        return ERROR;
    }
    memset((void *)pDrvCtrl, 0, sizeof(PLX9054_DRVCTRL));
    /* find all plx9054 cards */
    for (unit = 0; unit < PLX9054_MAX_DEV; unit++)
    {
                /* 為設備結構體申請內存空間*/
                pDevCtrl = (PLX9054_DEVICE *)malloc(sizeof(PLX9054_DEVICE));
                if(NULL == pDevCtrl)
                {
                    printf("Malloc return NULL File:%s, Line:%d.\n", __FILE__, __LINE__);
                    return ERROR;
                }
                memset((void *)pDevCtrl, 0, sizeof(PLX9054_DEVICE));
                
                /* load up the PCI device table */
                pDevCtrl->PlxPciRsrc = plx9054PciResrcs[unit];

                /*本地空間初始化*/
                pDevCtrl->spaceDesc[P9054_ADDR_SPACE0] = lSpaceDesc[unit][P9054_ADDR_SPACE0];
                pDevCtrl->spaceDesc[P9054_ADDR_SPACE1] = lSpaceDesc[unit][P9054_ADDR_SPACE0];
                pDevCtrl->spaceDesc[P9054_ADDR_EPROM] = lSpaceDesc[unit][P9054_ADDR_EPROM];
                
                pDrvCtrl->pDevice[unit] = pDevCtrl;

                plx9054Units++;   	/* number of units found */
    }
    
    pDrvCtrl->plxCardNum = plx9054Units;
    

    PLX9054_SetDrvCtrl(pDrvCtrl);   /* 設置全局設備驅動結構體指針*/
    
    return OK; 
}

/*
PLX9054_EditConfigReg
讀寫PLX9054 PCI 配置寄存器測試函數
input
       index: 設備索引
*/
STATUS PLX9054_EditConfigReg(int index)
{
    PLX9054_DRVCTRL * pDrvCtrl;
    struct {
        char *name;
        UINT dwOffset;
        UINT dwBytes;
        UINT32 dwVal;
    } fields[30] = {
        { "VID", 0x0, 2 },
        { "DID", 0x2, 2 },
        { "CMD", 0x4, 2 },
        { "STS", 0x6, 2 },
        { "RID", 0x8, 1 },
        { "CLCD", 0x9, 3 },
        { "CALN", 0xc, 1 },
        { "LAT", 0xd, 1 },
        { "HDR", 0xe, 1 },
        { "BIST", 0xf, 1 },
        { "BADDR0", 0x10, 4 },
        { "BADDR1", 0x14, 4 },
        { "BADDR2", 0x18, 4 },
        { "BADDR3", 0x1c, 4 },
        { "BADDR4", 0x20, 4 },
        { "BADDR5", 0x24, 4 },
        { "EXROM", 0x30, 4 },
        { "INTLN", 0x3c, 1 },
        { "INTPIN", 0x3d, 1 },
        { "MINGNT", 0x3e, 1 },
        { "MAXLAT", 0x3f, 1 },
        { NULL, 0, 0 },
        { NULL, 0, 0 }
    };

    int cmd, i;

    pDrvCtrl = PLX9054_GetDrvCtrl( );
    /* 輸入參數判斷*/
    #ifdef PLX_INPUT_CHECK
    if( (index < 0)  || (index > (pDrvCtrl->plxCardNum - 1)))
    {
        printf("Index out of range file:%s, line:%d.\n", __FILE__, __LINE__);
        return ERROR;
    }
    #endif
    
    do {
        int row;
        int col;

        printf ("\n");
        printf ("Edit PCI configuration registers\n");
        printf ("--------------------------------\n");
        for (row = 0; row<=10; row++)
        {
            for (col = 0; col <=1; col++)
            {
                i = ((0 == col) ? row : (row + 10));
                
                if (row==10 && col==0)
                    printf("%26s","");
                else
                {
                    #ifndef PLX_DEBUG
                    UINT32 dwVal = 0;
                    PLX9054_Pci_Reg_Read(index, fields[i].dwOffset, &dwVal, (DATA_WIDTH_MODE)(fields[i].dwBytes));
                    fields[i].dwVal = dwVal;
                    #endif
                    printf ("%2d. %6s : %0*x %*s    ",i+1, fields[i].name, 
                        fields[i].dwBytes*2, fields[i].dwVal, 
                        8-fields[i].dwBytes*2, "");
                }
                if (col==1)
                    printf ("\n");
            }
        }

        printf ("99. Back to main menu\n");
        printf ("Choose register to write to, or 99 to exit: ");
        cmd = 0;