开通博客赚积分
发布资源赚积分
分类

源码开发语言/平台
当前位置：首页 > 源码/资料 > 嵌入式/单片机编程 > VxWorks > 查看源码
flashDrvLib.c
资源名称：bcm4702.rar　[点击查看]
上传用户：yuanda199
上传日期：2022-06-26
资源大小：412k
文件大小：12k
源码类别：

VxWorks

开发平台：

C/C++

flashDrvLib.c：源码内容
  1. /*
  2.  * $Id: flashDrvLib.c,v 1.2 Broadcom SDK $
  3.  * $Copyright: (c) 2001-2003, 2004 Broadcom Corp.
  4.  * All Rights Reserved.$
  5.  *
  6.  * File:    flashDrvLib.c
  7.  */
  9. #include "vxWorks.h"
  10. #include "taskLib.h"
  11. #include "stdlib.h"
  12. #include "stdio.h"
  13. #include "string.h"
  14. #include "ctype.h"
  15. #include "config.h"
  16. #include "flashDrvLib.h"
  18. #define TOTAL_LOADED_SECS  3
  20. int             flashVerbose = 0; /* DEBUG */
  21. unsigned int    flashBaseAddress = 0;
  22. int             flashSize = 0x200000;
  23. int             flashDevSectorSize = 0x10000;
  24. int             flashSectorCount = 0;
  25. LOCAL struct flash_drv_funcs_s *flashDrvFuncs = &flash28f320;
  27. LOCAL struct flashLoadedSectorInfo {
  28.     SEM_ID fsSemID;
  29.     int   sector;
  30.     int   dirty;
  31.     char *buffer;
  32. } flashLoadedSectors[TOTAL_LOADED_SECS];
  34. #define FS_CACHE_LOCK(_x_) 
  35.     semTake(flashLoadedSectors[(_x_)].fsSemID, WAIT_FOREVER)
  36. #define FS_CACHE_UNLOCK(_x_) 
  37.     semGive(flashLoadedSectors[(_x_)].fsSemID)
  39. LOCAL int
  40. flashFlushLoadedSector(int number)
  41. {
  42.     if (flashLoadedSectors[number].sector < 0 ||
  43.         !flashLoadedSectors[number].dirty) {
  44.         if (flashVerbose)
  45.             printf("flashFlushLoadedSector(%d): not dirtyn", number);
  46.         return (OK);
  47.     }
  49.     if (flashVerbose) {
  50.         printf("flashFlushLoadedSector(%d): Flushing %dn", number,
  51.                 flashLoadedSectors[number].sector);
  52.     }
  54.     if (flashDrvFuncs->flashEraseSector(flashLoadedSectors[number].sector)==ERROR) {
  55.         return (ERROR);
  56.     }
  58.     if (flashDrvFuncs->flashWrite(flashLoadedSectors[number].sector,
  59.             flashLoadedSectors[number].buffer, 0, FLASH_SECTOR_SIZE) == ERROR) {
  60.         return (ERROR);
  61.     }
  63.     if (flashVerbose) {
  64.         printf("                           Flushing %d donen",
  65.                 flashLoadedSectors[number].sector);
  66.     }
  68.     flashLoadedSectors[number].sector = -1;
  69.     flashLoadedSectors[number].dirty = 0;
  71.     return (OK);
  72. }
  74. int
  75. flashDrvLibInit(void)
  76. {
  77.     FLASH_TYPES     dev;
  78.     FLASH_VENDORS   vendor;
  79.     int i;
  81.     flashBaseAddress = FLASH_BASE_ADDRESS_FLASH_BOOT;
  83.     flashDrvFuncs = &flash29l160;
  84.     flashDrvFuncs->flashAutoSelect(&dev, &vendor);
  85.     if ((vendor == 0xFF) && (dev == 0xFF)) {
  86.         flashDrvFuncs = &flash28f320;
  87.         flashDrvFuncs->flashAutoSelect(&dev, &vendor);
  88.     }
  90.     switch (vendor) {
  91.         case AMD:
  92.         case ALLIANCE:
  93.         switch (dev) {
  94.             case FLASH_2F040:
  95.                 flashSectorCount = 8;
  96.                 flashDevSectorSize = 0x10000;
  97.                 if (flashVerbose)
  98.                     printf("flashInit(): 2F040 Foundn");
  99.                 break;
  100.             case FLASH_2F080:
  101.                 flashSectorCount = 16;
  102.                 flashDevSectorSize = 0x10000;
  103.                 if (flashVerbose)
  104.                     printf("flashInit(): 2F080 Foundn");
  105.                 break;
  107.             case FLASH_2L081:
  108.                 flashSectorCount = 16;
  109.                 flashDevSectorSize = 0x10000;
  110.                 if (flashVerbose)
  111.                     printf("flashInit(): 29LV081B Foundn");
  112.                 break;
  114.             case FLASH_2L160:
  115.             case FLASH_2L017:
  116.                 flashSectorCount = 32;
  117.                 flashDevSectorSize = 0x10000;
  118.                 if (flashVerbose)
  119.                     printf("flashInit(): 29LV160D Foundn");
  120.                 break;
  122.             default:
  123.                 printf("flashInit(): Unrecognized Device (0x%02X)n", dev);
  124.                 return (ERROR);
  125.         }
  126.         break;
  128.         case INTEL:
  129.         switch (dev) {
  130.             case FLASH_2F320:
  131.                 flashSectorCount = 32;
  132.                 flashDevSectorSize = 0x20000;
  133.                 if (flashVerbose)
  134.                     printf("flashInit(): 28F320 Foundn");
  135.                 break;
  137.             default:
  138.                 printf("flashInit(): Unrecognized Device (0x%02X)n", dev);
  139.                 return (ERROR);
  140.         }
  141.         break;
  142.         default:
  143.             printf("flashInit(): Unrecognized Vendor (0x%02X)n", vendor);
  144.             return (ERROR);
  145.     }
  146.     flashSize = flashDevSectorSize * flashSectorCount;
  148.     for (i = 0; i < TOTAL_LOADED_SECS; i++) {
  149.         flashLoadedSectors[i].buffer = malloc(FLASH_SECTOR_SIZE);
  150.         if (flashLoadedSectors[i].buffer == NULL) {
  151.             printf("flashInit(): malloc() failedn");
  152.             for (; i > 0; i--) {
  153.                 free(flashLoadedSectors[i-1].buffer);
  154.             }
  155.             return (ERROR);
  156.         }
  157.         flashLoadedSectors[i].sector = -1;
  158.         flashLoadedSectors[i].dirty = 0;
  159.         flashLoadedSectors[i].fsSemID =
  160.             semMCreate (SEM_Q_PRIORITY | SEM_DELETE_SAFE);
  161.     }
  163.     return (OK);
  164. }
  166. int
  167. flashGetSectorCount(void)
  168. {
  169.     return (flashSectorCount);
  170. }
  172. int
  173. flashEraseBank(int firstSector, int nSectors)
  174. {
  175.     int             sectorNum, errCnt = 0;
  177.     if (firstSector < 0 || firstSector + nSectors > flashSectorCount) {
  178.         printf("flashEraseBank(): Illegal parms %d, %dn",
  179.            firstSector, nSectors);
  180.         return ERROR;
  181.     }
  183.     for (sectorNum = firstSector;
  184.          sectorNum < firstSector + nSectors; sectorNum++) {
  185.          printf(".");
  187.         if (flashDrvFuncs->flashEraseSector(sectorNum))
  188.             errCnt++;
  189.     }
  191.     printf("n");
  193.     if (errCnt)
  194.         return (ERROR);
  195.     else
  196.         return (OK);
  197. }
  199. int
  200. flashBlkRead(int sectorNum, char *buff,
  201.          unsigned int offset, unsigned int count)
  202. {
  203.     int i;
  205.     if (sectorNum < 0 || sectorNum >= flashSectorCount) {
  206.         printf("flashBlkRead(): Sector %d invalidn", sectorNum);
  207.         return (ERROR);
  208.     }
  210.     if (offset < 0 || offset >= FLASH_SECTOR_SIZE) {
  211.         printf("flashBlkRead(): Offset 0x%x invalidn", offset);
  212.         return (ERROR);
  213.     }
  215.     if (count < 0 || count > FLASH_SECTOR_SIZE - offset) {
  216.         printf("flashBlkRead(): Count 0x%x invalidn", count);
  217.         return (ERROR);
  218.     }
  220.     /*
  221.      * If the sector is loaded, read from it.  Else, read from the
  222.      * flash itself (slower).
  223.      */
  224.     for (i = 0; i < TOTAL_LOADED_SECS; i++) {
  225.         if (flashLoadedSectors[i].sector == sectorNum) {
  226.             if (flashVerbose)
  227.                 printf("flashBlkRead(): from loaded sector %dn", sectorNum);
  228.             bcopy(&flashLoadedSectors[i].buffer[offset], buff, count);
  229.             return (OK);
  230.         }
  231.     }
  233.     flashDrvFuncs->flashRead(sectorNum, buff, offset, count);
  235.     return (OK);
  236. }
  238. LOCAL int
  239. flashCheckCanProgram(int sectorNum, unsigned int offset, unsigned int count)
  240. {
  241.     unsigned char   *flashBuffPtr;
  242.     int             i;
  244.     flashBuffPtr = (unsigned char *)(FLASH_SECTOR_ADDRESS(sectorNum) + offset);
  246.     for (i = 0; i < count; i++) {
  247.         if (flashBuffPtr[i] != 0xff)
  248.             return (ERROR);
  249.     }
  251.     return (OK);
  252. }
  254. int
  255. flashBlkWrite(int sectorNum, char *buff,
  256.           unsigned int offset, unsigned int count)
  257. {
  258.     char *save;
  259.     int i;
  261.     if (sectorNum < 0 || sectorNum >= flashSectorCount) {
  262.         printf("flashBlkWrite(): Sector %d invalidn", sectorNum);
  263.         return (ERROR);
  264.     }
  266.     if (offset < 0 || offset >= FLASH_SECTOR_SIZE) {
  267.         printf("flashBlkWrite(): Offset 0x%x invalidn", offset);
  268.         return (ERROR);
  269.     }
  271.     /* 
  272.      * Count must be within range and must be a long word multiple, as
  273.      * we always program long words.
  274.      */
  276.     if ((count < 0) || 
  277.         (count > ((flashSectorCount - sectorNum) * FLASH_SECTOR_SIZE - offset))) {
  278.         printf("flashBlkWrite(): Count 0x%x invalidn", count);
  279.         return (ERROR);
  280.     }
  282.     /*
  283.      * If the Sector is loaded, write it to buffer.  Else check to see
  284.      * if we can program the sector; if so, program it.  Else, flush the
  285.      * first loaded sector (if loaded and dirty), push loaded sectors
  286.      * up by one, load the new one and copy the data into the last one.
  287.      */
  289.     for (i = 0; i < TOTAL_LOADED_SECS; i++) {
  290.         FS_CACHE_LOCK(i);
  291.         if (flashLoadedSectors[i].sector == sectorNum) {
  292.             if (flashVerbose)
  293.                 printf("%d ", sectorNum);
  294.             bcopy(buff, &flashLoadedSectors[i].buffer[offset], count);
  295.             flashLoadedSectors[i].dirty = 1;
  296.             FS_CACHE_UNLOCK(i);
  297.             return (OK);
  298.         }
  299.         FS_CACHE_UNLOCK(i);
  300.     }
  302.     if (flashCheckCanProgram(sectorNum, offset, count) != ERROR) {
  303.         return (flashDrvFuncs->flashWrite(sectorNum, buff, offset, count));
  304.     }
  306.     FS_CACHE_LOCK(0);
  307.     if (flashFlushLoadedSector(0) == ERROR) {
  308.         FS_CACHE_UNLOCK(0);
  309.         return (ERROR);
  310.     }
  311.     FS_CACHE_UNLOCK(0);
  313.     save = flashLoadedSectors[0].buffer;
  314.     for (i = 1; i < TOTAL_LOADED_SECS; i++) {
  315.         FS_CACHE_LOCK(i-1);
  316.         flashLoadedSectors[i-1].sector = flashLoadedSectors[i].sector;
  317.         flashLoadedSectors[i-1].dirty  = flashLoadedSectors[i].dirty;
  318.         flashLoadedSectors[i-1].buffer = flashLoadedSectors[i].buffer;
  319.         FS_CACHE_UNLOCK(i-1);
  320.     }
  321.     i--;
  322.     flashLoadedSectors[i].buffer = save;
  324.     FS_CACHE_LOCK(i);
  325.     if (flashDrvFuncs->flashRead(sectorNum, flashLoadedSectors[i].buffer,
  326.                                  0, FLASH_SECTOR_SIZE) == ERROR) {
  327.         flashLoadedSectors[i].sector = -1;
  328.         FS_CACHE_UNLOCK(i);
  329.         return (ERROR);
  330.     }
  332.     flashLoadedSectors[i].sector = sectorNum;
  333.     bcopy(buff, &flashLoadedSectors[i].buffer[offset], count);
  334.     flashLoadedSectors[i].dirty = 1;
  335.     FS_CACHE_UNLOCK(i);
  337.     if (flashVerbose) {
  338.         printf("flashBlkWrite(): load %d (and write to cache only)n", sectorNum);
  339.         printf("%d ", sectorNum);
  340.     }
  342.     return (OK);
  343. }
  345. int
  346. flashDiagnostic(void)
  347. {
  348.     unsigned int   *flashSectorBuff;
  349.     int             sectorNum, i;
  351.     /*
  352.      * Probe flash; allocate flashLoadedSector Buffer
  353.      */
  355.     flashDrvLibInit();        /* Probe; clear loaded sector */
  357.     flashSectorBuff = (unsigned int *) flashLoadedSectors[0].buffer;
  359.     if (flashVerbose)
  360.         printf("flashDiagnostic(): Executing. Erasing %d Sectorsn",
  361.                 flashSectorCount);
  363.     if (flashEraseBank(0, flashSectorCount) == ERROR) {
  364.     if (flashVerbose)
  365.         printf("flashDiagnostic(): flashEraseBank() #1 failedn");
  367.     return (ERROR);
  368.     }
  370.     /* Write unique counting pattern to each sector. */
  371.     for (sectorNum = 0; sectorNum < flashSectorCount; sectorNum++) {
  372.     if (flashVerbose)
  373.         printf("flashDiagnostic(): writing sector %dn", sectorNum);
  375.     for (i = 0; i < FLASH_SECTOR_SIZE / sizeof (unsigned int); i++)
  376.         flashSectorBuff[i] = (i + sectorNum);
  378.     if (flashDrvFuncs->flashWrite(sectorNum, (char *)flashSectorBuff,
  379.                0, FLASH_SECTOR_SIZE) == ERROR) {
  380.         if (flashVerbose)
  381.         printf("flashDiagnostic(): flashWrite() failed on %dn",
  382.                sectorNum);
  384.         return (ERROR);
  385.     }
  386.     }
  388.     /* Verify each sector. */
  389.     for (sectorNum = 0; sectorNum < flashSectorCount; sectorNum++) {
  390.     if (flashVerbose)
  391.         printf("flashDiagnostic(): verifying sector %dn", sectorNum);
  393.     if (flashDrvFuncs->flashRead(sectorNum, (char *)flashSectorBuff,
  394.               0, FLASH_SECTOR_SIZE) == ERROR) {
  395.         if (flashVerbose)
  396.         printf("flashDiagnostic(): flashRead() failed on %dn",
  397.                sectorNum);
  399.         return (ERROR);
  400.     }
  402.     for (i = 0; i < FLASH_SECTOR_SIZE / sizeof (unsigned int); i++) {
  403.         if (flashSectorBuff[i] != (i + sectorNum)) {
  404.         if (flashVerbose) {
  405.             printf("flashDiagnostic(): verification failedn");
  406.             printf("flashDiagnostic(): sector %d, offset 0x%xn",
  407.                sectorNum, (i * sizeof(unsigned int)));
  408.             printf("flashDiagnostic(): expected 0x%x, got 0x%xn",
  409.                (i + sectorNum), (int)flashSectorBuff[i]);
  410.         }
  412.         return (ERROR);
  413.         }
  414.     }
  415.     }
  417.     if (flashEraseBank(0, flashSectorCount) == ERROR) {
  418.     if (flashVerbose)
  419.         printf("flashDiagnostic(): flashEraseBank() #2 failedn");
  421.         return (ERROR);
  422.     }
  424.     if (flashVerbose)
  425.         printf("flashDiagnostic(): Completed without errorn");
  427.     return (OK);
  428. }
  430. int
  431. flashSyncFilesystem(void)
  432. {
  433.     int i;
  435.     for (i = 0; i < TOTAL_LOADED_SECS; i++) {
  436.         FS_CACHE_LOCK(i);
  437.         if (flashFlushLoadedSector(i) != OK) {
  438.             FS_CACHE_UNLOCK(i);
  439.             return (ERROR);
  440.         }
  441.         FS_CACHE_UNLOCK(i);
  442.     }
  444.     return (OK);
  445. }