p9050_lib.c

adlink 6760主控板上控制plx pci slave的驱动

////////////////////////////////////////////////////////////////
// File - P9050_LIB.C
//
// Library for 'DriverBuilder for PLX 9050' API. 
// The basic idea is to get a handle for the board
// with P9050_Open() and use it in the rest of the program
// when calling WD functions.  Call P9050_Close() when done.
// 
////////////////////////////////////////////////////////////////

#include "p9050_lib.h"
#include "../../../include/windrvr_int_thread.h"
#include <stdio.h>

#define P9050_LIB_DEBUG
#undef P9050_LIB_DEBUG

#ifdef  P9050_LIB_DEBUG
    #define p9050_lib_printf printf
#else
    #define p9050_lib_printf
#endif        


// this string is set to an error message, if one occurs
CHAR P9050_ErrorString[1024];

// internal data structures
typedef struct
{
    WD_INTERRUPT Int;
    HANDLE hThread;
    WD_TRANSFER Trans[2];
    P9050_INT_HANDLER funcIntHandler;
} P9050_INTERRUPT;

typedef struct
{
    DWORD dwLocalBase;
    DWORD dwMask;
    DWORD dwBytes;
    DWORD dwAddr;
    DWORD dwAddrDirect;
    BOOL  fIsMemory;
} P9050_ADDR_DESC;

typedef struct P9050_STRUCT
{
    HANDLE hWD;
    WD_CARD cardLock;
    WD_PCI_SLOT pciSlot;
    WD_CARD_REGISTER cardReg;
    P9050_ADDR_DESC addrDesc[AD_PCI_BARS];
    P9050_INTERRUPT Int;
} P9050_STRUCT;

// internal function used by P9050_Open()
BOOL P9050_DetectCardElements(P9050_HANDLE hPlx);
// internal function used by P9050_Read... and P9050_Write... functions
void P9050_SetMode (P9050_HANDLE hPlx, P9050_ADDR addrSpace, DWORD dwLocalAddr);

DWORD P9050_CountCards (DWORD dwVendorID, DWORD dwDeviceID)
{
    //return 1;
   
    WD_VERSION ver;
    WD_PCI_SCAN_CARDS pciScan;
    HANDLE hWD = INVALID_HANDLE_VALUE;

    P9050_ErrorString[0] = '\0';
    hWD = WD_Open();
    // check if handle valid & version OK
    if (hWD==INVALID_HANDLE_VALUE) 
    {
        sprintf( P9050_ErrorString, "Failed opening " WD_PROD_NAME " device\n");
        return 0;
    }

    BZERO(ver);
    WD_Version(hWD,&ver);
    if (ver.dwVer<WD_VER) 
    {
        sprintf( P9050_ErrorString, "Incorrect " WD_PROD_NAME " version\n");
        WD_Close (hWD);
        return 0;
    }

    BZERO(pciScan);
    pciScan.searchId.dwVendorId = dwVendorID;
    pciScan.searchId.dwDeviceId = dwDeviceID;
    WD_PciScanCards (hWD, &pciScan);
    WD_Close (hWD);
    if (pciScan.dwCards==0)
        sprintf( P9050_ErrorString, "no cards found\n");
    return pciScan.dwCards;
	    
}


