p9030_diag.c

Jungo公司确实为VxWorks开发了类似于WinDriver的驱动开发辅助套件DriverBuilder (for VxWorks)！

////////////////////////////////////////////////////////////////
// File - P9030_DIAG.C
//
// o A simple diagnostics program that lets you access the
//   PLX 9030 registers and local memory. 
// o This program is meant to be used as an example for using the P9030_LIB.H API,
//   you may use it as a skeleton for your driver, or 'cut & paste' parts
//   of it into your device driver code.
// o For a more advanced monitor program, use the standard PLXMON.EXE
//   from PLX.
// 
////////////////////////////////////////////////////////////////

#include "../lib/p9030_lib.h"
#include "../../../samples/shared/pci_diag_lib.h"
#include <stdio.h>

// input of command from user
static char line[256];

void PLX_EditReg(P9030_HANDLE hPlx)
{
    struct 
    {
        CHAR *name;
        DWORD dwOffset;
        DWORD dwVal;
    } fields[30];

    int cmd;
    int i;
    int field_count;

    i = 0;
    fields[i].name = "LAS0RR"; fields[i++].dwOffset = 0x00;
    fields[i].name = "LAS1RR"; fields[i++].dwOffset = 0x04;
    fields[i].name = "LAS2RR"; fields[i++].dwOffset = 0x08;
    fields[i].name = "LAS3RR"; fields[i++].dwOffset = 0x0c;
    fields[i].name = "EROMRR"; fields[i++].dwOffset = 0x10;
    fields[i].name = "LAS0BA"; fields[i++].dwOffset = 0x14;
    fields[i].name = "LAS1BA"; fields[i++].dwOffset = 0x18;
    fields[i].name = "LAS2BA"; fields[i++].dwOffset = 0x1c;
    fields[i].name = "LAS3BA"; fields[i++].dwOffset = 0x20;
    fields[i].name = "EROMBA"; fields[i++].dwOffset = 0x24;
    fields[i].name = "LAS0BRD"; fields[i++].dwOffset = 0x28;
    fields[i].name = "LAS1BRD"; fields[i++].dwOffset = 0x2c;
    fields[i].name = "LAS2BRD"; fields[i++].dwOffset = 0x30;
    fields[i].name = "LAS3BRD"; fields[i++].dwOffset = 0x34;
    fields[i].name = "EROMBRD"; fields[i++].dwOffset = 0x38;
    fields[i].name = "CS0BASE"; fields[i++].dwOffset = 0x3c;
    fields[i].name = "CS1BASE"; fields[i++].dwOffset = 0x40;
    fields[i].name = "CS2BASE"; fields[i++].dwOffset = 0x44;
    fields[i].name = "CS3BASE"; fields[i++].dwOffset = 0x48;
    fields[i].name = "INTCSR"; fields[i++].dwOffset = 0x4c;
    fields[i].name = "CNTRL"; fields[i++].dwOffset = 0x50;
    fields[i].name = "GPIOC"; fields[i++].dwOffset = 0x54;

    field_count = i;
    do
    {
        int row;
        int col;
        int row_count = field_count/2 + field_count%2;

        printf ("\n");
        printf ("Edit PLX 9030 registers\n");
        printf ("--------------------------------\n");
        for (row = 0; row<row_count; row++)
        {
            for (col = 0; col<=1; col++)
            {
                if (col==0) i = row;
                else i = row + row_count;

                if (i<field_count)
                {
                    char buf[10];
                    fields[i].dwVal = P9030_ReadReg(hPlx, fields[i].dwOffset);
                    sprintf(buf, "%08x",fields[i].dwVal);
                    printf ("%2d. %12s : %s     ",i+1, fields[i].name, buf);
                }
                if (col==1) printf ("\n");
            }
        }

        printf ("99. Back to main menu\n");
        printf ("Choose register to write to, or 99 to exit: ");
        cmd = 0;
        fgets(line, sizeof(line), stdin);
        sscanf (line, "%d",&cmd);
        if (cmd>=1 && cmd <=field_count)
        {
            i = cmd-1;
            printf ("Enter value to write to %s register (or 'X' to cancel): ",fields[i].name);
            fgets(line, sizeof(line), stdin);
            if (toupper (line[0])!='X')
            {
                DWORD dwVal;
                dwVal = 0;
                sscanf (line,"%x",&dwVal);
                P9030_WriteReg(hPlx, fields[i].dwOffset, dwVal);
            }
        }
    } while (cmd!=99);
}

char *PLX_GetAddrRangeName(P9030_ADDR addrSpace)
{
    return 
        addrSpace==P9030_ADDR_SPACE0 ? "Addr Space 0 - (BAR2)" :
        addrSpace==P9030_ADDR_SPACE1 ? "Addr Space 1 - (BAR3)" :
        addrSpace==P9030_ADDR_SPACE2 ? "Addr Space 2 - (BAR4)" :
        addrSpace==P9030_ADDR_SPACE3 ? "Addr Space 3 - (BAR5)" :
        addrSpace==P9030_ADDR_EPROM ? "EEPROM Addr Space" : "Invalid";
}

