nand_util.c

<B>SMSC USB2.0 Flash硬盘驱动源码</B>

/*============================================================================
  ____________________________________________________________________________
                                ______________________________________________
   SSSS  M   M          CCCC          Standard Microsystems Corporation
  S      MM MM   SSSS  C                    Austin Design Center
   SSS   M M M  S      C                 11000 N. Mopac Expressway
      S  M   M   SSS   C                Stonelake Bldg. 6, Suite 500
  SSSS   M   M      S   CCCC                Austin, Texas 78759
                SSSS            ______________________________________________
  ____________________________________________________________________________
  Copyright(C) 1999, Standard Microsystems Corporation
  All Rights Reserved.
  This program code listing is proprietary to SMSC and may not be copied,
  distributed, or used without a license to do so.  Such license may have
  Limited or Restricted Rights. Please refer to the license for further
  clarification.
  ____________________________________________________________________________
  Notice: The program contained in this listing is a proprietary trade
  secret of SMSC, Hauppauge, New York, and is copyrighted
  under the United States Copyright Act of 1976 as an unpublished work,
  pursuant to Section 104 and Section 408 of Title XVII of the United
  States code. Unauthorized copying, adaption, distribution, use, or
  display is prohibited by this law.
  ____________________________________________________________________________
  Use, duplication, or disclosure by the Government is subject to
  restrictions as set forth in subparagraph(c)(1)(ii) of the Rights
  in Technical Data and Computer Software clause at DFARS 52.227-7013.
  Contractor/Manufacturer is Standard Microsystems Corporation,
  80 Arkay Drive, Hauppauge, New York, 1178-8847.
  ____________________________________________________________________________
  ____________________________________________________________________________
  nand.c - nand flash fixed media mass storage class implementation
  ____________________________________________________________________________
  comments tbd
  ____________________________________________________________________________
  Revision History
  Date      Who  Comment
  ________  ___  _____________________________________________________________
  08/28/02  cds  initial version to debug smart media corruption
  10/17/02  cds  - project-wide lun data & vtbl paging to reduce code space.           
                 - removed g_active_media from _lun_data, _lun_() virtual functions    
                 - added _lun_data_rd() and _lun_data_wr() macros to bypass lun paging 
                 - added lun_set_active(log_lun) function to switch luns               
 ============================================================================*/

#include "project.h"
#include "dev.h"

//-----------------------------------------------------------------------------
// bit control macros
//-----------------------------------------------------------------------------
static code char k_tbl_bitdata[] = { 0x01,0x02,0x04,0x08,0x10,0x20,0x40,0x80} ;
#define _setbit(__buffer,__bitaddr) (__buffer[(uint8)((__bitaddr)/8)] |=  k_tbl_bitdata[(__bitaddr)%8])
#define _clrbit(__buffer,__bitaddr) (__buffer[(uint8)((__bitaddr)/8)] &= ~k_tbl_bitdata[(__bitaddr)%8])
#define _chkbit(__buffer,__bitaddr) (__buffer[(uint8)((__bitaddr)/8)] &   k_tbl_bitdata[(__bitaddr)%8])
#define _flpbit(__buffer,__bitaddr) (__buffer[(uint8)((__bitaddr)/8)] ^=  k_tbl_bitdata[(__bitaddr)%8])


extern t_result sm_media_erase_card() reentrant ;
extern uint16 map_log2phy(uint16 log) reentrant ;
extern xdata uint8 g_sector_buffer[];

t_log2phy_map_ref _log_map(uint8 __zone) reentrant;
t_assign_map_ref _assign_map( uint8 __zone ) reentrant;

static xdata t_log2phy_map_ref  _l2p_map;
static xdata t_assign_map_ref   _a_map;


#if 0