BOOL P9050_Open (P9050_HANDLE *phPlx, DWORD dwVendorID, DWORD dwDeviceID, DWORD nCardNum, DWORD options)
{
    P9050_HANDLE hPlx = (P9050_HANDLE) malloc (sizeof (P9050_STRUCT));

    WD_VERSION ver;
    WD_PCI_SCAN_CARDS pciScan;
    WD_PCI_CARD_INFO pciCardInfo;
    DWORD dwData;
    
    *phPlx = NULL;
    P9050_ErrorString[0] = '\0';
    BZERO(*hPlx);

    hPlx->hWD = WD_Open();
    
    // check if handle valid & version OK
    if (hPlx->hWD==INVALID_HANDLE_VALUE) 
    {
        sprintf( P9050_ErrorString, "Failed opening " WD_PROD_NAME " device\n");
        goto Exit;
    }

    BZERO(ver);
    WD_Version(hPlx->hWD,&ver);
    if (ver.dwVer<WD_VER) 
    {
        sprintf( P9050_ErrorString, "Incorrect " WD_PROD_NAME " version\n");
        goto Exit;
    }
    

    BZERO(pciScan);
    pciScan.searchId.dwVendorId = dwVendorID;
    pciScan.searchId.dwDeviceId = dwDeviceID;
    WD_PciScanCards (hPlx->hWD, &pciScan);
    if (pciScan.dwCards==0) // Found at least one card
    {
        sprintf( P9050_ErrorString, "Could not find PCI card\n");
        goto Exit;
    }
    if (pciScan.dwCards<=nCardNum)
    {
        sprintf( P9050_ErrorString, "Card out of range of available cards\n");
        goto Exit;
    }

    BZERO(pciCardInfo);
    pciCardInfo.pciSlot = pciScan.cardSlot[nCardNum];
    hPlx->pciSlot = pciCardInfo.pciSlot;


    if (options & P9050_OPEN_FIX_BIT7)
    {
        // this section fixes the BIT7 errata on PLX 9050 chip
        dwData = P9050_ReadPCIReg(hPlx, PCI_BAR0) & ~BIT7;
        P9050_WritePCIReg(hPlx, PCI_BAR0, dwData);
        // There is usually no need to fix also BAR1
        //dwData = P9050_ReadPCIReg(hPlx, PCI_BAR1) & ~BIT7;
        //P9050_WritePCIReg(hPlx, PCI_BAR1, dwData);
    }
    
    WD_PciGetCardInfo (hPlx->hWD, &pciCardInfo);
    hPlx->cardReg.Card = pciCardInfo.Card;

    hPlx->cardReg.fCheckLockOnly = FALSE;
    //WD_CardRegister (hPlx->hWD, &hPlx->cardReg); //commented by pgn
    WD_CardRegister (hPlx->hWD, hPlx);		   // replaced by pgn

    if (hPlx->cardReg.hCard==0)
    {
        sprintf ( P9050_ErrorString, "Failed locking device\n");
        goto Exit;
    }

    if (!P9050_DetectCardElements(hPlx))
    {
        sprintf ( P9050_ErrorString, "Card does not have all items expected for PLX 9050\n");
        goto Exit;
    }

    // Open finished OK
    *phPlx = hPlx;
    
    return TRUE;

Exit:
    // Error during Open
    if (hPlx->cardReg.hCard) 
        //WD_CardUnregister(hPlx->hWD, &hPlx->cardReg); // commented by pgn
        WD_CardUnregister(hPlx->hWD, hPlx);		// replaced by pgn
    if (hPlx->hWD!=INVALID_HANDLE_VALUE)
        WD_Close(hPlx->hWD);
    free (hPlx);
    return FALSE;
}


void P9050_GetPciSlot(P9050_HANDLE hPlx, WD_PCI_SLOT *pPciSlot)
{
    *pPciSlot = hPlx->pciSlot;
}


DWORD P9050_ReadPCIReg(P9050_HANDLE hPlx, DWORD dwReg)
{
    WD_PCI_CONFIG_DUMP pciCnf;
    DWORD dwVal;

    BZERO (pciCnf);
    pciCnf.pciSlot = hPlx->pciSlot;
    pciCnf.pBuffer = &dwVal;
    pciCnf.dwOffset = dwReg;
    pciCnf.dwBytes = 4;
    pciCnf.fIsRead = TRUE;
    WD_PciConfigDump(hPlx->hWD,&pciCnf);
    return dwVal;
}

void P9050_WritePCIReg(P9050_HANDLE hPlx, DWORD dwReg, DWORD dwData)
{
    WD_PCI_CONFIG_DUMP pciCnf;

    BZERO (pciCnf);
    pciCnf.pciSlot = hPlx->pciSlot;
    pciCnf.pBuffer = &dwData;
    pciCnf.dwOffset = dwReg;
    pciCnf.dwBytes = 4;
    pciCnf.fIsRead = FALSE;
    WD_PciConfigDump(hPlx->hWD,&pciCnf);
}

