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

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

VxWorks

开发平台：

C/C++

flash28f320DrvLib.c：源码内容
  1. #include "vxWorks.h"
  2. #include "taskLib.h"
  3. #include "stdlib.h"
  4. #include "stdio.h"
  5. #include "string.h"
  6. #include "ctype.h"
  7. #include "config.h"
  8. #include "flashDrvLib.h"
  10. #ifdef MBZ
  11. #define xor_val 0x3
  12. #else
  13. #define xor_val 0x0
  14. #endif
  16. #define FLASH_ADDR(dev, addr) 
  17.     ((volatile UINT8 *) (((int)(dev) + (int)(addr)) ^ xor_val))
  19. #define FLASH_WRITE(dev, addr, value) 
  20.     (*FLASH_ADDR(dev, addr) = (value))
  22. #define FLASH_READ(dev, addr) 
  23.     (*FLASH_ADDR(dev, addr))
  25. LOCAL void
  26. flashReadReset(void)
  27. {
  28.     FLASH_WRITE(FLASH_BASE_ADDRESS, 0x000, 0xff);
  29. }
  31. LOCAL void
  32. flashAutoSelect(FLASH_TYPES *dev, FLASH_VENDORS *vendor)
  33. {
  34.     flashReadReset();
  35.     FLASH_WRITE(FLASH_BASE_ADDRESS, 0x000, 0x90);
  37.     *vendor = FLASH_READ(FLASH_BASE_ADDRESS, 0);
  38.     *dev = FLASH_READ(FLASH_BASE_ADDRESS, 2);
  40.     if (flashVerbose) {
  41.         printf("flashAutoSelect(): dev = 0x%x, vendor = 0x%xn",
  42.                (int)*dev, (int)*vendor);
  43.     }
  44.     flashReadReset();
  45.     if ((*dev != FLASH_2F320) || (*vendor != INTEL)) {
  46.         *vendor = *dev = 0xFF;
  47.     }
  48. }
  50. LOCAL int
  51. flashEraseDevices(volatile UINT8 *sectorBasePtr)
  52. {
  53.     int             i;
  54.     unsigned int    tmp = 0;
  56.     if (flashVerbose) {
  57.         printf("Erasing Sector @ 0x%08xn",(UINT32)sectorBasePtr);
  58.     }
  59.     FLASH_WRITE(FLASH_BASE_ADDRESS, 0x0, 0xFF);
  60.     FLASH_WRITE(FLASH_BASE_ADDRESS, 0x0, 0x50);
  61.     FLASH_WRITE(sectorBasePtr, 0x000, 0x20);
  62.     FLASH_WRITE(sectorBasePtr, 0x000, 0xd0);
  63.     FLASH_WRITE(FLASH_BASE_ADDRESS, 0x0, 0x70);
  65.     for (i = 0; i < FLASH_ERASE_TIMEOUT_COUNT; i++) {
  66.         taskDelay(FLASH_ERASE_TIMEOUT_TICKS);
  68.         tmp = FLASH_READ(FLASH_BASE_ADDRESS, 0x0);
  70.         if ((tmp & 0x80) == 0x80) {
  71.             break;
  72.         }
  73.     }
  75.     flashReadReset();
  76.     if ((tmp & 0xa0) != 0x80) {
  77.         printf("flashEraseDevices(): addr 0x%08x erase failedn",
  78.            (int)sectorBasePtr);
  79.         return (ERROR);
  80.     }
  81.     return (OK);
  82. }
  84. LOCAL int
  85. flashEraseSector(int sectorNum)
  86. {
  87.     UINT8 *sectorBasePtr = (UINT8 *)FLASH_SECTOR_ADDRESS(sectorNum);
  89.     if (sectorNum < 0 || sectorNum >= flashSectorCount) {
  90.         printf("flashEraseSector(): Sector %d invalidn", sectorNum);
  91.         return (ERROR);
  92.     }
  94.     if (flashEraseDevices(sectorBasePtr) == ERROR) {
  95.         printf("flashEraseSector(): erase devices failed sector=%dn",
  96.                sectorNum);
  97.         return (ERROR);
  98.     }
  100.     if (flashVerbose)
  101.         printf("flashEraseSector(): Sector %d erasedn", sectorNum);
  103.     return (OK);
  104. }
  106. LOCAL int
  107. flashRead(int sectorNum, char *buff,
  108.     unsigned int offset, unsigned int count)
  109. {
  110.     flashReadReset();
  111.     if (sectorNum < 0 || sectorNum >= flashSectorCount) {
  112.         printf("flashRead(): Illegal sector %dn", sectorNum);
  113.         return (ERROR);
  114.     }
  116.     bcopy((char *)(FLASH_SECTOR_ADDRESS(sectorNum) + offset), buff, count);
  118.     return (0);
  119. }
  121. LOCAL int
  122. flashProgramDevices(volatile UINT8 *addr, UINT8 val)
  123. {
  124.     int             polls;
  125.     unsigned char    tmp;
  127.     FLASH_WRITE(FLASH_BASE_ADDRESS, 0x000, 0x50);
  128.     FLASH_WRITE(FLASH_BASE_ADDRESS, 0x000, 0xFF);
  129.     FLASH_WRITE(FLASH_BASE_ADDRESS, 0x000, 0x40);
  130.     /* FLASH_WRITE(addr, 0x0, val);*/
  131.     *addr = val;
  132.     FLASH_WRITE(FLASH_BASE_ADDRESS, 0x000, 0x70);
  134.     for (polls = 0; polls < FLASH_PROGRAM_TIMEOUT_POLLS; polls++) {
  135.         tmp = FLASH_READ(FLASH_BASE_ADDRESS, 0x0);
  137.         if ((tmp & 0x80) == 0x80) {
  138.             break;
  139.         }
  140.     }
  142.     flashReadReset();
  143.     if ((tmp & 0x90) != 0x80) {
  144.         printf("flashProgramDevices(): Address 0x%08x program failedn",
  145.                (int)addr);
  146.         return (ERROR);
  147.     } else {
  148.         return (OK);
  149.     }
  151. }
  153. LOCAL int
  154. flashWrite(int sectorNum, char *buff,
  155.             unsigned int offset, unsigned int count)
  156. {
  157.     UINT8   *curBuffPtr, *flashBuffPtr;
  158.     int             i;
  160.     curBuffPtr = (UINT8 *)buff;
  161.     flashBuffPtr = (UINT8 *)(FLASH_SECTOR_ADDRESS(sectorNum) + offset);
  163.     for (i = 0; i < count; i++) {
  164.         if (flashProgramDevices(flashBuffPtr, *curBuffPtr) == ERROR) {
  165.             printf("flashWrite(): Failed: Sector %d, address 0x%xn",
  166.                sectorNum, (int)flashBuffPtr);
  167.             return (ERROR);
  168.         }
  170.         flashBuffPtr++;
  171.         curBuffPtr++;
  172.     }
  174.     return (0);
  175. }
  177. struct flash_drv_funcs_s flash28f320 = {
  178.     FLASH_2F320, INTEL,
  179.     flashAutoSelect,
  180.     flashEraseSector,
  181.     flashRead,
  182.     flashWrite
  183. };