static code uint8 k_tbl_sm_media_cis_512[512] =
{
  0x01,0x03,0xd9,0x01,0xff,0x18,0x02,0xdf,0x01,0x20,0x04,0x00,0x00,0x00,0x00,0x21,
  0x02,0x04,0x01,0x22,0x02,0x01,0x01,0x22,0x03,0x02,0x04,0x07,0x1a,0x05,0x01,0x03,
  0x00,0x02,0x0f,0x1b,0x08,0xc0,0xc0,0xa1,0x01,0x55,0x08,0x00,0x20,0x1b,0x0a,0xc1,
  0x41,0x99,0x01,0x55,0x64,0xf0,0xff,0xff,0x20,0x1b,0x0c,0x82,0x41,0x18,0xea,0x61,
  0xf0,0x01,0x07,0xf6,0x03,0x01,0xee,0x1b,0x0c,0x83,0x41,0x18,0xea,0x61,0x70,0x01,
  0x07,0x76,0x03,0x01,0xee,0x15,0x14,0x05,0x00,0x20,0x20,0x20,0x20,0x20,0x20,0x20,
  0x00,0x20,0x20,0x20,0x20,0x00,0x30,0x2e,0x30,0x00,0xff,0x14,0x00,0xff,0x00,0x00,
  0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
  0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
  0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
  0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
  0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
  0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
  0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
  0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
  0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
  0x01,0x03,0xd9,0x01,0xff,0x18,0x02,0xdf,0x01,0x20,0x04,0x00,0x00,0x00,0x00,0x21,
  0x02,0x04,0x01,0x22,0x02,0x01,0x01,0x22,0x03,0x02,0x04,0x07,0x1a,0x05,0x01,0x03,
  0x00,0x02,0x0f,0x1b,0x08,0xc0,0xc0,0xa1,0x01,0x55,0x08,0x00,0x20,0x1b,0x0a,0xc1,
  0x41,0x99,0x01,0x55,0x64,0xf0,0xff,0xff,0x20,0x1b,0x0c,0x82,0x41,0x18,0xea,0x61,
  0xf0,0x01,0x07,0xf6,0x03,0x01,0xee,0x1b,0x0c,0x83,0x41,0x18,0xea,0x61,0x70,0x01,
  0x07,0x76,0x03,0x01,0xee,0x15,0x14,0x05,0x00,0x20,0x20,0x20,0x20,0x20,0x20,0x20,
  0x00,0x20,0x20,0x20,0x20,0x00,0x30,0x2e,0x30,0x00,0xff,0x14,0x00,0xff,0x00,0x00,
  0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
  0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
  0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
  0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
  0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
  0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
  0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
  0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
  0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00
} ;

//+-----------------------------------------------------------------------------
// Name:
//   k_tbl_sm_media_cis_512()
//
// Purpose:
//   default table data for restoring 512 + 16 byte media
//------------------------------------------------------------------------------
static code uint8 k_tbl_sm_media_cis_flash_edata[16] =
{
  0xff,0xff,0xff,0xff,0xff,0xff,0x00,0x00,0x0c,0xcc,0xc3,0x00,0x00,0x0c,0xcc,0xc3
} ;



t_result util_blank_smart_media_card(void) reentrant
{
  uint8* buf ;
  trace0(0, util, 0, "repairing card...") ;

  g_addr_wr_phy_blk = 0 ;
  g_addr_zone = 0 ;
  g_addr_page = 0 ;

  for ( g_addr_wr_phy_blk=0;
        g_addr_wr_phy_blk<(_media_data(physical_blocks_per_zone)-_media_data(logical_blocks_per_zone)-1);
        g_addr_wr_phy_blk++)
  {
    mcu_begin_critical_section() ;
    trace1(0, util, 0, "erasing phy_block %d", g_addr_wr_phy_blk) ;
    mcu_end_critical_section() ;

    // do erase here, because "erase_block" will prevent you from erasing the boot block
    if (k_success != sm_media_erase_block())
    {
      trace0(0, sm_media, 0, "repair card... failed to erase block") ;
      continue;
    }

  
/*
    _sm_wr_cmd_begin(k_sm_erase1);
    _media_set_erase_addr();
    _sm_set_wr_cmd(k_sm_erase2);
    if (k_success != sm_wait_rdy_with_timeout(k_sm_busy_erase_timeout))
    {
      trace0(0, sm_media, 0, "failed to erase block") ;
    }
    _sm_hw_set_wr_standby();
    _sm_hw_set_rd_standby();
*/

    for ( g_addr_page=0; g_addr_page < k_sm_max_cis_sect; g_addr_page++)
    {
      trace2(0, sm, 0, "attempting to write cis data to phy_blk %d sector %d", g_addr_wr_phy_blk, g_addr_page) ;
      // write the default data
      memcpy(g_sector_buffer, k_tbl_sm_media_cis_512, 512) ;
      memcpy(x_sm_redt_data,  k_tbl_sm_media_cis_flash_edata, 16) ;
      _media_data(sector_buffer) = g_sector_buffer ;
//      fmc_dbg_dump_sector(_media_data(sector_buffer)) ;
      sm_media_write_sector() ;
      _media_data(sector_buffer) = g_sector_buffer ;

      g_addr_rd_phy_blk = g_addr_wr_phy_blk ;
      // read it back
      sm_media_read_sector() ;
      if(0==memcmp(g_sector_buffer, k_tbl_sm_media_cis_512, 512))
      {
        trace0(0, sm_media, 0, "success!") ;
        _media_data(boot_block) = g_addr_wr_phy_blk ;
        _media_data(boot_page) = g_addr_page ;
        sm_media_erase_card() ;
        _media_data(sector_buffer) = buf ;
        return k_success ;
      }
/*
      else
      {
        fmc_dbg_dump_sector(g_sector_buffer) ;
      }
*/      
    }
    g_addr_page = 0 ;
    sm_media_set_phyblock_failed() ;
  }
  return k_error ;
}
#endif