BOOL P9050_DetectCardElements(P9050_HANDLE hPlx)
{
	
    return TRUE;	// added by pgn
    /*
    DWORD i;
    DWORD ad_sp;
    
    BZERO(hPlx->Int);
    BZERO(hPlx->addrDesc);
    
    // added by pgn for debug use 
    p9050_lib_printf("hPlx->cardReg.Card.dwItems is 0x%x.\n\n",hPlx->cardReg.Card.dwItems);
    // added end by pgn

    for (i=0; i<hPlx->cardReg.Card.dwItems; i++)
    {
        WD_ITEMS *pItem = &hPlx->cardReg.Card.Item[i];

        switch (pItem->item)
        {
        case ITEM_MEMORY:
        case ITEM_IO:
            {
                DWORD dwBytes;
                DWORD dwAddr;
                DWORD dwAddrDirect = 0;
                DWORD dwPhysAddr;
                BOOL fIsMemory;
                if (pItem->item==ITEM_MEMORY)
                {
                    dwBytes = pItem->I.Mem.dwBytes;
                    dwAddr = pItem->I.Mem.dwTransAddr;
                    dwAddrDirect = pItem->I.Mem.dwUserDirectAddr;
                    dwPhysAddr = pItem->I.Mem.dwPhysicalAddr;
                    fIsMemory = TRUE;
                }
                else 
                {
                    dwBytes = pItem->I.IO.dwBytes;
                    dwAddr = pItem->I.IO.dwAddr;
                    dwPhysAddr = dwAddr & 0xffff;
                    fIsMemory = FALSE;
                }

                for (ad_sp=P9050_ADDR_REG; ad_sp<=P9050_ADDR_EPROM; ad_sp++)
                {
                    DWORD dwPCIAddr;
                    DWORD dwPCIReg;

                    if (hPlx->addrDesc[ad_sp].dwAddr) continue;
                    if (ad_sp==P9050_ADDR_REG) dwPCIReg = PCI_BAR0;
                    else if (ad_sp<P9050_ADDR_EPROM) 
                        dwPCIReg = PCI_BAR2 + 4*(ad_sp-P9050_ADDR_SPACE0);
                    else dwPCIReg = PCI_ERBAR;
                    dwPCIAddr = P9050_ReadPCIReg(hPlx, dwPCIReg);
                    if (dwPCIAddr & 1)
                    {
                        if (fIsMemory) continue;
                        dwPCIAddr &= 0x0ffffffc;
                        dwPhysAddr &= 0x0ffffffc;
                    }
                    else
                    {
                        if (!fIsMemory) continue;
                        dwPCIAddr &= ~0xf;
                    }
                    if (dwPCIAddr==dwPhysAddr)
                        break;
                }
                if (ad_sp<=P9050_ADDR_EPROM)
                {
                    DWORD j;
                    hPlx->addrDesc[ad_sp].dwBytes = dwBytes;
                    hPlx->addrDesc[ad_sp].dwAddr = dwAddr;
                    hPlx->addrDesc[ad_sp].dwAddrDirect = dwAddrDirect;
                    hPlx->addrDesc[ad_sp].fIsMemory = fIsMemory;
                    hPlx->addrDesc[ad_sp].dwMask = 0;
                    for (j=1; j<hPlx->addrDesc[ad_sp].dwBytes && j!=0x80000000; j *= 2)  
                    {
                        hPlx->addrDesc[ad_sp].dwMask = 
                            (hPlx->addrDesc[ad_sp].dwMask << 1) | 1;
                            
                    }
                    
                    // added begin by pgn for debug use
		    p9050_lib_printf(" hPlx->addrDesc[0x%d].dwBytes is 0x%x\n", ad_sp,hPlx->addrDesc[ad_sp].dwBytes);
		    p9050_lib_printf(" hPlx->addrDesc[0x%d].dwAddr is 0x%x\n", ad_sp,hPlx->addrDesc[ad_sp].dwAddr);
		    p9050_lib_printf(" hPlx->addrDesc[0x%d].dwAddrDirect is 0x%x\n", ad_sp,hPlx->addrDesc[ad_sp].dwAddrDirect);
		    p9050_lib_printf(" hPlx->addrDesc[0x%d].fIsMemory is 0x%x\n", ad_sp,hPlx->addrDesc[ad_sp].fIsMemory);
		    p9050_lib_printf(" hPlx->addrDesc[0x%d].dwMask is 0x%x\n", ad_sp,hPlx->addrDesc[ad_sp].dwMask);
		    p9050_lib_printf("\n\n"); 
		    // added end by pgn
                }
            
            }
            break;
            
        case ITEM_INTERRUPT:
            if (hPlx->Int.Int.hInterrupt) return FALSE;
            hPlx->Int.Int.hInterrupt = pItem->I.Int.hInterrupt;
            
            // added begin by pgn for debug use 
            p9050_lib_printf("pItem->I.Int.dwInterrupt is 0x%x.\n",pItem->I.Int.dwInterrupt);
            p9050_lib_printf("pItem->I.Int.dwOptions is 0x%x.\n",pItem->I.Int.dwOptions);
            p9050_lib_printf("pItem->I.Int.hInterrupt is 0x%x.\n\n",pItem->I.Int.hInterrupt);
            // added end by pgn
            
            
            break;
        }
    }

    // check that all the items needed were found
    // check if interrupt found
    if (!hPlx->Int.Int.hInterrupt) 
        return FALSE;

    // check that the registers space was found
    if (!P9050_IsAddrSpaceActive(hPlx, P9050_ADDR_REG))
            //|| hPlx->addrDesc[P9050_ADDR_REG].dwBytes!=P9050_RANGE_REG)
        return FALSE;

    // check that at least one memory space was found
    // for (i = P9050_ADDR_SPACE0; i<=P9050_ADDR_EPROM; i++)
    //     if (P9050_IsAddrSpaceActive(hPlx, i)) break;
    // if (i>P9050_ADDR_EPROM) return FALSE;

    return TRUE;
    */
    
}

void P9050_Close(P9050_HANDLE hPlx)