flash_mtd.amd.c

MTK debug flash 兼容性的code

                     PageProgramCommand = 0xE5;
                  }
                  else
                  {
                     ProgramWords = 1;
                     PageProgramCommand = CMD_PROG;
                  }
                  
                  for(i = 0; i < ProgramWords*sizeof(FLASH_CELL); i++)
                  {
                     b[i] = bdp[j++];
                  }
 
                  savedMask = SaveAndSetIRQMask();
                  bp[ADDR_UNLOCK_1] = CMD_UNLOCK_1;
                  bp[ADDR_UNLOCK_2] = CMD_UNLOCK_2;
                  bp[ADDR_UNLOCK_1] = PageProgramCommand;
               
                  for(i = 0; i < ProgramWords; i++)
                  {
                  	fp[i] = prog_buffer[i];
                  }
      #ifdef _LOW_COST_SINGLE_BANK_FLASH_
                  WaitReady_AMD((kal_uint32)&fp[ProgramWords -1], (kal_uint16)prog_buffer[ProgramWords -1]);
                  RestoreIRQMask(savedMask);
      #elif defined(__SINGLE_BANK_NOR_FLASH_SUPPORT__)

                  NOR_FLASH_BUSY = KAL_TRUE;

                  #if defined(MT6205B)
                  if( kal_query_systemInit() || INT_QueryExceptionStatus() )
                  {
                     while(!CheckReadyAndResume_AMD((kal_uint32)&fp[ProgramWords -1], (kal_uint16)prog_buffer[ProgramWords-1]));
                  }
                  else
                  {
                     while(!CheckReadyAndResume_AMD((kal_uint32)&fp[ProgramWords -1], (kal_uint16)prog_buffer[ProgramWords-1]))
                     {
                        savedMask = CHECK_PENDING_IRQ(savedMask, (kal_uint32)&fp[ProgramWords -1]);
                     }
                  }

                  CHECK_LOG_STOP(sla_id[8])
                  RestoreIRQMask(savedMask);

                  #else /* !MT6205B */

                  RestoreIRQMask(savedMask);
                  while(!CheckReadyAndResume_AMD((kal_uint32)&fp[ProgramWords -1], (kal_uint16)prog_buffer[ProgramWords-1]));

                  CHECK_LOG_STOP(sla_id[8])
                  #endif /* MT6205B */
      #else               
                  RestoreIRQMask(savedMask);
                  WaitReady_AMD((kal_uint32)&fp[ProgramWords -1], (kal_uint16)prog_buffer[ProgramWords -1]);               
      #endif
                  Words -= ProgramWords;
                  fp += ProgramWords;
               }            }//while(Words > 0 )
