fs_flashprg.c

keil arm flash fs 最新版 在Ｋｅｉｌ ａｒｍ下使用

/*----------------------------------------------------------------------------
 *      R T L  -  F l a s h   F i l e   S y s t e m
 *----------------------------------------------------------------------------
 *      Name:    FS_FLASHPRG.C 
 *      Purpose: Flash Programming Functions - Dual Am29x800BB (32-bit Bus)
 *      Rev.:    V3.22
 *----------------------------------------------------------------------------
 *      This code is part of the RealView Run-Time Library.
 *      Copyright (c) 2004-2008 KEIL - An ARM Company. All rights reserved.
 *---------------------------------------------------------------------------*/

#include <File_Config.h>

#define M8(adr)  (*((volatile U8  *) (adr)))
#define M16(adr) (*((volatile U16 *) (adr)))
#define M32(adr) (*((volatile U32 *) (adr)))

U32 base_adr;

/* Embedded Flash programming/erase commands       */

#define RESET       0x00F000F0          /* reset command                     */
#define ERASE       0x00800080          /* erase command                     */
#define ERA_SECT    0x00300030          /* erase sector command              */
#define PROGRAM     0x00A000A0          /* write command                     */

#define DQ7         0x00800080          /* Flash Status Register bits        */
#define DQ6         0x00400040
#define DQ5         0x00200020
#define DQ3         0x00080008

/*----------------------------------------------------------------------------
 * Check if Program/Erase completed
 *    Parameter:      adr:  Block Start Address
 *    Return Value:   0 - OK
 *                    1 - Operation Failed
 *---------------------------------------------------------------------------*/

static int Q6Polling (U32 adr) {
   U32 fsreg;
   U32 dqold;
  
   fsreg = M32(adr);
   dqold = fsreg & DQ6;
   do {
      fsreg = M32(adr);
      if ((fsreg & DQ6) == dqold) {
         /* OK, Done. */
         return (0);
      }
      dqold = fsreg & DQ6;
   } while ((fsreg & DQ5) < DQ5);
   fsreg = M32(adr);
   dqold = fsreg & DQ6;
   fsreg = M32(adr);
   if ((fsreg & DQ6) == dqold) {
      /* OK, Done */
      return (0);
   }
   /* Error, Reset Flash Device */
   M32(adr) = RESET;
   return (1);
} /* end of Q6Polling */


/*----------------------------------------------------------------------------
 *  Initialize Flash Programming Functions
 *    Parameter:      adr:  Device Base Address
 *                    clk:  Clock Frequency (Hz)
 *    Return Value:   0 - Init OK
 *                    1 - Init Failed
 *---------------------------------------------------------------------------*/

int fs_Init (U32 adr, U32 clk)  {
   /* Supress compiler warning of unreferenced 'clk' */
   clk      = clk;
   base_adr = adr;
   return (0);
}


/*----------------------------------------------------------------------------
 *  Erase Sector in Flash Memory.  
 *    Parameter:      adr: Sector Address
 *    Return Value:   0 - Erase OK
 *                    1 - Erase Failed
 *---------------------------------------------------------------------------*/

int fs_EraseSector (U32 adr)  {
   U32 fsreg;

   M32(base_adr | (0xAAA << 1)) = 0x00AA00AA;
   M32(base_adr | (0x554 << 1)) = 0x00550055;
   M32(base_adr | (0xAAA << 1)) = ERASE;
   M32(base_adr | (0xAAA << 1)) = 0x00AA00AA;
   M32(base_adr | (0x554 << 1)) = 0x00550055;
   M32(adr) = ERA_SECT;

   /* Wait for Sector Erase Timeout. */
   do {
      fsreg = M32(adr);
   } while ((fsreg & DQ3) < DQ3);

   /* Wait until Erase Completed */
   return (Q6Polling (adr));
} /* end of fs_EraseSector */


/*----------------------------------------------------------------------------
 *  Program Page in Flash Memory.  
 *    Parameter:      adr:  Page Start Address
 *                    sz:   Page Size
 *                    buf:  Page Data
 *    Return Value:   0 - Program OK
 *                    1 - Program failed
 *---------------------------------------------------------------------------*/

int fs_ProgramPage (U32 adr, U32 sz, U8 *buf)  {

   for (  ; sz; sz -= 4, adr += 4, buf += 4)  {
      M32(base_adr | (0xAAA << 1)) = 0x00AA00AA;
      M32(base_adr | (0x554 << 1)) = 0x00550055;
      M32(base_adr | (0xAAA << 1)) = PROGRAM;
      /* 'buf' might be unaligned. */
      M32(adr) = *(__packed U32 *)buf;

      /* Wait until Programming completed */
      if (Q6Polling (adr)) {
         return (1);
      }
   }
   return (0);
} /* end of fs_ProgramPage */


/*----------------------------------------------------------------------------
 * end of file
 *---------------------------------------------------------------------------*/