//------------------------------------------------------------------------------
//------------------------------------------------------------------------------
void util_trace_buffer(uint8* sector, uint16 size) reentrant
{
  uint16 i;

  _mcu_begin_critical_section();
  for (i=0;i<size/8;i++)
  {
    trace5(0, util, 0, "%04X: %04x%04x %04x%04x", (i*8), ( ((uint16*)sector)[i*4]), (((uint16*)sector)[i*4+1]), (((uint16*)sector)[i*4+2]), (((uint16*)sector)[i*4+3]));
  }
  _mcu_end_critical_section();
}

//------------------------------------------------------------------------------
//------------------------------------------------------------------------------
void util_trace_ms_extra_data() reentrant
{
  trace0(0, util, 0, "--- not implemented") ;
}

//------------------------------------------------------------------------------
//------------------------------------------------------------------------------
void util_trace_nand_extra_data() reentrant
{
  trace0(0, util, 0, "--- extra data --------------") ;
  util_trace_buffer(x_sm_redt_data, 16) ;
}

//------------------------------------------------------------------------------
//------------------------------------------------------------------------------
void util_trace_page() reentrant
{
  trace1(0, util, 0, "--- Page:%d --------------", g_addr_page) ;
  trace3(0, util, 0, "--- nand_page: %02x%02x%02x -------------", g_nand_rd_addr_msb, g_nand_rd_addr_mid, g_nand_rd_addr_lsb) ;
  _media_data(sector_buffer) = g_sector_buffer ;
  _media_read_extra_data() ;
  if(_media_is_phyblock_blank())
  {
    trace0(0, util, 0, "****** blank ******") ;
  }
  else
  {
    for(g_addr_segment=0;
        g_addr_segment<_media_data(segments_per_page);
        g_addr_segment++)
    {
      trace1(0, util, 0, "--- Segment: %d ----------", g_addr_segment);

      _media_read_sector() ;

      util_trace_buffer(g_sector_buffer, 512) ;
      if(g_active_media==k_ix_media_ms)
      {
        util_trace_ms_extra_data() ;
      }
      else
      {
        util_trace_nand_extra_data() ;
      }
    }
  }
  trace1(0, util, 0, "--- Page:%d End-----------", g_addr_page) ;
}

//------------------------------------------------------------------------------
//------------------------------------------------------------------------------
void util_trace_map_data() reentrant
{
	trace0(0, util, 0, "----------- Media Parameters -------------------") ;
	trace1(0, util, 0, "num_zones: %d", _media_data(num_zones)) ;
	trace1(0, util, 0, "physical_blocks_per_zone    :%d", _media_data(physical_blocks_per_zone));
	trace1(0, util, 0, "logical_blocks_per_zone     :%d", _media_data(logical_blocks_per_zone)) ;
	trace1(0, util, 0, "logical_blocks_per_boot_zone:%d", _media_data(logical_blocks_per_boot_zone)) ;
	trace1(0, util, 0, "pages_per_block  :%d", _media_data(pages_per_block)); 
	trace1(0, util, 0, "segments_per_page:%d", _media_data(segments_per_page)) ;
	trace1(0, util, 0, "zones_per_chip   :%d", g_nand_zones_per_chip) ;
}