#endif //__PAGE_BUFFER_PROGRAM__
         }
         else
         {
            FLASH_CELL *dp = (FLASH_CELL*)Data;
#ifndef __PAGE_BUFFER_PROGRAM__
            for(i = 0; i < Length/sizeof(FLASH_CELL); i++)
            {
               savedMask = SaveAndSetIRQMask();
               bp[ADDR_UNLOCK_1] = CMD_UNLOCK_1;
               bp[ADDR_UNLOCK_2] = CMD_UNLOCK_2;
               bp[ADDR_UNLOCK_1] = CMD_PROG;
               fp[i] = dp[i];
#ifdef _LOW_COST_SINGLE_BANK_FLASH_
               WaitReady_AMD((kal_uint32)&fp[i], (kal_uint16)dp[i]);
               RestoreIRQMask(savedMask);
#else
               RestoreIRQMask(savedMask);
               WaitReady_AMD((kal_uint32)&fp[i], (kal_uint16)dp[i]);               
#endif
            }
#else //__PAGE_BUFFER_PROGRAM__
            Words = (Length/sizeof(FLASH_CELL));
            while(Words > 0 )
            {
{
                  kal_uint16 PageProgramCommand;
                  if ((Words >= 32)&& (!((kal_uint32)fp & (32*sizeof(FLASH_CELL)-1))))
                  {
                     ProgramWords = 32;
                     PageProgramCommand = 0xE8;
                  }
                  else if ((Words >= 16)&& (!((kal_uint32)fp & (16*sizeof(FLASH_CELL)-1))))
                  {
                     ProgramWords = 16;
                     PageProgramCommand = 0xE7;
                  }
                  else if ((Words >= 8)&& (!((kal_uint32)fp & (8*sizeof(FLASH_CELL)-1))))
                  {
                     ProgramWords = 8;
                     PageProgramCommand = 0xE6;
                  }
                  else if ((Words >= 4)&& (!((kal_uint32)fp & (4*sizeof(FLASH_CELL)-1))))
                  {
                     ProgramWords = 4;
                     PageProgramCommand = 0xE5;
                  }
                  else
                  {
                     ProgramWords = 1;
                     PageProgramCommand = CMD_PROG;
                  }
                  
                  savedMask = SaveAndSetIRQMask();
                  bp[ADDR_UNLOCK_1] = CMD_UNLOCK_1;
                  bp[ADDR_UNLOCK_2] = CMD_UNLOCK_2;
                  bp[ADDR_UNLOCK_1] = PageProgramCommand;
               
                  for(i = 0; i < ProgramWords; i++)
                  {
                     fp[i] = dp[i];
                  }
      #ifdef _LOW_COST_SINGLE_BANK_FLASH_
                  WaitReady_AMD((kal_uint32)&fp[ProgramWords -1], (kal_uint16)dp[ProgramWords -1]);
                  RestoreIRQMask(savedMask);
      #elif defined(__SINGLE_BANK_NOR_FLASH_SUPPORT__)

                  NOR_FLASH_BUSY = KAL_TRUE;

                 #if defined(MT6205B)
                 if( kal_query_systemInit() || INT_QueryExceptionStatus() )
                 {
                    while(!CheckReadyAndResume_AMD((kal_uint32)&fp[ProgramWords -1], (kal_uint16)dp[ProgramWords -1]));
                 }
                 else
                 {
                    while(!CheckReadyAndResume_AMD((kal_uint32)&fp[ProgramWords -1], (kal_uint16)dp[ProgramWords -1]))
                    {
                       savedMask = CHECK_PENDING_IRQ(savedMask, (kal_uint32)&fp[ProgramWords -1]);
                    }
                 }

                 CHECK_LOG_STOP(sla_id[10])
                 RestoreIRQMask(savedMask);

                 #else /*!MT6205B*/

                 RestoreIRQMask(savedMask);
                 while(!CheckReadyAndResume_AMD((kal_uint32)&fp[ProgramWords -1], (kal_uint16)dp[ProgramWords -1]));

                 CHECK_LOG_STOP(sla_id[10])
                 #endif /*MT6205B*/
      #else               
                  RestoreIRQMask(savedMask);
                  WaitReady_AMD((kal_uint32)&fp[ProgramWords -1], (kal_uint16)dp[ProgramWords -1]);            
      #endif
                  Words -= ProgramWords;
                  fp += ProgramWords;
                  dp += ProgramWords;                  
               }            }//while(Words > 0 )
#endif  //__PAGE_BUFFER_PROGRAM__
         }
      }
      break;
   }
   return FS_NO_ERROR;
}