void PLX_BoardAccess(P9030_HANDLE hPlx, BOOL fLocalAddr)
{
    int cmd, cmd2, i;
    DWORD addr, data;
    P9030_ADDR ad_sp = P9030_ADDR_SPACE0;
    P9030_MODE ad_mode = P9030_MODE_DWORD;
    char *pcMemoryType = fLocalAddr ? "local address" : "offset";

    for (; ad_sp<=P9030_ADDR_EPROM && !P9030_IsAddrSpaceActive(hPlx, ad_sp); ad_sp++)
    if (ad_sp>P9030_ADDR_EPROM)
    {
        printf ("No active memory spaces on board!\n");
        return;
    }

    do
    {
        printf ("Access the board's %s ranges\n",pcMemoryType);
        printf ("-------------------------------------------\n");
        printf ("(Access to invalid %s may hang the computer!)\n", pcMemoryType);
        printf ("1. Change active memory space: %s\n",PLX_GetAddrRangeName(ad_sp));
        printf ("2. Toggle active mode: %s\n", 
            ad_mode==P9030_MODE_BYTE ? "BYTE (8 bit)" :
            ad_mode==P9030_MODE_WORD ? "WORD (16 bit)" : "DWORD (32 bit)");
        printf ("3. Read from board\n");
        printf ("4. Write to board\n");
        printf ("99. Back to main menu\n");
        printf ("\n");
        printf ("Enter option: ");
        cmd = 0;
        fgets(line, sizeof(line), stdin);
        sscanf (line, "%d",&cmd);
        switch (cmd)
        {
        case 1:
            printf ("Choose memory space:\n");
            printf ("--------------------\n");
            for (i=P9030_ADDR_SPACE0; i<=P9030_ADDR_EPROM; i++)
            {
                printf ("%d. %s", i, PLX_GetAddrRangeName(i));
                if (P9030_IsAddrSpaceActive(hPlx, i)) printf ("\n");
                else printf (" - space not active\n");
            }
            printf ("Enter option: ");
            cmd2 = 99;
            fgets(line, sizeof(line), stdin);
            sscanf (line, "%d",&cmd2);
            if (cmd2>=P9030_ADDR_SPACE0 && cmd2<=P9030_ADDR_EPROM)
            {
                int new_ad_sp = cmd2;
                if (P9030_IsAddrSpaceActive(hPlx, new_ad_sp)) ad_sp = new_ad_sp;
                else printf ("Chosen space not active!\n");
            }
            break;
        case 2:
            ad_mode = (ad_mode + 1) % 3;
            break;
        case 3:
            printf ("Enter %s to read from: ", pcMemoryType);
            fgets(line, sizeof(line), stdin);
            sscanf (line, "%x", &addr);
            switch (ad_mode)
            {
            case P9030_MODE_BYTE:
                if (fLocalAddr) data = P9030_ReadByte(hPlx, ad_sp, addr);
                else data = P9030_ReadSpaceByte(hPlx, ad_sp, addr);
                break;
            case P9030_MODE_WORD:
                if (fLocalAddr) data = P9030_ReadWord(hPlx, ad_sp, addr);
                else data = P9030_ReadSpaceWord(hPlx, ad_sp, addr);
                break;
            case P9030_MODE_DWORD:
                if (fLocalAddr) data = P9030_ReadDWord(hPlx, ad_sp, addr);
                else data = P9030_ReadSpaceDWord(hPlx, ad_sp, addr);
                break;
            }
            printf ("Value read: %x\n", data);
            break;
        case 4:
            printf ("Enter %s to write to: ", pcMemoryType);
            fgets(line, sizeof(line), stdin);
            sscanf (line, "%x", &addr);
            printf ("Enter data to write %s: ",
                ad_mode==P9030_MODE_BYTE ? "BYTE (8 bit)" :
                ad_mode==P9030_MODE_WORD ? "WORD (16 bit)" : "DWORD (32 bit)");
            fgets(line, sizeof(line), stdin);
            sscanf (line, "%x",&data);
            switch (ad_mode)
            {
            case P9030_MODE_BYTE:
                if (fLocalAddr) P9030_WriteByte(hPlx, ad_sp, addr, (BYTE) data);
                else P9030_WriteSpaceByte(hPlx, ad_sp, addr, (BYTE) data);
                break;
            case P9030_MODE_WORD:
                if (fLocalAddr) P9030_WriteWord(hPlx, ad_sp, addr, (WORD) data);
                else P9030_WriteSpaceWord(hPlx, ad_sp, addr, (WORD) data);
                break;
            case P9030_MODE_DWORD:
                if (fLocalAddr) P9030_WriteDWord(hPlx, ad_sp, addr, data);
                else P9030_WriteSpaceDWord(hPlx, ad_sp, addr, data);
                break;
            }
            break;
        }
    } while (cmd!=99);
}

void WINAPI PLX_IntHandlerRoutine(P9030_HANDLE hPlx, P9030_INT_RESULT *intResult)
{
    printf ("Got interrupt number %d\n", intResult->dwCounter);
}

void PLX_EnableDisableInterrupts(P9030_HANDLE hPlx)
{
    int cmd;