//------------------------------------------------------------------------------
//------------------------------------------------------------------------------
void util_trace_phy_block() reentrant
{
  trace1(0, util, 0, "--- Phy Blk:%d -------------------", g_addr_rd_phy_blk) ;
  g_addr_page=0 ;
  g_addr_segment=0 ;
  nand_rd_va2pa() ;
  for(;g_addr_page < _media_data(pages_per_block);g_addr_page++)
  {
    util_trace_page() ;
    nand_incr_addr() ;
  }
  trace1(0, util, 0, "--- Phy Blk:%d End ---------------", g_addr_rd_phy_blk) ;
}

//------------------------------------------------------------------------------
//------------------------------------------------------------------------------
void util_trace_zone() reentrant
{
  trace1(0, util, 0, "--- Zone:%d --------------------", g_addr_zone) ;
  for(g_addr_rd_phy_blk=0; 
      g_addr_rd_phy_blk< _media_data(physical_blocks_per_zone) ; 
      g_addr_rd_phy_blk++)
  {
    util_trace_phy_block() ;
  }
  trace1(0, util, 0, "--- Zone:%d End ----------------", g_addr_zone) ;
}

//------------------------------------------------------------------------------
//------------------------------------------------------------------------------
void util_trace_media() reentrant
{
  trace0(0, util, 0, "--- Media Image -------------------") ;
  for(g_addr_zone=0 ; g_addr_zone<_media_data(num_zones); g_addr_zone++)
  {
    if(g_active_media != k_ix_media_sm)
    {
      nand_select_card() ;
    }
    util_trace_zone() ;
  }
  trace0(0, util, 0, "--- Media Image End ---------------") ;
}

//------------------------------------------------------------------------------
//------------------------------------------------------------------------------
#if 0 
void util_trace_log_blk() reentrant
{
  trace1(0, util, 0, "--- Logical Block:%d --------------",g_addr_log_blk) ;
  {
    g_addr_rd_phy_blk=map_log2phy(g_addr_log_blk);
    if(g_addr_rd_phy_blk != k_block_free)
      util_trace_phy_block() ;
  }
  trace1(0, util, 0, "--- Logical Block:%d End ----------",g_addr_log_blk) ;
}

//------------------------------------------------------------------------------
//------------------------------------------------------------------------------
void util_trace_log_zone() reentrant
{
  uint16 _max_lb ;

  trace0(0, util, 0, "--- Log2Phy Map Zone:%d -----------") ;
  map_build_sector_map();
  _max_lb = g_addr_zone?_media_data(logical_blocks_per_zone):_media_data(logical_blocks_per_boot_zone);
  for(g_addr_log_blk=0; g_addr_log_blk<_max_lb;g_addr_log_blk++)
  {
    util_trace_log_blk() ;
  }
  trace0(0, util, 0, "--- Log2Phy Map Zone:%d End -------") ;
}

//------------------------------------------------------------------------------
//------------------------------------------------------------------------------
void util_trace_log_media() reentrant
{
  trace0(0, util, 0, "--- Media Map -------------------") ;

  for(g_addr_zone=0;g_addr_zone<_media_data(num_zones);g_addr_zone++)
  {
    util_trace_log_zone() ;
  }
  trace0(0, util, 0, "--- Media Map End ---------------") ;
}

//------------------------------------------------------------------------------
//------------------------------------------------------------------------------
void util_trace_map_block() reentrant
{
  g_addr_page=0 ;
  g_addr_segment=0 ;
  if ((!g_addr_zone) && (g_addr_rd_phy_blk <= _media_data(boot_block)))
  {
    trace1(0, util, 0, "block %d:  reserved (boot block)", g_addr_rd_phy_blk) ;
    return ;
  }
  if (k_success != _media_read_extra_data() )
  {
    trace1(0, util, 0, "block %d:  not in use - error reading extra data", g_addr_rd_phy_blk) ;
    return ;
  }
  if( _media_is_phyblock_blank() )
  {
    trace1(0, util, 0, "block %d:  blank", g_addr_rd_phy_blk) ;
    return ;
  }

  // skip bad block
  if( !_media_is_phyblock_ok() )