static int ProgramData_TOSHIBA_TY_NOPBP(void * DriveData, void * Address, void * Data, kal_uint32 Length)
{
   kal_uint32 savedMask;
#ifndef __NOR_FDM5__
   NOR_Flash_MTD_Data * D = DriveData;
   volatile FLASH_CELL *bp = (volatile FLASH_CELL *) (D->CurrAddr);
   ASSERT((~D->Signature == (kal_uint32)D->RegionInfo));
#else
   NOR_MTD_DATA *D= DriveData;
   NORLayoutInfo * Layout = D->LayoutInfo;
   volatile FLASH_CELL *bp = (volatile FLASH_CELL *)((kal_uint32)Address&(~((Layout->BlkSize-1))));
   ASSERT(D->Signature == ~((kal_uint32)D->LayoutInfo));
#endif   
   
   #ifdef DEBUG
   //can't write zero bytes into flash
   ASSERT(Length != 0);
   #endif

   switch (Length)
   {
      case sizeof(FLASH_CELL):
         #if defined(DEBUG)
            //Misaligned write into flash
            ASSERT(!(((kal_uint32)Address) % sizeof(FLASH_CELL)));
         #endif

         #ifdef DEBUG
         //Attempt to set bits in flash!
         ASSERT(!(~((volatile FLASH_CELL*)Address)[0] & ((FLASH_CELL*)Data)[0]));
         #endif

         savedMask = SaveAndSetIRQMask();
         bp[ADDR_UNLOCK_1] = CMD_UNLOCK_1;
         bp[ADDR_UNLOCK_2] = CMD_UNLOCK_2;
         bp[ADDR_UNLOCK_1] = CMD_PROG;
         ((volatile FLASH_CELL*)Address)[0] = ((FLASH_CELL*)Data)[0];
#ifdef _LOW_COST_SINGLE_BANK_FLASH_
         WaitReady_AMD((kal_uint32)Address, *(kal_uint16*)Data);
         RestoreIRQMask(savedMask);         
#elif defined(__SINGLE_BANK_NOR_FLASH_SUPPORT__)

         NOR_FLASH_BUSY = KAL_TRUE;

         #if defined(MT6205B)
         if( kal_query_systemInit() || INT_QueryExceptionStatus() )
         {
            while(!CheckReadyAndResume_AMD((kal_uint32)Address, *(kal_uint16*)Data));
         }
         else
         {
            while(!CheckReadyAndResume_AMD((kal_uint32)Address, *(kal_uint16*)Data))
            {
               savedMask = CHECK_PENDING_IRQ(savedMask, (kal_uint32)Address);
            }
         }

         CHECK_LOG_STOP(sla_id[5])
         RestoreIRQMask(savedMask);

         #else /* !MT6205B */

         RestoreIRQMask(savedMask);
         while(!CheckReadyAndResume_AMD((kal_uint32)Address, *(kal_uint16*)Data));

         CHECK_LOG_STOP(sla_id[5])
         #endif /* MT6205B */
#else
         RestoreIRQMask(savedMask);
         WaitReady_AMD((kal_uint32)Address, *(kal_uint16*)Data);
#endif
         break;

      case 1:
      {
         volatile FLASH_CELL *fp;
         kal_uint32 ofs = ((kal_uint32) Address) & (sizeof(FLASH_CELL)-1);
         FLASH_CELL Cell;
         kal_uint8 *b = (kal_uint8*) &Cell;

         fp   = (void*) (((kal_uint32) Address) & ~(sizeof(FLASH_CELL)-1)); // round it down
         Cell = fp[0];

         b[ofs] = ((kal_uint8*)Data)[0];

         #ifdef DEBUG
         //Attempt to set bits in flash!
         ASSERT(!((~fp[0]) & Cell))
         #endif

         savedMask = SaveAndSetIRQMask();
         bp[ADDR_UNLOCK_1] = CMD_UNLOCK_1;
         bp[ADDR_UNLOCK_2] = CMD_UNLOCK_2;
         bp[ADDR_UNLOCK_1] = CMD_PROG;
         fp[0]     = Cell;
#ifdef _LOW_COST_SINGLE_BANK_FLASH_
         WaitReady_AMD((kal_uint32)fp, (kal_uint16)Cell);
         RestoreIRQMask(savedMask);
#elif defined(__SINGLE_BANK_NOR_FLASH_SUPPORT__)

         NOR_FLASH_BUSY = KAL_TRUE;

         #if defined(MT6205B)
         if( kal_query_systemInit() || INT_QueryExceptionStatus() )
         {
            while(!CheckReadyAndResume_AMD((kal_uint32)Address, (kal_uint16)Cell));
         }
         else
         {
            while(!CheckReadyAndResume_AMD((kal_uint32)Address, (kal_uint16)Cell))
            {
               savedMask = CHECK_PENDING_IRQ(savedMask, (kal_uint32)Address);
            }
         }

         CHECK_LOG_STOP(sla_id[5])
         RestoreIRQMask(savedMask);

         #else /* !MT6205B */

         RestoreIRQMask(savedMask);
         while(!CheckReadyAndResume_AMD((kal_uint32)Address, (kal_uint16)Cell));

         CHECK_LOG_STOP(sla_id[5])
         #endif /* MT6205B */
#else         
         RestoreIRQMask(savedMask);
         WaitReady_AMD((kal_uint32)fp, (kal_uint16)Cell);
#endif
      }
      break;
   default:
      #ifdef DEBUG
         //Misaligned write into flash
         ASSERT(!(((kal_uint32)Address) % sizeof(FLASH_CELL)));
         //Misaligned length write into flash
         ASSERT(!(Length % sizeof(FLASH_CELL)));
      #endif
      #ifdef DEBUG
      {
         kal_uint32 i;
         volatile FLASH_CELL *fp = (void*) Address;
         FLASH_CELL * V = Data;

         for (i=0; i<Length/sizeof(FLASH_CELL); i++)
            ASSERT(!((~fp[i]) & V[i]));//Attempt to set bits in flash!
      }
      #endif

      {
         kal_uint32 i, j=0;
         volatile FLASH_CELL *fp;

         fp = (volatile FLASH_CELL *)Address;
         if((((kal_uint32)Data) % sizeof(FLASH_CELL)))
         {
            kal_uint8 *bdp =  (kal_uint8*)Data;
            FLASH_CELL Cell;
            kal_uint8 *b = (kal_uint8*)&Cell;
//#ifndef __PAGE_BUFFER_PROGRAM__
            for(i = 0; i < Length/sizeof(FLASH_CELL); i++)
            {
               b[0] = bdp[j++];
               b[1] = bdp[j++];
               savedMask = SaveAndSetIRQMask();
               bp[ADDR_UNLOCK_1] = CMD_UNLOCK_1;
               bp[ADDR_UNLOCK_2] = CMD_UNLOCK_2;
               bp[ADDR_UNLOCK_1] = CMD_PROG;
               fp[i] = Cell;
#ifdef _LOW_COST_SINGLE_BANK_FLASH_
               WaitReady_AMD((kal_uint32)&fp[i], (kal_uint16)Cell);
               RestoreIRQMask(savedMask);
#elif defined(__SINGLE_BANK_NOR_FLASH_SUPPORT__)

               NOR_FLASH_BUSY = KAL_TRUE;

               #if defined(MT6205B)
               if( kal_query_systemInit() || INT_QueryExceptionStatus() )
               {
                  while(!CheckReadyAndResume_AMD((kal_uint32)Address, (kal_uint16)Cell));
               }
               else
               {
                  while(!CheckReadyAndResume_AMD((kal_uint32)Address, (kal_uint16)Cell))
                  {
                     savedMask = CHECK_PENDING_IRQ(savedMask, (kal_uint32)Address);
                  }
               }

               CHECK_LOG_STOP(sla_id[5])
               RestoreIRQMask(savedMask);

               #else /* !MT6205B */

               RestoreIRQMask(savedMask);
               while(!CheckReadyAndResume_AMD((kal_uint32)Address, (kal_uint16)Cell));

               CHECK_LOG_STOP(sla_id[5])
               #endif /* MT6205B */
#else               
               RestoreIRQMask(savedMask);
               WaitReady_AMD((kal_uint32)&fp[i], (kal_uint16)Cell);
#endif
            } /* end of for loop */
         }
         else
         {
            FLASH_CELL *dp = (FLASH_CELL*)Data;
//#ifndef __PAGE_BUFFER_PROGRAM__
            for(i = 0; i < Length/sizeof(FLASH_CELL); i++)
            {
               savedMask = SaveAndSetIRQMask();
               bp[ADDR_UNLOCK_1] = CMD_UNLOCK_1;
               bp[ADDR_UNLOCK_2] = CMD_UNLOCK_2;
               bp[ADDR_UNLOCK_1] = CMD_PROG;
               fp[i] = dp[i];
#ifdef _LOW_COST_SINGLE_BANK_FLASH_
               WaitReady_AMD((kal_uint32)&fp[i], (kal_uint16)dp[i]);
               RestoreIRQMask(savedMask);
#else
               RestoreIRQMask(savedMask);
               WaitReady_AMD((kal_uint32)&fp[i], (kal_uint16)dp[i]);               
#endif
            }
         }
      }
      break;
   }
   return FS_NO_ERROR;
}

extern volatile kal_uint32 processing_irqCnt;
void CompareData(void * Address, void * Data, kal_uint32 Length)
{
    kal_uint32 i;

    if((kal_uint32)Address&0x3==0 && (kal_uint32)Data&0x3==0)
    {
       kal_uint32* Source = (kal_uint32*)Address;
       kal_uint32* Dest = (kal_uint32*)Data;

       for(i=0;i<(Length>>2);i++)
       {
          if(Source[i] != Dest[i])
             EXT_ASSERT(0,0,0,0