VxWorks

开发平台：
C/C++

flash29l160DrvLib.c：源码内容
							#include "vxWorks.h"
#include "taskLib.h"
#include "stdlib.h"
#include "stdio.h"
#include "string.h"
#include "ctype.h"
#include "config.h"
#include "flashDrvLib.h"
#ifdef MBZ
#define xor_val 0x3
#else
#define xor_val 0x0
#endif
#define FLASH_ADDR(dev, addr) 
    ((volatile UINT8 *) (((int)(dev) + (int)(addr)) ^ xor_val))
#define FLASH_WRITE(dev, addr, value) 
    (*FLASH_ADDR(dev, addr) = (value))
#define FLASH_READ(dev, addr) 
    (*FLASH_ADDR(dev, addr))
extern struct flash_drv_funcs_s flash29l160;
LOCAL void
flashReadReset(void)
{
    FLASH_WRITE(FLASH_BASE_ADDRESS, 0xaaa, 0xf0);
}
LOCAL void
flashAutoSelect(FLASH_TYPES *dev, FLASH_VENDORS *vendor)
{
    flashReadReset();   
    FLASH_WRITE(FLASH_BASE_ADDRESS, 0xaaa, 0xaa);
    FLASH_WRITE(FLASH_BASE_ADDRESS, 0x555, 0x55);
    FLASH_WRITE(FLASH_BASE_ADDRESS, 0xaaa, 0x90);
    *vendor = FLASH_READ(FLASH_BASE_ADDRESS, 0);
    *dev = FLASH_READ(FLASH_BASE_ADDRESS, 2);
    if (flashVerbose)
        printf("flashAutoSelect(): dev = 0x%x, vendor = 0x%xn",
               (int)*dev, (int)*vendor);
    flashReadReset();   
    if ((*dev != FLASH_2L160) || ((*vendor != AMD) && (*vendor != ALLIANCE))) {
        *vendor = *dev = 0xFF;
    }
}
LOCAL int
flashEraseDevices(volatile unsigned char *sectorBasePtr)
{
    int             i;
    unsigned int    tmp;
    if (flashVerbose) {
        printf("Erasing Sector @ 0x%08xn",(unsigned int)sectorBasePtr);
    }
    FLASH_WRITE(FLASH_BASE_ADDRESS, 0xaaa, 0xaa);
    FLASH_WRITE(FLASH_BASE_ADDRESS, 0x555, 0x55);
    FLASH_WRITE(FLASH_BASE_ADDRESS, 0xaaa, 0x80);
    FLASH_WRITE(FLASH_BASE_ADDRESS, 0xaaa, 0xaa);
    FLASH_WRITE(FLASH_BASE_ADDRESS, 0x555, 0x55);
    FLASH_WRITE(sectorBasePtr, 0x0, 0x30);
    for (i = 0; i < FLASH_ERASE_TIMEOUT_COUNT; i++) {
        taskDelay(FLASH_ERASE_TIMEOUT_TICKS);
        tmp = FLASH_READ(sectorBasePtr, 0x0);
        if ((tmp & 0x80) == 0x80) {
            if (flashVerbose > 1)
                printf("flashEraseDevices(): all devices erasedn");
            return (OK);
        }
    }
    if ((tmp & 0x20) == 0x20) {
        printf("flashEraseDevices(): addr 0x%08x erase failedn",
           (int)sectorBasePtr);
    } else {
        printf("flashEraseDevices(): addr 0x%08x erase timed outn",
           (int)sectorBasePtr);
    }
    flashReadReset();
    return (ERROR);
}
LOCAL int
flashEraseSector(int sectorNum)
{
    unsigned char   *sectorBasePtr =
	(unsigned char *)FLASH_SECTOR_ADDRESS(sectorNum);
    if (sectorNum < 0 || sectorNum >= flashSectorCount) {
        printf("flashEraseSector(): Sector %d invalidn", sectorNum);
        return (ERROR);
    }
    if (flashEraseDevices(sectorBasePtr) == ERROR) {
        printf("flashEraseSector(): erase devices failed sector=%dn",
               sectorNum);
        return (ERROR);
    }
    /* Boot Sectored devices need multiple erases in sector 0 Sector 0 is
     * broken up into 16k, 8k, 8k, 32k sub sectors. Each one must have an
     * erase issued in that sub sector to erase all of logical sector 0. */
    if (sectorNum == 0) {
        if (flashEraseDevices(sectorBasePtr + 0x4000) == ERROR) {
            printf("flashEraseSector(): erase devices failed sector=0.1n");
            return (ERROR);
        }
        if (flashEraseDevices(sectorBasePtr + 0x6000) == ERROR) {
            printf("flashEraseSector(): erase devices failed sector=0.2n");
            return (ERROR);
        }
        if (flashEraseDevices(sectorBasePtr + 0x8000) == ERROR) {
            printf("flashEraseSector(): erase devices failed sector=0.3n");
            return (ERROR);
        }
    }
    if (flashVerbose)
        printf("flashEraseSector(): Sector %d erasedn", sectorNum);
    return (OK);
}
LOCAL int
flashRead(int sectorNum, char *buff, unsigned int offset, unsigned int count)
{
    if (sectorNum < 0 || sectorNum >= flashSectorCount) {
        printf("flashRead(): Illegal sector %dn", sectorNum);
        return (ERROR);
    }
    bcopy((char *)(FLASH_SECTOR_ADDRESS(sectorNum) + offset), buff, count);
    return (0);
}
LOCAL int
flashProgramDevices(volatile unsigned char *addr, unsigned char val)
{
    int             polls;
    unsigned char    tmp;
    FLASH_WRITE(FLASH_BASE_ADDRESS, 0xaaa, 0xaa);
    FLASH_WRITE(FLASH_BASE_ADDRESS, 0x555, 0x55);
    FLASH_WRITE(FLASH_BASE_ADDRESS, 0xaaa, 0xa0);
    /* FLASH_WRITE(addr, 0x0, val);*/
    *addr = val;
    for (polls = 0; polls < FLASH_PROGRAM_TIMEOUT_POLLS; polls++) {
        tmp = *addr;
        if ((tmp & 0x80) == (val & 0x80)) {
            if (flashVerbose > 2)
                printf("flashProgramDevices(): devices programmedn");
            return (OK);
        }
    }
    if ((tmp & 0x20) != 0) {
	/* 
	 * We've already waited so long that chances are nil that the
	 * 0x80 bits will change again.  Don't bother re-checking them.
	 */
		printf("flashProgramDevices(): Address 0x%08x program failedn",
		       (int)addr);
    } else {
        printf("flashProgramDevices(): timed outn");
    }
    flashReadReset();
    return (ERROR);
}
LOCAL int
flashWrite(int sectorNum, char *buff, unsigned int offset, unsigned int count)
{
    unsigned char   *curBuffPtr, *flashBuffPtr;
    int             i;
    curBuffPtr = (unsigned char *)buff;
    flashBuffPtr = (unsigned char *)(FLASH_SECTOR_ADDRESS(sectorNum) + offset);
    for (i = 0; i < count; i++) {
        if (flashProgramDevices(flashBuffPtr, *curBuffPtr) == ERROR) {
            printf("flashWrite(): Failed: Sector %d, address 0x%xn",
               sectorNum, (int)flashBuffPtr);
            return (ERROR);
        }
        flashBuffPtr++;
        curBuffPtr++;
    }
    return (0);
}
struct flash_drv_funcs_s flash29l160 = {
    FLASH_2L160, AMD,
    flashAutoSelect,
    flashEraseSector,
    flashRead,
    flashWrite
};

						