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

源码开发语言/平台
当前位置：首页 > 源码/资料 > 多媒体 > DVD > 查看源码
wt_flash.c
资源名称：ST_5105DTV.rar　[点击查看]
上传用户：fy98168
上传日期：2015-06-26
资源大小：13771k
文件大小：90k
源码类别：

DVD

开发平台：

C/C++

wt_flash.c：源码内容
  1. /****************************************************************************
  3. File Name   : tt_flash.c
  5. Description : Testtool FLASH Commands
  7. Copyright (C) 2004, ST Microelectronics
  8.  
  9. ****************************************************************************/
  11. /* Includes --------------------------------------------------------------- */
  12. /* Standard Includes */
  13. #include <stdio.h>
  14. #include <stddef.h>
  15. #include <stdlib.h>
  16. #include <string.h>
  17. #include <debug.h>
  18. #include "stack.h"
  19. #include "stlite.h"
  20. #include "stddefs.h"
  21. #include "stdevice.h"
  23. /* STAPI Includes */
  24. #include "stflash.h"
  25. #include "sttbx.h"
  26. #include "testtool.h"
  28. /* Local Includes */
  29. #include "wts_app_data.h"
  30. #include "wts_flash.h"
  32. /* Private Types ------------------------------------------------------ */
  34. /* Private Constants -------------------------------------------------- */
  35. #define FREMONT
  38. /* Definitions for Flash */
  39. #if 0
  40. #define FLASH_BANK_0_BASE_ADDRESS_LOCAL 0x40000000 /* check this as it should be 7f80000 */
  41. #define WTFLASH_BANK_0_BASE     FLASH_BANK_0_BASE_ADDRESS_LOCAL  /*FLASH_BANK_0_BASE_ADDRESS*/
  42. #endif
  44. #ifdef ST_5105
  45. #define STFLASH_VPP_0_ENABLE    0x45200000
  46. #elif defined(ST_5100)
  47. #define STFLASH_VPP_0_ENABLE    0x41400000
  48. #endif
  50. #define WTFLASH_MAIN_SIZE 0x00010000  /*0x10000 = 64Kbytes *//*0x00020000*/
  51. #define WTFLASH_MAIN01_SIZE             0x00008000  /* 32Kb */
  52. #define WTFLASH_PARA_0_SIZE             0x00002000  /* 8Kb */
  53. #define WTFLASH_BOOT_0_SIZE             0x00004000  /* 16Kb */
  57. /* if BANK_1 defined it is available */
  58. #if defined(FLASH_BANK_1_BASE_ADDRESS)
  59.     #define STFLASH_BANK_1_BASE     FLASH_BANK_1_BASE_ADDRESS
  60.     #define NUM_BANKS               2
  61. #else
  62.     #define NUM_BANKS               1
  63. #endif
  65. /* if VPP not defined it is not needed */
  66. #if !defined(STFLASH_VPP_0_ENABLE)
  67.     #define STFLASH_VPP_0_ENABLE    (U32)NULL
  68. #endif
  70. #if !defined(STFLASH_VPP_1_ENABLE)
  71.     #define STFLASH_VPP_1_ENABLE    (U32)NULL
  72. #endif
  74. /*#define DEVICE_TYPE             STFLASH_M29W160BT*/
  75. #define DEVICE_TYPE             STFLASH_M29W320DT
  77. #define MIN_ACCESS_WIDTH        STFLASH_ACCESS_16_BITS
  78. #define MAX_ACCESS_WIDTH        STFLASH_ACCESS_16_BITS
  80. #define wtNUM_BLOCKS           135//35
  82. #define wtNUM_SECTIONS             wtNUM_BLOCKS /*24*/
  85. #define wtTOTAL_BLOCKS            ( wtNUM_BLOCKS)
  87. #define CR                      13
  88. #define LF                      10
  90. #define wtCODE_BLOCKS 16
  91. #define wtFIRST_CODE_BLOCK 0
  93. #define wtLANG_BLOCKS 8
  94. #define wtFIRST_LANG_BLOCK 16
  96. #define wtLNB_BLOCKS 2
  97. #define wtFIRST_LNB_BLOCK 24
  99. #define wtLOGO_BLOCKS 1
  100. #define wtFIRST_LOGO_BLOCK 31
  103. /* Private Variables -------------------------------------------------- */
  104. #if 1
  105. /* ------------------------STFLASH_M29W640DT-------------------------- */
  106. STFLASH_Block_t      BlockData_s[wtNUM_BLOCKS] =
  107.  {
  108.   {WTFLASH_MAIN_SIZE  , STFLASH_MAIN_BLOCK }, /* 1 */
  109.   {WTFLASH_MAIN_SIZE  , STFLASH_MAIN_BLOCK }, /* 2 */
  110.   {WTFLASH_MAIN_SIZE  , STFLASH_MAIN_BLOCK }, /* 3 */
  111.   {WTFLASH_MAIN_SIZE  , STFLASH_MAIN_BLOCK }, /* 4 */
  112.   {WTFLASH_MAIN_SIZE  , STFLASH_MAIN_BLOCK }, /* 5 */
  113.   {WTFLASH_MAIN_SIZE  , STFLASH_MAIN_BLOCK }, /* 6 */
  114.   {WTFLASH_MAIN_SIZE  , STFLASH_MAIN_BLOCK }, /* 7 */
  115.   {WTFLASH_MAIN_SIZE  , STFLASH_MAIN_BLOCK }, /* 8 */
  116.   {WTFLASH_MAIN_SIZE  , STFLASH_MAIN_BLOCK }, /* 9 */
  117.   {WTFLASH_MAIN_SIZE  , STFLASH_MAIN_BLOCK }, /* 10 */
  118.   {WTFLASH_MAIN_SIZE  , STFLASH_MAIN_BLOCK }, /* 11 */
  119.   {WTFLASH_MAIN_SIZE  , STFLASH_MAIN_BLOCK }, /* 12 */
  120.   {WTFLASH_MAIN_SIZE  , STFLASH_MAIN_BLOCK }, /* 13 */
  121.   {WTFLASH_MAIN_SIZE  , STFLASH_MAIN_BLOCK }, /* 14 */
  122.   {WTFLASH_MAIN_SIZE  , STFLASH_MAIN_BLOCK }, /* 15 */
  123.   {WTFLASH_MAIN_SIZE  , STFLASH_MAIN_BLOCK }, /* 16 */
  124.   {WTFLASH_MAIN_SIZE  , STFLASH_MAIN_BLOCK }, /* 17 */
  125.   {WTFLASH_MAIN_SIZE  , STFLASH_MAIN_BLOCK }, /* 18 */
  126.   {WTFLASH_MAIN_SIZE  , STFLASH_MAIN_BLOCK }, /* 19 */
  127.   {WTFLASH_MAIN_SIZE  , STFLASH_MAIN_BLOCK }, /* 20 */
  128.   {WTFLASH_MAIN_SIZE  , STFLASH_MAIN_BLOCK }, /* 21 */
  129.   {WTFLASH_MAIN_SIZE  , STFLASH_MAIN_BLOCK }, /* 22 */
  130.   {WTFLASH_MAIN_SIZE  , STFLASH_MAIN_BLOCK }, /* 23 */
  131.   {WTFLASH_MAIN_SIZE  , STFLASH_MAIN_BLOCK }, /* 24 */
  132.   {WTFLASH_MAIN_SIZE  , STFLASH_MAIN_BLOCK }, /* 25 */
  133.   {WTFLASH_MAIN_SIZE  , STFLASH_MAIN_BLOCK }, /* 26 */
  134.   {WTFLASH_MAIN_SIZE  , STFLASH_MAIN_BLOCK }, /* 27 */
  135.   {WTFLASH_MAIN_SIZE  , STFLASH_MAIN_BLOCK }, /* 28 */
  136.   {WTFLASH_MAIN_SIZE  , STFLASH_MAIN_BLOCK }, /* 29 */
  137.   {WTFLASH_MAIN_SIZE  , STFLASH_MAIN_BLOCK }, /* 30 */
  138.   {WTFLASH_MAIN_SIZE  , STFLASH_MAIN_BLOCK }, /* 1 */
  139.   {WTFLASH_MAIN_SIZE  , STFLASH_MAIN_BLOCK }, /* 2 */
  140.   {WTFLASH_MAIN_SIZE  , STFLASH_MAIN_BLOCK }, /* 3 */
  141.   {WTFLASH_MAIN_SIZE  , STFLASH_MAIN_BLOCK }, /* 4 */
  142.   {WTFLASH_MAIN_SIZE  , STFLASH_MAIN_BLOCK }, /* 5 */
  143.   {WTFLASH_MAIN_SIZE  , STFLASH_MAIN_BLOCK }, /* 6 */
  144.   {WTFLASH_MAIN_SIZE  , STFLASH_MAIN_BLOCK }, /* 7 */
  145.   {WTFLASH_MAIN_SIZE  , STFLASH_MAIN_BLOCK }, /* 8 */
  146.   {WTFLASH_MAIN_SIZE  , STFLASH_MAIN_BLOCK }, /* 9 */
  147.   {WTFLASH_MAIN_SIZE  , STFLASH_MAIN_BLOCK }, /* 10 */
  148.   {WTFLASH_MAIN_SIZE  , STFLASH_MAIN_BLOCK }, /* 11 */
  149.   {WTFLASH_MAIN_SIZE  , STFLASH_MAIN_BLOCK }, /* 12 */
  150.   {WTFLASH_MAIN_SIZE  , STFLASH_MAIN_BLOCK }, /* 13 */
  151.   {WTFLASH_MAIN_SIZE  , STFLASH_MAIN_BLOCK }, /* 14 */
  152.   {WTFLASH_MAIN_SIZE  , STFLASH_MAIN_BLOCK }, /* 15 */
  153.   {WTFLASH_MAIN_SIZE  , STFLASH_MAIN_BLOCK }, /* 16 */
  154.   {WTFLASH_MAIN_SIZE  , STFLASH_MAIN_BLOCK }, /* 17 */
  155.   {WTFLASH_MAIN_SIZE  , STFLASH_MAIN_BLOCK }, /* 18 */
  156.   {WTFLASH_MAIN_SIZE  , STFLASH_MAIN_BLOCK }, /* 19 */
  157.   {WTFLASH_MAIN_SIZE  , STFLASH_MAIN_BLOCK }, /* 20 */
  158.   {WTFLASH_MAIN_SIZE  , STFLASH_MAIN_BLOCK }, /* 21 */
  159.   {WTFLASH_MAIN_SIZE  , STFLASH_MAIN_BLOCK }, /* 22 */
  160.   {WTFLASH_MAIN_SIZE  , STFLASH_MAIN_BLOCK }, /* 23 */
  161.   {WTFLASH_MAIN_SIZE  , STFLASH_MAIN_BLOCK }, /* 24 */
  162.   {WTFLASH_MAIN_SIZE  , STFLASH_MAIN_BLOCK }, /* 25 */
  163.   {WTFLASH_MAIN_SIZE  , STFLASH_MAIN_BLOCK }, /* 26 */
  164.   {WTFLASH_MAIN_SIZE  , STFLASH_MAIN_BLOCK }, /* 27 */
  165.   {WTFLASH_MAIN_SIZE  , STFLASH_MAIN_BLOCK }, /* 28 */
  166.   {WTFLASH_MAIN_SIZE  , STFLASH_MAIN_BLOCK }, /* 29 */
  167.   {WTFLASH_MAIN_SIZE  , STFLASH_MAIN_BLOCK }, /* 60 */
  168.   {WTFLASH_MAIN_SIZE  , STFLASH_MAIN_BLOCK }, /* 1 */
  169.   {WTFLASH_MAIN_SIZE  , STFLASH_MAIN_BLOCK }, /* 2 */
  170.   {WTFLASH_MAIN_SIZE  , STFLASH_MAIN_BLOCK }, /* 3 */
  171.   {WTFLASH_MAIN_SIZE  , STFLASH_MAIN_BLOCK }, /* 4 */
  172.   {WTFLASH_MAIN_SIZE  , STFLASH_MAIN_BLOCK }, /* 5 */
  173.   {WTFLASH_MAIN_SIZE  , STFLASH_MAIN_BLOCK }, /* 6 */
  174.   {WTFLASH_MAIN_SIZE  , STFLASH_MAIN_BLOCK }, /* 7 */
  175.   {WTFLASH_MAIN_SIZE  , STFLASH_MAIN_BLOCK }, /* 8 */
  176.   {WTFLASH_MAIN_SIZE  , STFLASH_MAIN_BLOCK }, /* 9 */
  177.   {WTFLASH_MAIN_SIZE  , STFLASH_MAIN_BLOCK }, /* 10 */
  178.   {WTFLASH_MAIN_SIZE  , STFLASH_MAIN_BLOCK }, /* 11 */
  179.   {WTFLASH_MAIN_SIZE  , STFLASH_MAIN_BLOCK }, /* 12 */
  180.   {WTFLASH_MAIN_SIZE  , STFLASH_MAIN_BLOCK }, /* 13 */
  181.   {WTFLASH_MAIN_SIZE  , STFLASH_MAIN_BLOCK }, /* 14 */
  182.   {WTFLASH_MAIN_SIZE  , STFLASH_MAIN_BLOCK }, /* 15 */
  183.   {WTFLASH_MAIN_SIZE  , STFLASH_MAIN_BLOCK }, /* 16 */
  184.   {WTFLASH_MAIN_SIZE  , STFLASH_MAIN_BLOCK }, /* 17 */
  185.   {WTFLASH_MAIN_SIZE  , STFLASH_MAIN_BLOCK }, /* 18 */
  186.   {WTFLASH_MAIN_SIZE  , STFLASH_MAIN_BLOCK }, /* 19 */
  187.   {WTFLASH_MAIN_SIZE  , STFLASH_MAIN_BLOCK }, /* 20 */
  188.   {WTFLASH_MAIN_SIZE  , STFLASH_MAIN_BLOCK }, /* 21 */
  189.   {WTFLASH_MAIN_SIZE  , STFLASH_MAIN_BLOCK }, /* 22 */
  190.   {WTFLASH_MAIN_SIZE  , STFLASH_MAIN_BLOCK }, /* 23 */
  191.   {WTFLASH_MAIN_SIZE  , STFLASH_MAIN_BLOCK }, /* 24 */
  192.   {WTFLASH_MAIN_SIZE  , STFLASH_MAIN_BLOCK }, /* 25 */
  193.   {WTFLASH_MAIN_SIZE  , STFLASH_MAIN_BLOCK }, /* 26 */
  194.   {WTFLASH_MAIN_SIZE  , STFLASH_MAIN_BLOCK }, /* 27 */
  195.   {WTFLASH_MAIN_SIZE  , STFLASH_MAIN_BLOCK }, /* 28 */
  196.   {WTFLASH_MAIN_SIZE  , STFLASH_MAIN_BLOCK }, /* 29 */
  197.   {WTFLASH_MAIN_SIZE  , STFLASH_MAIN_BLOCK }, /* 90 */
  198.   {WTFLASH_MAIN_SIZE  , STFLASH_MAIN_BLOCK }, /* 1 */
  199.   {WTFLASH_MAIN_SIZE  , STFLASH_MAIN_BLOCK }, /* 2 */
  200.   {WTFLASH_MAIN_SIZE  , STFLASH_MAIN_BLOCK }, /* 3 */
  201.   {WTFLASH_MAIN_SIZE  , STFLASH_MAIN_BLOCK }, /* 4 */
  202.   {WTFLASH_MAIN_SIZE  , STFLASH_MAIN_BLOCK }, /* 5 */
  203.   {WTFLASH_MAIN_SIZE  , STFLASH_MAIN_BLOCK }, /* 6 */
  204.   {WTFLASH_MAIN_SIZE  , STFLASH_MAIN_BLOCK }, /* 7 */
  205.   {WTFLASH_MAIN_SIZE  , STFLASH_MAIN_BLOCK }, /* 8 */
  206.   {WTFLASH_MAIN_SIZE  , STFLASH_MAIN_BLOCK }, /* 9 */
  207.   {WTFLASH_MAIN_SIZE  , STFLASH_MAIN_BLOCK }, /* 10 */
  208.   {WTFLASH_MAIN_SIZE  , STFLASH_MAIN_BLOCK }, /* 11 */
  209.   {WTFLASH_MAIN_SIZE  , STFLASH_MAIN_BLOCK }, /* 12 */
  210.   {WTFLASH_MAIN_SIZE  , STFLASH_MAIN_BLOCK }, /* 13 */
  211.   {WTFLASH_MAIN_SIZE  , STFLASH_MAIN_BLOCK }, /* 14 */
  212.   {WTFLASH_MAIN_SIZE  , STFLASH_MAIN_BLOCK }, /* 15 */
  213.   {WTFLASH_MAIN_SIZE  , STFLASH_MAIN_BLOCK }, /* 16 */
  214.   {WTFLASH_MAIN_SIZE  , STFLASH_MAIN_BLOCK }, /* 17 */
  215.   {WTFLASH_MAIN_SIZE  , STFLASH_MAIN_BLOCK }, /* 18 */
  216.   {WTFLASH_MAIN_SIZE  , STFLASH_MAIN_BLOCK }, /* 19 */
  217.   {WTFLASH_MAIN_SIZE  , STFLASH_MAIN_BLOCK }, /* 20 */
  218.   {WTFLASH_MAIN_SIZE  , STFLASH_MAIN_BLOCK }, /* 21 */
  219.   {WTFLASH_MAIN_SIZE  , STFLASH_MAIN_BLOCK }, /* 22 */
  220.   {WTFLASH_MAIN_SIZE  , STFLASH_MAIN_BLOCK }, /* 23 */
  221.   {WTFLASH_MAIN_SIZE  , STFLASH_MAIN_BLOCK }, /* 24 */
  222.   {WTFLASH_MAIN_SIZE  , STFLASH_MAIN_BLOCK }, /* 25 */
  223.   {WTFLASH_MAIN_SIZE  , STFLASH_MAIN_BLOCK }, /* 26 */
  224.   {WTFLASH_MAIN_SIZE  , STFLASH_MAIN_BLOCK }, /* 27 */
  225.   {WTFLASH_MAIN_SIZE  , STFLASH_MAIN_BLOCK }, /* 28 */
  226.   {WTFLASH_MAIN_SIZE  , STFLASH_MAIN_BLOCK }, /* 29 */
  227.   {WTFLASH_MAIN_SIZE  , STFLASH_MAIN_BLOCK }, /* 120 */
  228.   {WTFLASH_MAIN_SIZE  , STFLASH_MAIN_BLOCK }, /* 1 */
  229.   {WTFLASH_MAIN_SIZE  , STFLASH_MAIN_BLOCK }, /* 2 */
  230.   {WTFLASH_MAIN_SIZE  , STFLASH_MAIN_BLOCK }, /* 3 */
  231.   {WTFLASH_MAIN_SIZE  , STFLASH_MAIN_BLOCK }, /* 4 */
  232.   {WTFLASH_MAIN_SIZE  , STFLASH_MAIN_BLOCK }, /* 5 */
  233.   {WTFLASH_MAIN_SIZE  , STFLASH_MAIN_BLOCK }, /* 6 */
  234.   {WTFLASH_MAIN_SIZE  , STFLASH_MAIN_BLOCK }, /* 7 */
  235.   {WTFLASH_PARA_0_SIZE  , STFLASH_PARAMETER_BLOCK }, /* 8 */
  236.   {WTFLASH_PARA_0_SIZE  , STFLASH_PARAMETER_BLOCK }, /* 9 */
  237.   {WTFLASH_PARA_0_SIZE  , STFLASH_PARAMETER_BLOCK }, /* 10 */
  238.   {WTFLASH_PARA_0_SIZE  , STFLASH_PARAMETER_BLOCK }, /* 11 */
  239.   {WTFLASH_PARA_0_SIZE  , STFLASH_PARAMETER_BLOCK }, /* 12 */
  240.   {WTFLASH_PARA_0_SIZE  , STFLASH_PARAMETER_BLOCK }, /* 13 */
  241.   {WTFLASH_PARA_0_SIZE  , STFLASH_PARAMETER_BLOCK }, /* 14 */
  242.   {WTFLASH_PARA_0_SIZE  , STFLASH_PARAMETER_BLOCK }}; /* 135 */
  243. /* ------------------------STFLASH_M29W160BT-------------------------- */
  244. #else
  245.     STFLASH_Block_t      BlockData_s[wtNUM_BLOCKS] =
  246.     {
  247.       { WTFLASH_MAIN_SIZE, STFLASH_MAIN_BLOCK },/*0*/
  248.       { WTFLASH_MAIN_SIZE, STFLASH_MAIN_BLOCK },
  249.       { WTFLASH_MAIN_SIZE, STFLASH_MAIN_BLOCK },
  250.       { WTFLASH_MAIN_SIZE, STFLASH_MAIN_BLOCK },
  251.       { WTFLASH_MAIN_SIZE, STFLASH_MAIN_BLOCK },
  252.       { WTFLASH_MAIN_SIZE, STFLASH_MAIN_BLOCK },
  253.       { WTFLASH_MAIN_SIZE, STFLASH_MAIN_BLOCK },
  254.       { WTFLASH_MAIN_SIZE, STFLASH_MAIN_BLOCK },
  256.       { WTFLASH_MAIN_SIZE, STFLASH_MAIN_BLOCK },/*8*/
  257.       { WTFLASH_MAIN_SIZE, STFLASH_MAIN_BLOCK },/*9*/
  258.       { WTFLASH_MAIN_SIZE, STFLASH_MAIN_BLOCK },
  259.       { WTFLASH_MAIN_SIZE, STFLASH_MAIN_BLOCK },
  260.       { WTFLASH_MAIN_SIZE, STFLASH_MAIN_BLOCK },
  261.       { WTFLASH_MAIN_SIZE, STFLASH_MAIN_BLOCK },
  262.       { WTFLASH_MAIN_SIZE, STFLASH_MAIN_BLOCK },
  263.       { WTFLASH_MAIN_SIZE, STFLASH_MAIN_BLOCK },
  264.       
  265.       { WTFLASH_MAIN_SIZE, STFLASH_MAIN_BLOCK },/*16*/
  266.       { WTFLASH_MAIN_SIZE, STFLASH_MAIN_BLOCK },
  267.       { WTFLASH_MAIN_SIZE, STFLASH_MAIN_BLOCK },
  268.       { WTFLASH_MAIN_SIZE, STFLASH_MAIN_BLOCK },/*19*/
  269.       { WTFLASH_MAIN_SIZE, STFLASH_MAIN_BLOCK },
  270.       { WTFLASH_MAIN_SIZE, STFLASH_MAIN_BLOCK },
  271.       { WTFLASH_MAIN_SIZE, STFLASH_MAIN_BLOCK },
  272.       { WTFLASH_MAIN_SIZE, STFLASH_MAIN_BLOCK },/*1.5M*/
  273.       
  274.       { WTFLASH_MAIN_SIZE, STFLASH_MAIN_BLOCK },/*24*/
  275.       { WTFLASH_MAIN_SIZE, STFLASH_MAIN_BLOCK },/*25*/
  276.       { WTFLASH_MAIN_SIZE, STFLASH_MAIN_BLOCK },/*26*/
  277.       { WTFLASH_MAIN_SIZE, STFLASH_MAIN_BLOCK },/*27*/
  278.       { WTFLASH_MAIN_SIZE, STFLASH_MAIN_BLOCK },/*28*/
  279.       { WTFLASH_MAIN_SIZE, STFLASH_MAIN_BLOCK },/*29*/
  280.       { WTFLASH_MAIN_SIZE, STFLASH_MAIN_BLOCK },/*30*/
  281.       
  282.   {WTFLASH_MAIN01_SIZE  , STFLASH_PARAMETER_BLOCK }, /* 31 */
  283.   {WTFLASH_PARA_0_SIZE  , STFLASH_PARAMETER_BLOCK }, /* 32 */
  284.   {WTFLASH_PARA_0_SIZE  , STFLASH_PARAMETER_BLOCK }, /* 33 */
  285.   {WTFLASH_BOOT_0_SIZE  , STFLASH_BOOT_BLOCK }};  /* 34 */
  287. #endif
  291. static U32              FlashSize = 0;          /* Non-zero = file converted */
  292. static char             *FlashData_p = NULL;
  293. /*static SectionInfo_t    SectionInfo[wtNUM_SECTIONS]; gleam*/
  294. static SectionInfo_t    SectionInfo[wtNUM_BLOCKS];
  295. static BlockInfo_t      BlockInfo[wtTOTAL_BLOCKS + 1];
  296. static U32              BaseAddress[NUM_BANKS];
  297. static STFLASH_Block_t  GetBlkDat_s[wtNUM_BLOCKS];
  298. BOOL           binFile ;
  300. /* Private Macros ----------------------------------------------------- */
  301. extern U32 wtFlashBankBaseAddr;
  303. #define WTFLASH_BASE_ADDR1 wtFlashBankBaseAddr
  305. /* Global Variables ------------------------------------------------------- */
  307. STFLASH_Handle_t        FLASHHndl[2];
  308. ST_DeviceName_t         FLASHDeviceName[2] = {"Bank0", "Bank1"};
  310. /* Private Function prototypes ---------------------------------------- */
  312. /* Functions ---------------------------------------------------------- */
  314. /*-------------------------------------------------------------------------
  315.  * Function : FLASH_Close
  316.  *            close FLASH
  317.  * Input    : None
  318.  * Output   :
  319.  * Return   : TRUE if error, FALSE if success
  320.  * ----------------------------------------------------------------------*/
  321. ST_ErrorCode_t FLASH_Close( U8 BankNum )
  322. {
  323.     ST_ErrorCode_t          ErrCode;
  325.     ErrCode = STFLASH_Close(FLASHHndl[BankNum]);
  327.     STTBX_Print(("STFLASH_Close()=%sn", wts_GetErrorText(ErrCode) ));
  329.     return ( ErrCode );
  331. } /* end FLASH_Close */
  333. /*-------------------------------------------------------------------------
  334.  * Function : FLASH_GetParams
  335.  *            Get Flash Parameters
  336.  * Input    : None
  337.  * Output   :
  338.  * Return   : TRUE if error, FALSE if success
  339.  * ----------------------------------------------------------------------*/
  340. ST_ErrorCode_t FLASH_GetParams( U8 BankNum, STFLASH_Params_t *FLASHParams_p )
  341. {
  342.     ST_ErrorCode_t      ErrCode;
  343.     
  344.     /* assign structure for returning data */
  345.     FLASHParams_p->InitParams.Blocks = GetBlkDat_s;    
  346.     ErrCode = STFLASH_GetParams(FLASHHndl[BankNum], FLASHParams_p );
  348. #if 1
  349.         STTBX_Print(("| ManufactCode   =0x%04x | DeviceCode   =0x%04x |n",FLASHParams_p->ManufactCode,FLASHParams_p->DeviceCode));
  350. #endif
  351.     STTBX_Print(("STFLASH_GetParams(%d)=%sn", BankNum, wts_GetErrorText(ErrCode)));
  353.     return ( ErrCode );
  355. } /* end FLASH_Close */
  357. /*-------------------------------------------------------------------------
  358.  * Function : FLASH_Init
  359.  *            Initialise FLASH
  360.  * Input    : None
  361.  * Output   :
  362.  * Return   : TRUE if error, FALSE if success
  363.  * ----------------------------------------------------------------------*/
  364. ST_ErrorCode_t FLASH_Init( U8 BankNum )
  365. {
  366.     ST_ErrorCode_t          ErrCode;
  367.     STFLASH_InitParams_t    InitParams;
  370.     InitParams.DeviceType = DEVICE_TYPE;
  371. #if 0
  372.     STTBX_Print(("InitParams.DeviceType=     %dn", DEVICE_TYPE));
  373. #endif
  375.     if ( BankNum == BANK0 )
  376.     {
  377. #if 0
  378.         InitParams.BaseAddress = (U32*)WTFLASH_BANK_0_BASE;
  379. #else
  380.         InitParams.BaseAddress = (U32*)WTFLASH_BASE_ADDR1; /*&wtFlashBankBaseAddr;*/
  381. STTBX_Print(("nBaseAddress=[0x%x]n",InitParams.BaseAddress));
  382. #endif
  383.         InitParams.VppAddress  = (U32*)STFLASH_VPP_0_ENABLE;
  384.     }
  385.     else
  386.     {
  387.         #if defined(STFLASH_BANK_1_BASE)
  388.             InitParams.BaseAddress = (U32*)STFLASH_BANK_1_BASE;
  389.             InitParams.VppAddress  = (U32*)STFLASH_VPP_1_ENABLE;
  390.         #else
  391.             return ST_ERROR_FEATURE_NOT_SUPPORTED;
  392.         #endif
  393.     }
  395.     InitParams.MinAccessWidth  = MIN_ACCESS_WIDTH;
  396.     InitParams.MaxAccessWidth  = MAX_ACCESS_WIDTH;
  397.     InitParams.NumberOfBlocks  = wtNUM_BLOCKS;
  398.     InitParams.Blocks          = BlockData_s;
  399.     InitParams.DriverPartition = SystemPartition;
  401.     ErrCode = STFLASH_Init(FLASHDeviceName[BankNum], &InitParams );
  403.     STTBX_Print(("STFLASH_Init(%s)=%sn", FLASHDeviceName[BankNum], wts_GetErrorText(ErrCode) ));
  405.     return ( ErrCode );
  407. } /* end FLASH_Init */
  409. /*-------------------------------------------------------------------------
  410.  * Function : FLASH_Open
  411.  *            Open FLASH
  412.  * Input    : None
  413.  * Output   :
  414.  * Return   : TRUE if error, FALSE if success
  415.  * ----------------------------------------------------------------------*/
  416. ST_ErrorCode_t FLASH_Open( U8 BankNum )
  417. {
  418.     ST_ErrorCode_t          ErrCode;
  419.     STFLASH_OpenParams_t    OpenParams;
  420.     
  421.     memset((char*)&OpenParams,0,sizeof(STFLASH_OpenParams_t));
  422.     
  423.     ErrCode = STFLASH_Open(FLASHDeviceName[BankNum], &OpenParams, &FLASHHndl[BankNum]);
  425.     STTBX_Print(("STFLASH_Open(%s)=%sn", FLASHDeviceName[BankNum], wts_GetErrorText(ErrCode) ));
  427.     return ( ErrCode );
  429. } /* end FLASH_Open */
  431. /*-------------------------------------------------------------------------
  432.  * Function : FLASH_Term
  433.  *            Terminate FLASH
  434.  * Input    : ForceTerminate
  435.  * Output   :
  436.  * Return   : TRUE if error, FALSE if success
  437.  * ----------------------------------------------------------------------*/
  438. ST_ErrorCode_t FLASH_Term(  BOOL ForceTerminate, U8 BankNum )
  439. {
  440.     ST_ErrorCode_t          ErrCode;
  441.     STFLASH_TermParams_t    TermParams;
  443.     TermParams.ForceTerminate = ForceTerminate;
  445.     ErrCode = STFLASH_Term(FLASHDeviceName[BankNum], &TermParams);
  447.     STTBX_Print(("STFLASH_Term(%s)=%sn", FLASHDeviceName[BankNum], wts_GetErrorText(ErrCode) ));
  449.     return ( ErrCode );
  451. } /* end FLASH_Term */
  453. /*-------------------------------------------------------------------------
  454.  * Function : FLASH_SetupBlockInfo
  455.  *            Setup Block Info structure
  456.  * Input    :
  457.  * Output   :
  458.  * Return   : Error Code
  459.  * ----------------------------------------------------------------------*/
  460. ST_ErrorCode_t FLASH_SetupBlockInfo( void )
  461. {
  462.     ST_ErrorCode_t      ErrCode = ST_NO_ERROR;
  463.     STFLASH_Params_t    FLASHParams;
  464.     U8  Bank=0, Block=0;
  465.     U32 BlockStart = 0;
  466.     static U8 Section = 0;
  467.     
  468.     memset((char*)&FLASHParams,0,sizeof(STFLASH_Params_t));
  470.     if ( Section == 0 )
  471.     {
  472.         /*
  473.         **  Set the address for each section
  474.         */
  475.         for ( Bank = 0; ( Bank < NUM_BANKS ) && ( ErrCode == ST_NO_ERROR ); Bank ++ )
  476.         {
  477.             ErrCode = FLASH_Init( Bank );                /* Init Bank */
  478.             if ( ErrCode == ST_NO_ERROR )
  479.             {
  480.                 ErrCode = FLASH_Open( Bank );
  481.                 if ( ErrCode == ST_NO_ERROR )
  482.                     ErrCode = FLASH_GetParams( Bank, &FLASHParams );
  484.                 if ( ErrCode == ST_NO_ERROR )
  485.                 {
  486.                     BlockStart = BaseAddress[Bank] = (U32) FLASHParams.InitParams.BaseAddress;
  487.                     for ( Block = 0; Block < FLASHParams.InitParams.NumberOfBlocks; Block ++)
  488.                     {
  489.                         BlockInfo[Section].Bank    = Bank;
  490.                         BlockInfo[Section].Address = BlockStart;
  491.                         BlockInfo[Section].Length  = FLASHParams.InitParams.Blocks[Block].Length;
  492.                         #ifdef DEBUG_OUTPUT
  493.                             STTBX_Print(("Block %2d (%d) 0x%08x 0x%08x (%6d) bytesn",
  494.                                          Block, Section,
  495.                                          BlockInfo[Section].Address,
  496.                                          BlockInfo[Section].Length,
  497.                                          BlockInfo[Section].Length ));
  498.                         #endif
  499.                         Section ++;
  500.                         BlockStart += FLASHParams.InitParams.Blocks[Block].Length;
  501.                     }
  502.                 }
  503.                 ErrCode = FLASH_Term( TRUE, Bank );
  504.             }
  505.         }
  506.         BlockInfo[Section].Address = BlockStart;
  507.     }
  509.     if ( ErrCode == ST_NO_ERROR )
  510.         STTBX_Print(("Flash setup Ok (%d blocks)n", Section ));
  512.     return( ErrCode );
  514. } /* end of FLASH_SetupBlockInfo */
  516. /*-------------------------------------------------------------------------
  517.  * Function : FLASH_Setup
  518.  *            Setup Block Info structure
  519.  * Input    :
  520.  * Output   :
  521.  * Return   : Error Code
  522.  * ----------------------------------------------------------------------*/
  523. ST_ErrorCode_t FLASH_Setup( void )
  524. {
  525.     ST_ErrorCode_t      ErrCode = ST_NO_ERROR;
  526.     U8  Bank;
  527.     
  528.     /*    **  Set the address for each section*/
  529.        
  530.         for ( Bank = 0; ( Bank < NUM_BANKS ) && ( ErrCode == ST_NO_ERROR ); Bank ++ )
  531.         {
  532.             ErrCode = FLASH_Init( Bank );                /* Init Bank */
  533.             if ( ErrCode == ST_NO_ERROR )
  534.             {
  535.                 ErrCode = FLASH_Open( Bank );
  536.             }
  537.             if ( ErrCode == ST_NO_ERROR )
  538.             STTBX_Print(("Flash setup Ok.....n" ));        
  539.         }
  540.     return( ErrCode );
  542. } /* end of Flash_Setup */
  544. /*-------------------------------------------------------------------------
  545.  * Function : FreeFileDataBuffer
  546.  *            as is
  547.  * Input    :
  548.  * Output   :
  549.  * Return   : None
  550.  * ----------------------------------------------------------------------*/
  551. static void FreeFileDataBuffer(void)
  552. {
  553.     /* deallocate File data buffer */
  554.     if ( FlashData_p != NULL )
  555.         memory_deallocate( SystemPartition, FlashData_p );
  557. } /* end of FreeFileDataBuffer() */
  559. /*-------------------------------------------------------------------------
  560.  * Function : GetBlockNumber
  561.  *            Get block number from address
  562.  * Input    :
  563.  * Output   :
  564.  * Return   : Block number of address
  565.  * ----------------------------------------------------------------------*/
  566. static U8 GetBlockNumber( U32 Address )
  567. {
  568.     U8  Block;
  570.     /* find the block this address is in */
  571.     for ( Block = 0; Block < wtTOTAL_BLOCKS; Block++ )
  572.     {
  573.         if (( Address >= BlockInfo[Block].Address ) &&
  574.             ( Address < (BlockInfo[Block].Address+BlockInfo[Block].Length)))
  575.         {
  576.             break;
  577.         }
  578.     }
  579.     return Block;
  581. } /* end GetBlockNumber */
  583. /*-------------------------------------------------------------------------
  584.  * Function : ConvertTotalMemory
  585.  *            Convert Raw Hex file into memory buffer suitable to write to
  586.  *            flash copying created data over data read from filem, the
  587.  *            created data will be smaller as each byte takes three bytes
  588.  *            in the Hex file.
  589.  * Input    :
  590.  * Output   :
  591.  * Return   : size of data in buffer
  592.  * ----------------------------------------------------------------------*/
  593. static U32 ConvertTotalMemory( long unsigned int MemSize )
  594. {
  595.     char                *OldPtr, *NewPtr;
  596.     int                 Section;
  597.     U32                 InOffset;
  598.     U32                 OutOffset;
  599.     U32                 BlockOffset;
  600.     U32                 Value=0;
  601.     U8                  Count=0 , Block=0;
  602.     
  603.     for ( Section = 0; Section < wtNUM_BLOCKS; Section ++ )
  604.     {
  605.         SectionInfo[Section].Block = 0xff;
  606.         SectionInfo[Section].Address = 0;
  607.         SectionInfo[Section].Offset = 0;
  608.         SectionInfo[Section].Size = 0;
  609.     }
  611.     /* Convert File */
  613.     Section = 0;
  614.     OldPtr = FlashData_p;
  615.     NewPtr = (char*) NULL;
  616.     
  617.     for ( InOffset = 0, OutOffset = 0; InOffset < MemSize; )
  618.     {
  619.         /* Line format =
  620.         ** Address  Data  (both in hex)
  621.         ** 12345678 11 22 33 44 55 etc. CR/LF
  622.         */
  623.         Value = (U32) strtol( OldPtr, &NewPtr, 16 );
  624.         if ( NewPtr != OldPtr ) /* if conversion possible */
  625.         {
  626.             if ( Value > 255 )  /* which means it is an address */
  627.             {
  628.                 if (( Block = GetBlockNumber( Value )) == wtTOTAL_BLOCKS )/*changed temp*/
  629.                 {
  630.                     STTBX_Print(("Invalid address 0x%xn", Value ));
  631.                     break;
  632.                 }
  633.                 else
  634.                 {
  635.                     /*
  636.                     ** check if the address is non-contiguous
  637.                     ** or if it is a new block
  638.                     */
  639.                     if ((( SectionInfo[Section].Address + SectionInfo[Section].Size ) != Value ) ||
  640.                         ( SectionInfo[Section].Block != Block ))
  641.                     {
  642.                         Section ++;
  643.                     }
  645.                     /* Start New Block */
  646.                     if ( SectionInfo[Section].Block == 0xff )
  647.                     {
  648.                         SectionInfo[Section].Address = Value;
  649.                         SectionInfo[Section].Block = Block;
  650.                         SectionInfo[Section].Offset = OutOffset;
  651.                         SectionInfo[Section].Size = 0;
  652.                     }
  653.                 }
  654.             }
  655.             else
  656.             {
  657.                 BlockOffset = OutOffset;
  658.                 for ( Count = 0; Count < Section; Count++ )
  659.                     BlockOffset -= SectionInfo[Count].Size;
  661.                 if (( BlockOffset+1 ) > BlockInfo[SectionInfo[Section].Block].Length )
  662.                 {
  663.                     Section++;
  664.                 }
  666.                 /* Start New Block */
  667.                 if ( SectionInfo[Section].Block == 0xff )
  668.                 {
  669.                     SectionInfo[Section].Address = BlockInfo[Block].Address + BlockOffset;
  670.                     SectionInfo[Section].Block = GetBlockNumber(SectionInfo[Section].Address);
  671.                     SectionInfo[Section].Offset = OutOffset;
  672.                     SectionInfo[Section].Size = 0;
  673.                 }
  675.                 SectionInfo[Section].Size ++;
  676.                 FlashData_p[OutOffset++] = (char) Value;
  677.              }
  679.             InOffset += (U32)( NewPtr - OldPtr );
  680.             OldPtr = NewPtr;
  682.             if ( Section > wtNUM_BLOCKS )
  683.             {
  684.                 STTBX_Print(("Program Limitationn"));
  685.                 exit(0);
  686.             }
  688.        }
  689.         else
  690.             break;
  691.     } /* end of for loop */
  693.     STTBX_Print(("n"));
  694.     /* display the first few bytes of each section */
  695.     for ( Section = 0; Section < wtNUM_BLOCKS; Section ++ )
  696.     {
  697.         if ( SectionInfo[Section].Block != 0xFF )
  698.         {
  699.             STTBX_Print(("Section %2d, Block %3d, Addr 0x%08x, Offset 0x%08x, Size %6dn",
  700.                          Section,
  701.                          SectionInfo[Section].Block,
  702.                          SectionInfo[Section].Address,
  703.                          SectionInfo[Section].Offset,
  704.                          SectionInfo[Section].Size ));
  706.             #ifdef DEBUG_INFO
  707.                 for ( InOffset = 0;
  708.                       ( InOffset < 32 ) && ( InOffset < SectionInfo[Section].Size );
  709.                       InOffset ++ )
  710.                 {
  711.                     STTBX_Print((" %02x", FlashData_p[ SectionInfo[Section].Offset + InOffset ] ));
  712.                 }
  713.                 STTBX_Print(("n"));
  714.             #endif
  715.         }
  716.     }
  717.     return ( OutOffset );
  719. } /* end ConvertTotalMemory */
  722. /*-------------------------------------------------------------------------
  723.  * Function : ConvertMemory
  724.  *            Convert Raw Hex file into memory buffer suitable to write to
  725.  *            flash copying created data over data read from filem, the
  726.  *            created data will be smaller as each byte takes three bytes
  727.  *            in the Hex file.
  728.  * Input    :
  729.  * Output   :
  730.  * Return   : size of data in buffer
  731.  * ----------------------------------------------------------------------*/
  732. static U32 ConvertMemory( long unsigned int MemSize )
  733. {
  734.     char                *OldPtr, *NewPtr;
  735.     int                 Section;
  736.     U32                 InOffset;
  737.     U32                 OutOffset;
  738.     U32                 BlockOffset;
  739.     U32                 Value=0;
  740.     U8                  Count=0 , Block=0;
  741.     
  742.     for ( Section = 0; Section < wtNUM_SECTIONS; Section ++ )
  743.     {
  744.         SectionInfo[Section].Block = 0xff;
  745.         SectionInfo[Section].Address = 0;
  746.         SectionInfo[Section].Offset = 0;
  747.         SectionInfo[Section].Size = 0;
  748.     }
  750.     /* Convert File */
  752.     Section = 0;
  753.     OldPtr = FlashData_p;
  754.     NewPtr = (char*) NULL;
  755.     
  756.     for ( InOffset = 0, OutOffset = 0; InOffset < MemSize; )
  757.     {
  758.         /* Line format =
  759.         ** Address  Data  (both in hex)
  760.         ** 12345678 11 22 33 44 55 etc. CR/LF
  761.         */
  762.         Value = (U32) strtol( OldPtr, &NewPtr, 16 );
  763.         if ( NewPtr != OldPtr ) /* if conversion possible */
  764.         {
  765.             if ( Value > 255 )  /* which means it is an address */
  766.             {
  767.                 if (( Block = GetBlockNumber( Value )) == wtTOTAL_BLOCKS )/*changed temp*/
  768.                 {
  769.                     STTBX_Print(("Invalid address 0x%xn", Value ));
  770.                     break;
  771.                 }
  772.                 else
  773.                 {
  774.                     /*
  775.                     ** check if the address is non-contiguous
  776.                     ** or if it is a new block
  777.                     */
  778.                     if ((( SectionInfo[Section].Address + SectionInfo[Section].Size ) != Value ) ||
  779.                         ( SectionInfo[Section].Block != Block ))
  780.                     {
  781.                         Section ++;
  782.                     }
  784.                     /* Start New Block */
  785.                     if ( SectionInfo[Section].Block == 0xff )
  786.                     {
  787.                         SectionInfo[Section].Address = Value;
  788.                         SectionInfo[Section].Block = Block;
  789.                         SectionInfo[Section].Offset = OutOffset;
  790.                         SectionInfo[Section].Size = 0;
  791.                     }
  792.                 }
  793.             }
  794.             else
  795.             {
  796.                 BlockOffset = OutOffset;
  797.                 for ( Count = 0; Count < Section; Count++ )
  798.                     BlockOffset -= SectionInfo[Count].Size;
  800.                 if (( BlockOffset+1 ) > BlockInfo[SectionInfo[Section].Block].Length )
  801.                 {
  802.                     Section++;
  803.                 }
  805.                 /* Start New Block */
  806.                 if ( SectionInfo[Section].Block == 0xff )
  807.                 {
  808.                     SectionInfo[Section].Address = BlockInfo[Block].Address + BlockOffset;
  809.                     SectionInfo[Section].Block = GetBlockNumber(SectionInfo[Section].Address);
  810.                     SectionInfo[Section].Offset = OutOffset;
  811.                     SectionInfo[Section].Size = 0;
  812.                 }
  814.                 SectionInfo[Section].Size ++;
  815.                 FlashData_p[OutOffset++] = (char) Value;
  816.              }
  818.             InOffset += (U32)( NewPtr - OldPtr );
  819.             OldPtr = NewPtr;
  821.             if ( Section > wtNUM_SECTIONS )
  822.             {
  823.                 STTBX_Print(("Program Limitationn"));
  824.                 exit(0);
  825.             }
  827.        }
  828.         else
  829.             break;
  830.     } /* end of for loop */
  832.     STTBX_Print(("n"));
  833.     /* display the first few bytes of each section */
  834.     for ( Section = 0; Section < wtNUM_SECTIONS; Section ++ )
  835.     {
  836.         if ( SectionInfo[Section].Block != 0xFF )
  837.         {
  838.             STTBX_Print(("Section %2d, Block %3d, Addr 0x%08x, Offset 0x%08x, Size %6dn",
  839.                          Section,
  840.                          SectionInfo[Section].Block,
  841.                          SectionInfo[Section].Address,
  842.                          SectionInfo[Section].Offset,
  843.                          SectionInfo[Section].Size ));
  845.             #ifdef DEBUG_INFO
  846.                 for ( InOffset = 0;
  847.                       ( InOffset < 32 ) && ( InOffset < SectionInfo[Section].Size );
  848.                       InOffset ++ )
  849.                 {
  850.                     STTBX_Print((" %02x", FlashData_p[ SectionInfo[Section].Offset + InOffset ] ));
  851.                 }
  852.                 STTBX_Print(("n"));
  853.             #endif
  854.         }
  855.     }
  856.     return ( OutOffset );
  858. } /* end ConvertMemory */
  860. /*-------------------------------------------------------------------------
  861.  * Function : ReadFile
  862.  *            Read HEX file into memory
  863.  * Input    :
  864.  * Output   :
  865.  * Return   : File size
  866.  * ----------------------------------------------------------------------*/
  867. U32 FLASH_ReadFile( char *Filename )
  868. {
  869.     long int    ReadFile_p=0;            /* datafile descriptor          */
  870.     long int    FileSize=0;          /* size in bytes of the file    */
  871.     int            nameLength ;
  872.     int                 Section;
  874.   nameLength = strlen( Filename ) ;
  875.   if ((Filename[nameLength-1]=='n' ||Filename[nameLength-1]=='N') &&
  876.     (Filename[nameLength-2]=='i' ||Filename[nameLength-2]=='I') &&
  877.     (Filename[nameLength-3]=='b' ||Filename[nameLength-3]=='B') &&
  878.     Filename[nameLength-4]=='.' ) {
  879.     binFile = TRUE ;
  880.     ReadFile_p = debugopen(Filename, "rb");
  881.   } else {
  882.     binFile = FALSE ;
  883.     ReadFile_p = debugopen(Filename, "rb");
  884.   }
  886.         STTBX_Print(("opening file = '%s'n", Filename ));
  887.     /* Open and Read file into memory 
  888.     ReadFile_p = debugopen(Filename, "rb");*/
  889.     STTBX_Print(("ReadFile_p = 0x%8xn",ReadFile_p));
  890.     
  891.     if(ReadFile_p < 0)
  892.     {
  893.         STTBX_Print(("Error opening file '%s'n", Filename ));
  894.         return (0);
  895.     }
  896.     else
  897.     {
  898.         FileSize = debugfilesize(ReadFile_p);
  899.         STTBX_Print(("FileSize = 0x%8xn",FileSize));
  900.         /* allocate File data buffer */
  901.         FreeFileDataBuffer();
  902.         FlashData_p = (char*) memory_allocate( SystemPartition, (U32) FileSize );
  903.         if ( FlashData_p != NULL )
  904.         {
  905.             STTBX_Print(("Loading '%s' into memory, wait .. ", Filename ));
  906.             debugread(ReadFile_p, FlashData_p, (size_t) FileSize);
  907.             STTBX_Print(("%d bytesn", FileSize ));
  908.         }
  909.         else
  910.         {
  911.             STTBX_Print(("Not enough memory for file (%d bytes)n", FileSize));
  912.             FileSize = 0;
  913.         }
  915.         debugclose(ReadFile_p);
  916.     }
  918.    if (binFile)
  919.    {
  920.     for ( Section = 0; Section < wtNUM_BLOCKS; Section ++ )
  921.     {
  922. SectionInfo[Section].Address = BlockInfo[Section].Address;
  923.        SectionInfo[Section].Block = Section;
  924.        SectionInfo[Section].Offset = BlockInfo[Section].Address-wtFlashBankBaseAddr;/*WTFLASH_BANK_0_BASE;*/
  925.        SectionInfo[Section].Size = BlockInfo[Section].Length;
  926.                 }
  928.     STTBX_Print(("n"));
  929. #if 1
  930. /* display the first few bytes of each section */
  931.     for ( Section = 0; Section < wtNUM_BLOCKS; Section ++ )
  932.     {
  933.         if ( SectionInfo[Section].Block != 0xFF )
  934.         {
  935.             STTBX_Print(("Section %2d, Block %3d, Addr 0x%08x, Offset 0x%08x, Size 0x%08xn",
  936.                          Section,
  937.                          SectionInfo[Section].Block,
  938.                          SectionInfo[Section].Address,
  939.                          SectionInfo[Section].Offset,
  940.                          SectionInfo[Section].Size ));
  941.         }
  942.     }
  943. #endif
  945. FlashSize = (U32)FileSize;
  946.     return( FlashSize );
  947.    }
  948.    else
  949.    {
  950.     if ( FileSize > 0 )
  951.     {
  952.         /* convert buffer to binary and resize memory */
  953.         STTBX_Print(("Converting file in memory, wait .. "));
  954. /*         FlashSize = ConvertMemory( FileSize ); gleam*/
  955.         FlashSize = ConvertTotalMemory( FileSize );
  956.         if ( FlashSize > 0 )
  957.         {
  958.             STTBX_Print(("%d bytesn", FlashSize ));
  959.             FlashData_p = (char*) memory_reallocate( SystemPartition, FlashData_p, FlashSize );
  960.         }
  961.         else
  962.             STTBX_Print(("Invalid filen"));
  963.     }
  964.     return( FlashSize );
  965.    }
  966. } /* end of FLASH_ReadFile */
  968. BOOL ReadProgram(char *Filename ,U32 StartAddress ,U32 Length )
  969. {
  970.     ST_ErrorCode_t      ErrCode = ST_NO_ERROR;
  971.     int                 Section, Bank;
  972.     U32                 ReadOffset;
  973.     U32                 NumberOfBytes;
  974.     U8                  *Buffer_p;
  975.     int            nameLength,numBytes ;
  976.     long int    ReadFile_p=0;            /* datafile descriptor          */
  978.   volatile char    *ptr_to_m;
  980.   nameLength = strlen( Filename ) ;
  981.   if (Filename[nameLength-1]=='n' &&
  982.     Filename[nameLength-2]=='i' &&
  983.     Filename[nameLength-3]=='b' &&
  984.     Filename[nameLength-4]=='.' ) {
  985.     binFile = TRUE ;
  986.     ReadFile_p = debugopen(Filename, "wb");
  987.   } else {
  988.    Filename[nameLength  ]= '.' ;
  989.     Filename[nameLength+1]= 'b' ;
  990.     Filename[nameLength+2]= 'i' ;
  991.     Filename[nameLength+3]= 'n' ;
  992.     binFile = FALSE ;
  993.     ReadFile_p = debugopen(Filename, "wb");
  994.   }
  995.   if (ReadFile_p<=0) {
  996.         STTBX_Print(("nCannot Create data file '%s'n", Filename ));
  997.         return FALSE;
  998.   }
  1001.     /* Read the data and compare */
  1003.             Bank = BlockInfo[ SectionInfo[0].Block ].Bank;
  1004.             ReadOffset = StartAddress - BaseAddress[Bank];
  1006.             /* allocate temp buffer to put flash data in */
  1007.             Buffer_p = memory_allocate( SystemPartition, Length );
  1008.             if ( Buffer_p != NULL )
  1009.             {
  1010.                 STTBX_Print(("Address t| 0x%08x | 0x%08x |ReadOffset = 0x%08x |n ",
  1011.                          StartAddress,
  1012.                          StartAddress + Length-1,
  1013.                          ReadOffset));
  1014.                 ErrCode = STFLASH_Read( FLASHHndl[Bank],
  1015.                                         ReadOffset,
  1016.                                         Buffer_p,
  1017.                                         Length,
  1018.                                         &NumberOfBytes );
  1019.                 if(ErrCode != ST_NO_ERROR)
  1020.                 {
  1021.                     STTBX_Print(("STFLASH_Read %sn",wts_GetErrorText(ErrCode)));
  1022.                     return FALSE;
  1023.                 }
  1025.          numBytes = (int) debugwrite( (long int)ReadFile_p, (void*)Buffer_p, Length);
  1026.                STTBX_Print(("write file size  = %d bytesn", numBytes ));
  1027. #if 0
  1028.   /* ===================== check whether array is erased================== */
  1030.   ptr_to_m = (char *)0x40000000;           /* point to lowest _add in FlashROM     */
  1031.   *ptr_to_m = (char) 0xf0f0;         /* read_array command                   */
  1033.     for(ptr_to_m = (char *)0x40000000;      /* point to flash_start and change type */
  1034.        ptr_to_m < (char *)0x40200000;     /* point to flash_end and change type   */
  1035.        ptr_to_m++,Buffer_p++) {                    /* inc pointer                          */
  1037.        *Buffer_p =  *ptr_to_m;
  1039.          if (*ptr_to_m != *Buffer_p){             /* check all bits are set to 1          */
  1040.             debugmessage("ROMTOOL>  ERROR!!! EPROM not erased properlyn");
  1041.             return 0;
  1042.             }
  1043.        }
  1044.   
  1045.   /* ===================== check whether array is erased================== */
  1046.          numBytes = (int) debugwrite( (long int)ReadFile_p, (U8 *)Buffer_p, Length);
  1047.                STTBX_Print(("write file size  = %d bytesn", numBytes ));
  1048. #endif
  1049.                 /* deallocate temp buffer */
  1050.                 memory_deallocate( SystemPartition, Buffer_p );
  1051.             }
  1053.         STTBX_Print(("!!!! Read file successfully!!!!n"));
  1054.         return TRUE;
  1056. }
  1058. /*-------------------------------------------------------------------------
  1059.  * Function : EraseLNBFlash
  1060.  *            Function to Read Hex file and erase areas required
  1061.  * Input    : EraselLNB 
  1062.  * Output   :
  1063.  * Return   : EraseFailed = TRUE else FALSE
  1064.  * ----------------------------------------------------------------------*/
  1065. BOOL EraseLNBFlash( BOOL Erasel)
  1066. {
  1067.     ST_ErrorCode_t ErrCode = ST_NO_ERROR;
  1068.     U8   Section, Bank;
  1069.     U32  EraseOffset;
  1070.     BOOL EraseFailed = TRUE;
  1072.     /* check data size */
  1073.     if ( Erasel )
  1074.     {
  1075.         EraseFailed = FALSE;
  1077.         STTBX_Print(("tt+------------+------------+n"));
  1078.         if ( Erasel )
  1079.         {
  1080.             for ( Section = wtFIRST_LNB_BLOCK;( Section <  wtFIRST_LNB_BLOCK+wtLNB_BLOCKS ) && ( ErrCode == ST_NO_ERROR ); Section ++)
  1081.             {
  1082.                 Bank = BlockInfo[Section].Bank;
  1083. #ifdef DEBUG
  1084.                 STTBX_Print(("tBaseAddress[Bank]=0x%08x n",BaseAddress[Bank]));
  1085.                 STTBX_Print(("tBlockInfo[Section].Address=0x%08x n",BlockInfo[Section].Address));
  1086. #endif
  1087.                 EraseOffset = BlockInfo[Section].Address - BaseAddress[Bank];
  1088.                 STTBX_Print(("bank %d block %2dt| 0x%08x | 0x%08x | ",
  1089.                              Bank, Section,
  1090.                              BlockInfo[Section].Address,
  1091.                              BlockInfo[Section].Address + BlockInfo[Section].Length - 1 ));
  1093.                 ErrCode = STFLASH_Erase( FLASHHndl[Bank],
  1094.                                          EraseOffset,
  1095.                                          BlockInfo[Section].Length );
  1096.                 if ( ErrCode != ST_NO_ERROR )
  1097.                 {
  1098.                     STTBX_Print(("Erase FAILEDn"));
  1099.                     EraseFailed = TRUE;
  1100.                 }
  1101.                 else
  1102.                     STTBX_Print(("ERASEDn"));
  1103.             }
  1104.         }
  1105.         
  1106.         STTBX_Print(("tt+------------+------------+n"));
  1107.     }
  1109.     if ( EraseFailed == TRUE )
  1110.     {
  1111.         FreeFileDataBuffer();
  1112.         STTBX_Print(("!!!! ERASE Failed !!!!n"));
  1113.         return TRUE;
  1114.     }
  1116.     return EraseFailed;
  1118. } /* end ProgramFlash */
  1121. /*-------------------------------------------------------------------------
  1122.  * Function : EraseLNBFlash
  1123.  *            Function to Read Hex file and erase areas required
  1124.  * Input    : Erasel 
  1125.  * Output   :
  1126.  * Return   : EraseFailed = TRUE else FALSE
  1127.  * ----------------------------------------------------------------------*/
  1128. BOOL EraseLogoFlash( BOOL Erasel )
  1129. {
  1130.     ST_ErrorCode_t ErrCode = ST_NO_ERROR;
  1131.     U8   Section, Bank;
  1132.     U32  EraseOffset;
  1133.     BOOL EraseFailed = TRUE;
  1135.     /* check data size */
  1136.     if ( Erasel )
  1137.     {
  1138.         EraseFailed = FALSE;
  1140.         STTBX_Print(("tt+------------+------------+n"));
  1141.         if ( Erasel )
  1142.         {
  1143.             for ( Section = wtFIRST_LOGO_BLOCK;( Section < wtFIRST_LOGO_BLOCK+wtLOGO_BLOCKS) && ( ErrCode == ST_NO_ERROR ); Section ++)
  1144.             {
  1145.                 Bank = BlockInfo[Section].Bank;
  1146. #ifdef DEBUG
  1147.                 STTBX_Print(("tBaseAddress[Bank]=0x%08x n",BaseAddress[Bank]));
  1148.                 STTBX_Print(("tBlockInfo[Section].Address=0x%08x n",BlockInfo[Section].Address));
  1149. #endif
  1150.                 EraseOffset = BlockInfo[Section].Address - BaseAddress[Bank];
  1151.                 STTBX_Print(("bank %d block %2dt| 0x%08x | 0x%08x | ",
  1152.                              Bank, Section,
  1153.                              BlockInfo[Section].Address,
  1154.                              BlockInfo[Section].Address + BlockInfo[Section].Length - 1 ));
  1156.                 ErrCode = STFLASH_Erase( FLASHHndl[Bank],
  1157.                                          EraseOffset,
  1158.                                          BlockInfo[Section].Length );
  1159.                 if ( ErrCode != ST_NO_ERROR )
  1160.                 {
  1161.                     STTBX_Print(("Erase FAILEDn"));
  1162.                     EraseFailed = TRUE;
  1163.                 }
  1164.                 else
  1165.                     STTBX_Print(("ERASEDn"));
  1166.             }
  1167.         }
  1168.         
  1169.         STTBX_Print(("tt+------------+------------+n"));
  1170.     }
  1172.     if ( EraseFailed == TRUE )
  1173.     {
  1174.         FreeFileDataBuffer();
  1175.         STTBX_Print(("!!!! ERASE Failed !!!!n"));
  1176.         return TRUE;
  1177.     }
  1179.     return EraseFailed;
  1181. } /* end ProgramFlash */
  1184. /*-------------------------------------------------------------------------
  1185.  * Function : EraseLNBFlash
  1186.  *            Function to Read Hex file and erase areas required
  1187.  * Input    : Erasel 
  1188.  * Output   :
  1189.  * Return   : EraseFailed = TRUE else FALSE
  1190.  * ----------------------------------------------------------------------*/
  1191. BOOL EraseLanguageFlash( BOOL Erasel )
  1192. {
  1193.     ST_ErrorCode_t ErrCode = ST_NO_ERROR;
  1194.     U8   Section, Bank;
  1195.     U32  EraseOffset;
  1196.     BOOL EraseFailed = TRUE;
  1198.     /* check data size */
  1199.     if ( Erasel )
  1200.     {
  1201.         EraseFailed = FALSE;
  1203.         STTBX_Print(("tt+------------+------------+n"));
  1204.         if ( Erasel )
  1205.         {
  1206.             for ( Section = wtFIRST_LANG_BLOCK;( Section <  wtFIRST_LANG_BLOCK+wtLANG_BLOCKS ) && ( ErrCode == ST_NO_ERROR ); Section ++)
  1207.             {
  1208.                 Bank = BlockInfo[Section].Bank;
  1209. #ifdef DEBUG
  1210.                 STTBX_Print(("tBaseAddress[Bank]=0x%08x n",BaseAddress[Bank]));
  1211.                 STTBX_Print(("tBlockInfo[Section].Address=0x%08x n",BlockInfo[Section].Address));
  1212. #endif
  1213.                 EraseOffset = BlockInfo[Section].Address - BaseAddress[Bank];
  1214.                 STTBX_Print(("bank %d block %2dt| 0x%08x | 0x%08x | ",
  1215.                              Bank, Section,
  1216.                              BlockInfo[Section].Address,
  1217.                              BlockInfo[Section].Address + BlockInfo[Section].Length - 1 ));
  1219.                 ErrCode = STFLASH_Erase( FLASHHndl[Bank],
  1220.                                          EraseOffset,
  1221.                                          BlockInfo[Section].Length );
  1222.                 if ( ErrCode != ST_NO_ERROR )
  1223.                 {
  1224.                     STTBX_Print(("Erase FAILEDn"));
  1225.                     EraseFailed = TRUE;
  1226.                 }
  1227.                 else
  1228.                     STTBX_Print(("ERASEDn"));
  1229.             }
  1230.         }
  1231.         
  1232.         STTBX_Print(("tt+------------+------------+n"));
  1233.     }
  1235.     if ( EraseFailed == TRUE )
  1236.     {
  1237.         FreeFileDataBuffer();
  1238.         STTBX_Print(("!!!! ERASE Failed !!!!n"));
  1239.         return TRUE;
  1240.     }
  1242.     return EraseFailed;
  1244. } /* end ProgramFlash */
  1246. /*-------------------------------------------------------------------------
  1247.  * Function : EraseCodeFlash
  1248.  *            Function to Read Hex file and erase areas required
  1249.  * Input    : EraseCode 
  1250.  * Output   :
  1251.  * Return   : EraseFailed = TRUE else FALSE
  1252.  * ----------------------------------------------------------------------*/
  1253. BOOL EraseCodeFlash( BOOL EraseCode )
  1254. {
  1255.     ST_ErrorCode_t ErrCode = ST_NO_ERROR;
  1256.     U8   Section, Bank;
  1257.     U32  EraseOffset;
  1258.     BOOL EraseFailed = TRUE;
  1260.     /* check data size */
  1261.     if ( EraseCode )
  1262.     {
  1263.         EraseFailed = FALSE;
  1265.         STTBX_Print(("tt+------------+------------+n"));
  1266.         if ( EraseCode )
  1267.         {
  1268.             for ( Section = 0;( Section < wtCODE_BLOCKS ) && ( ErrCode == ST_NO_ERROR ); Section ++)
  1269.             {
  1270.                 Bank = BlockInfo[Section].Bank;
  1271. #ifdef DEBUG
  1272.                 STTBX_Print(("tBaseAddress[Bank]=0x%08x n",BaseAddress[Bank]));
  1273.                 STTBX_Print(("tBlockInfo[Section].Address=0x%08x n",BlockInfo[Section].Address));
  1274. #endif
  1275.                 EraseOffset = BlockInfo[Section].Address - BaseAddress[Bank];
  1276.                 STTBX_Print(("bank %d block %2dt| 0x%08x | 0x%08x | ",
  1277.                              Bank, Section,
  1278.                              BlockInfo[Section].Address,
  1279.                              BlockInfo[Section].Address + BlockInfo[Section].Length - 1 ));
  1281.                 ErrCode = STFLASH_Erase( FLASHHndl[Bank],
  1282.                                          EraseOffset,
  1283.                                          BlockInfo[Section].Length );
  1284.                 if ( ErrCode != ST_NO_ERROR )
  1285.                 {
  1286.                     STTBX_Print(("Erase FAILEDn"));
  1287.                     EraseFailed = TRUE;
  1288.                 }
  1289.                 else
  1290.                     STTBX_Print(("ERASEDn"));
  1291.             }
  1292.         }
  1293.         
  1294.         STTBX_Print(("tt+------------+------------+n"));
  1295.     }
  1297.     if ( EraseFailed == TRUE )
  1298.     {
  1299.         FreeFileDataBuffer();
  1300.         STTBX_Print(("!!!! ERASE Failed !!!!n"));
  1301.         return TRUE;
  1302.     }
  1304.     return EraseFailed;
  1306. } /* end ProgramFlash */
  1309. /*-------------------------------------------------------------------------
  1310.  * Function : EraseFlash
  1311.  *            Function to Read Hex file and erase areas required
  1312.  * Input    : EraseAll 
  1313.  * Output   :
  1314.  * Return   : EraseFailed = TRUE else FALSE
  1315.  * ----------------------------------------------------------------------*/
  1316. BOOL EraseFlash( BOOL EraseAll )
  1317. {
  1318.     ST_ErrorCode_t ErrCode = ST_NO_ERROR;
  1319.     U8   Section, Bank;
  1320.     U32  EraseOffset;
  1321.     BOOL EraseFailed = TRUE;
  1322.   volatile char    *ptr_to_m;
  1324.     /* check data size */
  1325.     if (( FlashSize != 0 ) || EraseAll )
  1326.     {
  1327.         EraseFailed = FALSE;
  1329.         STTBX_Print(("tt+------------+------------+n"));
  1330.         if ( EraseAll )
  1331.         {
  1332.             for ( Section = 0;( Section < wtTOTAL_BLOCKS ) && ( ErrCode == ST_NO_ERROR ); Section ++)
  1333.             {
  1334.                 Bank = BlockInfo[Section].Bank;
  1335. #ifdef DEBUG
  1336.                 STTBX_Print(("tBaseAddress[Bank]=0x%08x n",BaseAddress[Bank]));
  1337.                 STTBX_Print(("tBlockInfo[Section].Address=0x%08x n",BlockInfo[Section].Address));
  1338. #endif
  1339.                 EraseOffset = BlockInfo[Section].Address - BaseAddress[Bank];
  1340.                 STTBX_Print(("bank %d block %2dt| 0x%08x | 0x%08x | ",
  1341.                              Bank, Section,
  1342.                              BlockInfo[Section].Address,
  1343.                              BlockInfo[Section].Address + BlockInfo[Section].Length - 1 ));
  1345.                 ErrCode = STFLASH_Erase( FLASHHndl[Bank],
  1346.                                          EraseOffset,
  1347.                                          BlockInfo[Section].Length );
  1348.                 if ( ErrCode != ST_NO_ERROR )
  1349.                 {
  1350.                     STTBX_Print(("Erase FAILEDn"));
  1351.                     EraseFailed = TRUE;
  1352.                 }
  1353.                 else
  1354.                     STTBX_Print(("ERASEDn"));
  1355.             }
  1356.   /* ===================== check whether array is erased================== */
  1358.   ptr_to_m = (char *)wtFlashBankBaseAddr;           /* point to lowest _add in FlashROM     */
  1359.   *ptr_to_m = (char) 0xf0f0;         /* read_array command                   */
  1361.   debugmessage("ROMTOOL> Checking whether the array has been fully erased....n");
  1363.     for(ptr_to_m = (char*)wtFlashBankBaseAddr;      /* point to flash_start and change type */
  1364.        ptr_to_m < (char *)(wtFlashBankBaseAddr+0x00200000);     /* point to flash_end and change type   */
  1365.        ptr_to_m++) {                    /* inc pointer                          */
  1367.     if (*ptr_to_m != 0xff){             /* check all bits are set to 1          */
  1368.       debugmessage("ROMTOOL>  ERROR!!! EPROM not erased properlyn");
  1369.       return 0;
  1370.     }
  1371.   }
  1372.   if( 1 )
  1373.     debugmessage( "ROMTOOL> Array has been erased successfully!an") ;
  1374.   
  1375.   /* ===================== check whether array is erased================== */
  1377.         }
  1378.         else
  1379.         {
  1380.             /* Find out which blocks are to be Erased */
  1382.             for ( Section = 0; ( Section < wtNUM_SECTIONS ) && ( EraseFailed == FALSE ); Section ++ )
  1383.             {
  1384.                 if ( SectionInfo[Section].Block != 0xFF )
  1385.                 {
  1386.                     /*
  1387.                     ** Erase = erase whole block, valid parameters are block base address & block size
  1388.                     */
  1389.                     Bank = BlockInfo[ SectionInfo[Section].Block ].Bank;
  1390.                     EraseOffset = BlockInfo[ SectionInfo[Section].Block ].Address - BaseAddress[Bank];
  1392.                     STTBX_Print(("block %2dt| 0x%08x | 0x%08x | ",
  1393.                                  SectionInfo[Section].Block,
  1394.                                  BlockInfo[ SectionInfo[Section].Block ].Address,
  1395.                                  BlockInfo[ SectionInfo[Section].Block ].Address +
  1396.                                  BlockInfo[ SectionInfo[Section].Block ].Length - 1 ));
  1397.                                  
  1398.                     ErrCode = STFLASH_Erase( FLASHHndl[Bank],
  1399.                                              EraseOffset,
  1400.                                              BlockInfo[ SectionInfo[Section].Block ].Length );
  1402.                     if ( ErrCode != ST_NO_ERROR )
  1403.                     {
  1404.                         STTBX_Print(("ErrCode = 0x%8xn",ErrCode));
  1405.                         STTBX_Print(("Erase FAILEDn"));
  1406.                         STTBX_Print(("FLASHHndl[Bank] = 0x%8Xn",FLASHHndl[Bank]));
  1407.                         EraseFailed = TRUE;
  1408.                     }
  1409.                     else
  1410.                         STTBX_Print(("ERASEDn"));
  1411.                 }
  1412.             }
  1413.         }
  1414.         STTBX_Print(("tt+------------+------------+n"));
  1415.     }
  1417.     if ( EraseFailed == TRUE )
  1418.     {
  1419.         FreeFileDataBuffer();
  1420.         STTBX_Print(("!!!! ERASE Failed !!!!n"));
  1421.         return TRUE;
  1422.     }
  1424.     return EraseFailed;
  1426. } /* end ProgramFlash */
  1428. /*-------------------------------------------------------------------------
  1429.  * Function : ProgramAllFlash
  1430.  *            Function to Read Hex file and program flash with contents
  1431.  * Input    :
  1432.  * Output   :
  1433.  * Return   : None
  1434.  * ----------------------------------------------------------------------*/
  1435. BOOL ProgramAllFlash( void )
  1436. {
  1437.     ST_ErrorCode_t      ErrCode;
  1438.     int                 Section, Bank;
  1439.     U32                 NumberOfBytes;
  1440.     BOOL                ProgramFailed;
  1442.     /* check data size */
  1443.     if ( FlashSize == 0 )
  1444.         ProgramFailed = TRUE;
  1445.     else
  1446.     {
  1447.         ProgramFailed = FALSE;
  1448.         STTBX_Print(("tt+------------+------------+n"));
  1449.     }
  1451.     /* Find out which blocks are to be written to */
  1452.     /* Write the data to the Flash */
  1453.     /*STTBX_Print(("Printing the contents of BlockInfo n"));
  1454.     for ( Section = 0; ( Section < wtNUM_SECTIONS ) ; Section ++ )
  1455.     {
  1456.         STTBX_Print(("Section=%dt", Section ));
  1457.         STTBX_Print(("SectionInfo[Section]=%dn", SectionInfo[Section] ));
  1458.         STTBX_Print(("SectionInfo[Section].Block=%dt", SectionInfo[Section].Block ));
  1459.         STTBX_Print(("BlockInfo[ SectionInfo[Section].Block ].Bank=%dn",BlockInfo[ SectionInfo[Section].Block ].Bank));
  1460.     }*/
  1462.     for ( Section = 0; ( Section < wtTOTAL_BLOCKS ) && ( ProgramFailed == FALSE ); Section ++ )
  1463.     {
  1464.         if ( SectionInfo[Section].Block != 0xFF )
  1465.         {
  1466.             U32  WriteOffset;
  1468.             /*
  1469.             ** Write = write bytes from Offset
  1470.             */
  1471.             Bank = BlockInfo[ SectionInfo[Section].Block ].Bank;
  1472. #ifdef DEBUG
  1473.             STTBX_Print(("Section=%dt", Section ));
  1474.             STTBX_Print(("SectionInfo[Section]=%dn", SectionInfo[Section] ));
  1475.             STTBX_Print(("SectionInfo[Section].Block=%dt", SectionInfo[Section].Block ));
  1476.             STTBX_Print(("BlockInfo[ SectionInfo[Section].Block ].Bank=%dn",BlockInfo[ SectionInfo[Section].Block ].Bank));
  1477. #endif
  1478.             WriteOffset = SectionInfo[Section].Address - BaseAddress[Bank];
  1479.             /*SectionInfo[Section].Address += 0x4; Tara*/
  1480.             STTBX_Print(("block %2dt| 0x%08x | 0x%08x | ",
  1481.                          SectionInfo[Section].Block,
  1482.                          SectionInfo[Section].Address,
  1483.                          SectionInfo[Section].Address + SectionInfo[Section].Size - 1 ));
  1485.             ErrCode = STFLASH_Write( FLASHHndl[Bank],
  1486.                                      WriteOffset,
  1487.                                      (U8*)&FlashData_p[SectionInfo[Section].Offset],
  1488.                                      SectionInfo[Section].Size,
  1489.                                      &NumberOfBytes );
  1491.             if ( ErrCode != ST_NO_ERROR )
  1492.             {
  1493.                 STTBX_Print(("Program FAILEDn"));
  1494.                 ProgramFailed = TRUE;
  1495.             }
  1496.             else
  1497.                 STTBX_Print(("PROGRAMMEDn"));
  1498.         }
  1499.     }
  1501.     if ( ProgramFailed == TRUE )
  1502.     {
  1503.         FreeFileDataBuffer();
  1504.         STTBX_Print(("!!!! PROGRAM Failed !!!!n"));
  1505.         return TRUE;
  1506.     }
  1507.     else
  1508.     {
  1509.         STTBX_Print(("tt+------------+------------+n"));
  1510.         return FALSE;
  1511.     }
  1513. } /* end ProgramAllFlash */
  1516. /*-------------------------------------------------------------------------
  1517.  * Function : ProgramLNBFlash
  1518.  *            Function to Read Hex file and program flash with contents
  1519.  * Input    :
  1520.  * Output   :
  1521.  * Return   : None
  1522.  * ----------------------------------------------------------------------*/
  1523. BOOL ProgramLNBFlash( void )
  1524. {
  1525.     ST_ErrorCode_t      ErrCode;
  1526.     int                 Section, Bank;
  1527.     U32                 NumberOfBytes;
  1528.     BOOL                ProgramFailed;
  1530.     /* check data size */
  1531.     if ( FlashSize == 0 )
  1532.         ProgramFailed = TRUE;
  1533.     else
  1534.     {
  1535.         ProgramFailed = FALSE;
  1536.         STTBX_Print(("tt+------------+------------+n"));
  1537.     }
  1539.     /* Find out which blocks are to be written to */
  1540.     /* Write the data to the Flash */
  1541.     /*STTBX_Print(("Printing the contents of BlockInfo n"));
  1542.     for ( Section = 0; ( Section < wtNUM_SECTIONS ) ; Section ++ )
  1543.     {
  1544.         STTBX_Print(("Section=%dt", Section ));
  1545.         STTBX_Print(("SectionInfo[Section]=%dn", SectionInfo[Section] ));
  1546.         STTBX_Print(("SectionInfo[Section].Block=%dt", SectionInfo[Section].Block ));
  1547.         STTBX_Print(("BlockInfo[ SectionInfo[Section].Block ].Bank=%dn",BlockInfo[ SectionInfo[Section].Block ].Bank));
  1548.     }*/
  1550.     for ( Section = wtFIRST_LNB_BLOCK; ( Section < wtFIRST_LNB_BLOCK+wtLNB_BLOCKS ) && ( ProgramFailed == FALSE ); Section ++ )
  1551.     {
  1552.         if ( SectionInfo[Section].Block != 0xFF )
  1553.         {
  1554.             U32  WriteOffset;
  1556.             /*
  1557.             ** Write = write bytes from Offset
  1558.             */
  1559.             Bank = BlockInfo[ SectionInfo[Section].Block ].Bank;
  1560. #ifdef DEBUG
  1561.             STTBX_Print(("Section=%dt", Section ));
  1562.             STTBX_Print(("SectionInfo[Section]=%dn", SectionInfo[Section] ));
  1563.             STTBX_Print(("SectionInfo[Section].Block=%dt", SectionInfo[Section].Block ));
  1564.             STTBX_Print(("BlockInfo[ SectionInfo[Section].Block ].Bank=%dn",BlockInfo[ SectionInfo[Section].Block ].Bank));
  1565. #endif
  1566.             WriteOffset = SectionInfo[Section].Address - BaseAddress[Bank];
  1567.             /*SectionInfo[Section].Address += 0x4; Tara*/
  1568.             STTBX_Print(("block %2dt| 0x%08x | 0x%08x | ",
  1569.                          SectionInfo[Section].Block,
  1570.                          SectionInfo[Section].Address,
  1571.                          SectionInfo[Section].Address + SectionInfo[Section].Size - 1 ));
  1573.             ErrCode = STFLASH_Write( FLASHHndl[Bank],
  1574.                                      WriteOffset,
  1575.                                      (U8*)&FlashData_p[SectionInfo[Section-wtFIRST_LNB_BLOCK].Offset],
  1576.                                      SectionInfo[Section-wtFIRST_LNB_BLOCK].Size,
  1577.                                      &NumberOfBytes );
  1579.             if ( ErrCode != ST_NO_ERROR )
  1580.             {
  1581.                 STTBX_Print(("Program FAILEDn"));
  1582.                 ProgramFailed = TRUE;
  1583.             }
  1584.             else
  1585.                 STTBX_Print(("PROGRAMMEDn"));
  1586.         }
  1587.     }
  1589.     if ( ProgramFailed == TRUE )
  1590.     {
  1591.         FreeFileDataBuffer();
  1592.         STTBX_Print(("!!!! PROGRAM Failed !!!!n"));
  1593.         return TRUE;
  1594.     }
  1595.     else
  1596.     {
  1597.         STTBX_Print(("tt+------------+------------+n"));
  1598.         return FALSE;
  1599.     }
  1601. } /* end ProgramLNBFlash */
  1605. /*-------------------------------------------------------------------------
  1606.  * Function : ProgramLNBFlash
  1607.  *            Function to Read Hex file and program flash with contents
  1608.  * Input    :
  1609.  * Output   :
  1610.  * Return   : None
  1611.  * ----------------------------------------------------------------------*/
  1612. BOOL ProgramLogoFlash( void )
  1613. {
  1614.     ST_ErrorCode_t      ErrCode;
  1615.     int                 Section, Bank;
  1616.     U32                 NumberOfBytes;
  1617.     BOOL                ProgramFailed;
  1619.     /* check data size */
  1620.     if ( FlashSize == 0 )
  1621.         ProgramFailed = TRUE;
  1622.     else
  1623.     {
  1624.         ProgramFailed = FALSE;
  1625.         STTBX_Print(("tt+------------+------------+n"));
  1626.     }
  1628.     /* Find out which blocks are to be written to */
  1629.     /* Write the data to the Flash */
  1630.     /*STTBX_Print(("Printing the contents of BlockInfo n"));
  1631.     for ( Section = 0; ( Section < wtNUM_SECTIONS ) ; Section ++ )
  1632.     {
  1633.         STTBX_Print(("Section=%dt", Section ));
  1634.         STTBX_Print(("SectionInfo[Section]=%dn", SectionInfo[Section] ));
  1635.         STTBX_Print(("SectionInfo[Section].Block=%dt", SectionInfo[Section].Block ));
  1636.         STTBX_Print(("BlockInfo[ SectionInfo[Section].Block ].Bank=%dn",BlockInfo[ SectionInfo[Section].Block ].Bank));
  1637.     }*/
  1639.     for ( Section = wtFIRST_LOGO_BLOCK; ( Section < wtFIRST_LOGO_BLOCK+wtLOGO_BLOCKS ) && ( ProgramFailed == FALSE ); Section ++ )
  1640.     {
  1641.         if ( SectionInfo[Section].Block != 0xFF )
  1642.         {
  1643.             U32  WriteOffset;
  1645.             /*
  1646.             ** Write = write bytes from Offset
  1647.             */
  1648.             Bank = BlockInfo[ SectionInfo[Section].Block ].Bank;
  1649. #ifdef DEBUG
  1650.             STTBX_Print(("Section=%dt", Section ));
  1651.             STTBX_Print(("SectionInfo[Section]=%dn", SectionInfo[Section] ));
  1652.             STTBX_Print(("SectionInfo[Section].Block=%dt", SectionInfo[Section].Block ));
  1653.             STTBX_Print(("BlockInfo[ SectionInfo[Section].Block ].Bank=%dn",BlockInfo[ SectionInfo[Section].Block ].Bank));
  1654. #endif
  1655.             WriteOffset = SectionInfo[Section].Address - BaseAddress[Bank];
  1656.             /*SectionInfo[Section].Address += 0x4; Tara*/
  1657.             STTBX_Print(("block %2dt| 0x%08x | 0x%08x | ",
  1658.                          SectionInfo[Section].Block,
  1659.                          SectionInfo[Section].Address,
  1660.                          SectionInfo[Section].Address + SectionInfo[Section].Size - 1 ));
  1662.             ErrCode = STFLASH_Write( FLASHHndl[Bank],
  1663.                                      WriteOffset,
  1664.                                      (U8*)&FlashData_p[SectionInfo[Section-wtFIRST_LOGO_BLOCK].Offset],
  1665.                                      SectionInfo[Section-wtFIRST_LOGO_BLOCK].Size,
  1666.                                      &NumberOfBytes );
  1668.             if ( ErrCode != ST_NO_ERROR )
  1669.             {
  1670.                 STTBX_Print(("Program FAILEDn"));
  1671.                 ProgramFailed = TRUE;
  1672.             }
  1673.             else
  1674.                 STTBX_Print(("PROGRAMMEDn"));
  1675.         }
  1676.     }
  1678.     if ( ProgramFailed == TRUE )
  1679.     {
  1680.         FreeFileDataBuffer();
  1681.         STTBX_Print(("!!!! PROGRAM Failed !!!!n"));
  1682.         return TRUE;
  1683.     }
  1684.     else
  1685.     {
  1686.         STTBX_Print(("tt+------------+------------+n"));
  1687.         return FALSE;
  1688.     }
  1690. } /* end ProgramLNBFlash */
  1693. /*-------------------------------------------------------------------------
  1694.  * Function : ProgramLNBFlash
  1695.  *            Function to Read Hex file and program flash with contents
  1696.  * Input    :
  1697.  * Output   :
  1698.  * Return   : None
  1699.  * ----------------------------------------------------------------------*/
  1700. BOOL ProgramLanguageFlash( void )
  1701. {
  1702.     ST_ErrorCode_t      ErrCode;
  1703.     int                 Section, Bank;
  1704.     U32                 NumberOfBytes;
  1705.     BOOL                ProgramFailed;
  1707.     /* check data size */
  1708.     if ( FlashSize == 0 )
  1709.         ProgramFailed = TRUE;
  1710.     else
  1711.     {
  1712.         ProgramFailed = FALSE;
  1713.         STTBX_Print(("tt+------------+------------+n"));
  1714.     }
  1716.     /* Find out which blocks are to be written to */
  1717.     /* Write the data to the Flash */
  1718.     /*STTBX_Print(("Printing the contents of BlockInfo n"));
  1719.     for ( Section = 0; ( Section < wtNUM_SECTIONS ) ; Section ++ )
  1720.     {
  1721.         STTBX_Print(("Section=%dt", Section ));
  1722.         STTBX_Print(("SectionInfo[Section]=%dn", SectionInfo[Section] ));
  1723.         STTBX_Print(("SectionInfo[Section].Block=%dt", SectionInfo[Section].Block ));
  1724.         STTBX_Print(("BlockInfo[ SectionInfo[Section].Block ].Bank=%dn",BlockInfo[ SectionInfo[Section].Block ].Bank));
  1725.     }*/
  1727.     for ( Section = wtFIRST_LANG_BLOCK; ( Section < wtFIRST_LANG_BLOCK+wtLANG_BLOCKS ) && ( ProgramFailed == FALSE ); Section ++ )
  1728.     {
  1729.         if ( SectionInfo[Section].Block != 0xFF )
  1730.         {
  1731.             U32  WriteOffset;
  1733.             /*
  1734.             ** Write = write bytes from Offset
  1735.             */
  1736.             Bank = BlockInfo[ SectionInfo[Section].Block ].Bank;
  1737. #ifdef DEBUG
  1738.             STTBX_Print(("Section=%dt", Section ));
  1739.             STTBX_Print(("SectionInfo[Section]=%dn", SectionInfo[Section] ));
  1740.             STTBX_Print(("SectionInfo[Section].Block=%dt", SectionInfo[Section].Block ));
  1741.             STTBX_Print(("BlockInfo[ SectionInfo[Section].Block ].Bank=%dn",BlockInfo[ SectionInfo[Section].Block ].Bank));
  1742. #endif
  1743.             WriteOffset = SectionInfo[Section].Address - BaseAddress[Bank];
  1744.             /*SectionInfo[Section].Address += 0x4; Tara*/
  1745.             STTBX_Print(("block %2dt| 0x%08x | 0x%08x | ",
  1746.                          SectionInfo[Section].Block,
  1747.                          SectionInfo[Section].Address,
  1748.                          SectionInfo[Section].Address + SectionInfo[Section].Size - 1 ));
  1750.             ErrCode = STFLASH_Write( FLASHHndl[Bank],
  1751.                                      WriteOffset,
  1752.                                      (U8*)&FlashData_p[SectionInfo[Section-wtFIRST_LANG_BLOCK].Offset],
  1753.                                      SectionInfo[Section-wtFIRST_LANG_BLOCK].Size,
  1754.                                      &NumberOfBytes );
  1756.             if ( ErrCode != ST_NO_ERROR )
  1757.             {
  1758.                 STTBX_Print(("Program FAILEDn"));
  1759.                 ProgramFailed = TRUE;
  1760.             }
  1761.             else
  1762.                 STTBX_Print(("PROGRAMMEDn"));
  1763.         }
  1764.     }
  1766.     if ( ProgramFailed == TRUE )
  1767.     {
  1768.         FreeFileDataBuffer();
  1769.         STTBX_Print(("!!!! PROGRAM Failed !!!!n"));
  1770.         return TRUE;
  1771.     }
  1772.     else
  1773.     {
  1774.         STTBX_Print(("tt+------------+------------+n"));
  1775.         return FALSE;
  1776.     }
  1778. } /* end ProgramLNBFlash */
  1780. /*-------------------------------------------------------------------------
  1781.  * Function : ProgramFlash
  1782.  *            Function to Read Hex file and program flash with contents
  1783.  * Input    :
  1784.  * Output   :
  1785.  * Return   : None
  1786.  * ----------------------------------------------------------------------*/
  1787. BOOL ProgramFlash( void )
  1788. {
  1789.     ST_ErrorCode_t      ErrCode;
  1790.     int                 Section, Bank;
  1791.     U32                 NumberOfBytes;
  1792.     BOOL                ProgramFailed;
  1794.     /* check data size */
  1795.     if ( FlashSize == 0 )
  1796.         ProgramFailed = TRUE;
  1797.     else
  1798.     {
  1799.         ProgramFailed = FALSE;
  1800.         STTBX_Print(("tt+------------+------------+n"));
  1801.     }
  1803.     /* Find out which blocks are to be written to */
  1804.     /* Write the data to the Flash */
  1805.     /*STTBX_Print(("Printing the contents of BlockInfo n"));
  1806.     for ( Section = 0; ( Section < wtNUM_SECTIONS ) ; Section ++ )
  1807.     {
  1808.         STTBX_Print(("Section=%dt", Section ));
  1809.         STTBX_Print(("SectionInfo[Section]=%dn", SectionInfo[Section] ));
  1810.         STTBX_Print(("SectionInfo[Section].Block=%dt", SectionInfo[Section].Block ));
  1811.         STTBX_Print(("BlockInfo[ SectionInfo[Section].Block ].Bank=%dn",BlockInfo[ SectionInfo[Section].Block ].Bank));
  1812.     }*/
  1814.     for ( Section = 0; ( Section < wtNUM_SECTIONS ) && ( ProgramFailed == FALSE ); Section ++ )
  1815.     {
  1816.         if ( SectionInfo[Section].Block != 0xFF )
  1817.         {
  1818.             U32  WriteOffset;
  1820.             /*
  1821.             ** Write = write bytes from Offset
  1822.             */
  1823.             Bank = BlockInfo[ SectionInfo[Section].Block ].Bank;
  1824. #ifdef DEBUG
  1825.             STTBX_Print(("Section=%dt", Section ));
  1826.             STTBX_Print(("SectionInfo[Section]=%dn", SectionInfo[Section] ));
  1827.             STTBX_Print(("SectionInfo[Section].Block=%dt", SectionInfo[Section].Block ));
  1828.             STTBX_Print(("BlockInfo[ SectionInfo[Section].Block ].Bank=%dn",BlockInfo[ SectionInfo[Section].Block ].Bank));
  1829. #endif
  1830.             WriteOffset = SectionInfo[Section].Address - BaseAddress[Bank];
  1831.             /*SectionInfo[Section].Address += 0x4; Tara*/
  1832.             STTBX_Print(("block %2dt| 0x%08x | 0x%08x | ",
  1833.                          SectionInfo[Section].Block,
  1834.                          SectionInfo[Section].Address,
  1835.                          SectionInfo[Section].Address + SectionInfo[Section].Size - 1 ));
  1837.             ErrCode = STFLASH_Write( FLASHHndl[Bank],
  1838.                                      WriteOffset,
  1839.                                      (U8*)&FlashData_p[SectionInfo[Section].Offset],
  1840.                                      SectionInfo[Section].Size,
  1841.                                      &NumberOfBytes );
  1843.             if ( ErrCode != ST_NO_ERROR )
  1844.             {
  1845.                 STTBX_Print(("Program FAILEDn"));
  1846.                 ProgramFailed = TRUE;
  1847.             }
  1848.             else
  1849.                 STTBX_Print(("PROGRAMMEDn"));
  1850.         }
  1851.     }
  1853.     if ( ProgramFailed == TRUE )
  1854.     {
  1855.         FreeFileDataBuffer();
  1856.         STTBX_Print(("!!!! PROGRAM Failed !!!!n"));
  1857.         return TRUE;
  1858.     }
  1859.     else
  1860.     {
  1861.         STTBX_Print(("tt+------------+------------+n"));
  1862.         return FALSE;
  1863.     }
  1865. } /* end ProgramFlash */
  1868. /*-------------------------------------------------------------------------
  1869.  * Function : VerifyAllFlash
  1870.  *            Function to Read Hex file and verify flash with contents
  1871.  * Input    :
  1872.  * Output   :
  1873.  * Return   : None
  1874.  * ----------------------------------------------------------------------*/
  1875. BOOL VerifyAllFlash( void )
  1876. {
  1877.     ST_ErrorCode_t      ErrCode = ST_NO_ERROR;
  1878.     int                 Section, Bank;
  1879.     U32                 Length;
  1880.     U32                 ReadOffset;
  1881.     U32                 NumberOfBytes;
  1882.     U8                  *Buffer_p;
  1883.     BOOL                VerifyFailed;
  1885.     /* check data size */
  1886.     if ( FlashSize == 0 )
  1887.         VerifyFailed = TRUE;
  1888.     else
  1889.     {
  1890.         VerifyFailed = FALSE;
  1891.         STTBX_Print(("tt+------------+------------+n"));
  1892.     }
  1894.     /* Find out which blocks are to be verified */
  1895.     /* Read the data and compare */
  1897.     for ( Section = 0; ( Section < wtTOTAL_BLOCKS ) && ( VerifyFailed == FALSE ); Section ++ )
  1898.     {
  1899.         if ( SectionInfo[Section].Block != 0xFF )
  1900.         {
  1901.             Bank = BlockInfo[ SectionInfo[Section].Block ].Bank;
  1902.             Length = BlockInfo[ SectionInfo[Section].Block ].Length;
  1903.             ReadOffset = SectionInfo[Section].Address - BaseAddress[Bank];
  1905.             /* allocate temp buffer to put flash data in */
  1906.             Buffer_p = memory_allocate( SystemPartition, Length );
  1907.             if ( Buffer_p != NULL )
  1908.             {
  1909.                 STTBX_Print(("block %2dt| 0x%08x | 0x%08x | ",
  1910.                          SectionInfo[Section].Block,
  1911.                          SectionInfo[Section].Address,
  1912.                          SectionInfo[Section].Address + SectionInfo[Section].Size - 1 ));
  1914.                 ErrCode = STFLASH_Read( FLASHHndl[Bank],
  1915.                                         ReadOffset,
  1916.                                         Buffer_p,
  1917.                                         SectionInfo[Section].Size,
  1918.                                         &NumberOfBytes );
  1919.                 if(ErrCode != ST_NO_ERROR)
  1920.                 {
  1921.                     STTBX_Print(("STFLASH_Read %sn",wts_GetErrorText(ErrCode)));
  1922.                 }
  1924.                 if ( memcmp( Buffer_p,(U8*)&FlashData_p[SectionInfo[Section].Offset],
  1925.                              SectionInfo[Section].Size ) != 0 )
  1926.                 {
  1927.                     STTBX_Print(("Verify FAILEDn"));
  1928.                     VerifyFailed = TRUE;
  1929.                 }
  1930.                 else
  1931.                     STTBX_Print(("VERIFIEDn"));
  1933.                 /* deallocate temp buffer */
  1934.                 memory_deallocate( SystemPartition, Buffer_p );
  1935.             }
  1936.         }
  1937.     }
  1939.     FreeFileDataBuffer();
  1940.     
  1941.     if ( VerifyFailed == TRUE )
  1942.     {
  1943.         STTBX_Print(("!!!! VERIFY Failed !!!!n"));
  1944.         return TRUE;
  1945.     }
  1946.     else
  1947.     {
  1948.         STTBX_Print(("tt+------------+------------+n"));
  1949.         return FALSE;
  1950.     }
  1952. } /* end VerifyAllFlash */
  1955. /*-------------------------------------------------------------------------
  1956.  * Function : VerifyLNBFlash
  1957.  *            Function to Read Hex file and verify flash with contents
  1958.  * Input    :
  1959.  * Output   :
  1960.  * Return   : None
  1961.  * ----------------------------------------------------------------------*/
  1962. BOOL VerifyLNBFlash( void )
  1963. {
  1964.     ST_ErrorCode_t      ErrCode = ST_NO_ERROR;
  1965.     int                 Section, Bank;
  1966.     U32                 Length;
  1967.     U32                 ReadOffset;
  1968.     U32                 NumberOfBytes;
  1969.     U8                  *Buffer_p;
  1970.     BOOL                VerifyFailed;
  1972.     /* check data size */
  1973.     if ( FlashSize == 0 )
  1974.         VerifyFailed = TRUE;
  1975.     else
  1976.     {
  1977.         VerifyFailed = FALSE;
  1978.         STTBX_Print(("tt+------------+------------+n"));
  1979.     }
  1981.     /* Find out which blocks are to be verified */
  1982.     /* Read the data and compare */
  1984.     for ( Section = wtFIRST_LNB_BLOCK; ( Section < wtFIRST_LNB_BLOCK+wtLNB_BLOCKS  ) && ( VerifyFailed == FALSE ); Section ++ )
  1985.     {
  1986.         if ( SectionInfo[Section].Block != 0xFF )
  1987.         {
  1988.             Bank = BlockInfo[ SectionInfo[Section].Block ].Bank;
  1989.             Length = BlockInfo[ SectionInfo[Section].Block ].Length;
  1990.             ReadOffset = SectionInfo[Section].Address - BaseAddress[Bank];
  1992.             /* allocate temp buffer to put flash data in */
  1993.             Buffer_p = memory_allocate( SystemPartition, Length );
  1994.             if ( Buffer_p != NULL )
  1995.             {
  1996.                 STTBX_Print(("block %2dt| 0x%08x | 0x%08x | ",
  1997.                          SectionInfo[Section].Block,
  1998.                          SectionInfo[Section].Address,
  1999.                          SectionInfo[Section].Address + SectionInfo[Section].Size - 1 ));
  2001.                 ErrCode = STFLASH_Read( FLASHHndl[Bank],
  2002.                                         ReadOffset,
  2003.                                         Buffer_p,
  2004.                                         SectionInfo[Section].Size,
  2005.                                         &NumberOfBytes );
  2006.                 if(ErrCode != ST_NO_ERROR)
  2007.                 {
  2008.                     STTBX_Print(("STFLASH_Read %sn",wts_GetErrorText(ErrCode)));
  2009.                 }
  2011.                 if ( memcmp( Buffer_p,(U8*)&FlashData_p[SectionInfo[Section-wtFIRST_LNB_BLOCK].Offset],
  2012.                              SectionInfo[Section-wtFIRST_LNB_BLOCK].Size ) != 0 )
  2013.                 {
  2014.                     STTBX_Print(("Verify FAILEDn"));
  2015.                     VerifyFailed = TRUE;
  2016.                 }
  2017.                 else
  2018.                     STTBX_Print(("VERIFIEDn"));
  2020.                 /* deallocate temp buffer */
  2021.                 memory_deallocate( SystemPartition, Buffer_p );
  2022.             }
  2023.         }
  2024.     }
  2026.     FreeFileDataBuffer();
  2027.     
  2028.     if ( VerifyFailed == TRUE )
  2029.     {
  2030.         STTBX_Print(("!!!! VERIFY Failed !!!!n"));
  2031.         return TRUE;
  2032.     }
  2033.     else
  2034.     {
  2035.         STTBX_Print(("tt+------------+------------+n"));
  2036.         return FALSE;
  2037.     }
  2039. } /* end VerifyLNBFlash */
  2043. /*-------------------------------------------------------------------------
  2044.  * Function : VerifyLNBFlash
  2045.  *            Function to Read Hex file and verify flash with contents
  2046.  * Input    :
  2047.  * Output   :
  2048.  * Return   : None
  2049.  * ----------------------------------------------------------------------*/
  2050. BOOL VerifyLogoFlash( void )
  2051. {
  2052.     ST_ErrorCode_t      ErrCode = ST_NO_ERROR;
  2053.     int                 Section, Bank;
  2054.     U32                 Length;
  2055.     U32                 ReadOffset;
  2056.     U32                 NumberOfBytes;
  2057.     U8                  *Buffer_p;
  2058.     BOOL                VerifyFailed;
  2060.     /* check data size */
  2061.     if ( FlashSize == 0 )
  2062.         VerifyFailed = TRUE;
  2063.     else
  2064.     {
  2065.         VerifyFailed = FALSE;
  2066.         STTBX_Print(("tt+------------+------------+n"));
  2067.     }
  2069.     /* Find out which blocks are to be verified */
  2070.     /* Read the data and compare */
  2072.     for ( Section = wtFIRST_LOGO_BLOCK; ( Section < wtFIRST_LOGO_BLOCK+wtLOGO_BLOCKS ) && ( VerifyFailed == FALSE ); Section ++ )
  2073.     {
  2074.         if ( SectionInfo[Section].Block != 0xFF )
  2075.         {
  2076.             Bank = BlockInfo[ SectionInfo[Section].Block ].Bank;
  2077.             Length = BlockInfo[ SectionInfo[Section].Block ].Length;
  2078.             ReadOffset = SectionInfo[Section].Address - BaseAddress[Bank];
  2080.             /* allocate temp buffer to put flash data in */
  2081.             Buffer_p = memory_allocate( SystemPartition, Length );
  2082.             if ( Buffer_p != NULL )
  2083.             {
  2084.                 STTBX_Print(("block %2dt| 0x%08x | 0x%08x | ",
  2085.                          SectionInfo[Section].Block,
  2086.                          SectionInfo[Section].Address,
  2087.                          SectionInfo[Section].Address + SectionInfo[Section].Size - 1 ));
  2089.                 ErrCode = STFLASH_Read( FLASHHndl[Bank],
  2090.                                         ReadOffset,
  2091.                                         Buffer_p,
  2092.                                         SectionInfo[Section].Size,
  2093.                                         &NumberOfBytes );
  2094.                 if(ErrCode != ST_NO_ERROR)
  2095.                 {
  2096.                     STTBX_Print(("STFLASH_Read %sn",wts_GetErrorText(ErrCode)));
  2097.                 }
  2099.                 if ( memcmp( Buffer_p,(U8*)&FlashData_p[SectionInfo[Section-wtFIRST_LOGO_BLOCK].Offset],
  2100.                              SectionInfo[Section-wtFIRST_LOGO_BLOCK].Size ) != 0 )
  2101.                 {
  2102.                     STTBX_Print(("Verify FAILEDn"));
  2103.                     VerifyFailed = TRUE;
  2104.                 }
  2105.                 else
  2106.                     STTBX_Print(("VERIFIEDn"));
  2108.                 /* deallocate temp buffer */
  2109.                 memory_deallocate( SystemPartition, Buffer_p );
  2110.             }
  2111.         }
  2112.     }
  2114.     FreeFileDataBuffer();
  2115.     
  2116.     if ( VerifyFailed == TRUE )
  2117.     {
  2118.         STTBX_Print(("!!!! VERIFY Failed !!!!n"));
  2119.         return TRUE;
  2120.     }
  2121.     else
  2122.     {
  2123.         STTBX_Print(("tt+------------+------------+n"));
  2124.         return FALSE;
  2125.     }
  2127. } /* end VerifyLNBFlash */
  2132. /*-------------------------------------------------------------------------
  2133.  * Function : VerifyLNBFlash
  2134.  *            Function to Read Hex file and verify flash with contents
  2135.  * Input    :
  2136.  * Output   :
  2137.  * Return   : None
  2138.  * ----------------------------------------------------------------------*/
  2139. BOOL VerifyLanguageFlash( void )
  2140. {
  2141.     ST_ErrorCode_t      ErrCode = ST_NO_ERROR;
  2142.     int                 Section, Bank;
  2143.     U32                 Length;
  2144.     U32                 ReadOffset;
  2145.     U32                 NumberOfBytes;
  2146.     U8                  *Buffer_p;
  2147.     BOOL                VerifyFailed;
  2149.     /* check data size */
  2150.     if ( FlashSize == 0 )
  2151.         VerifyFailed = TRUE;
  2152.     else
  2153.     {
  2154.         VerifyFailed = FALSE;
  2155.         STTBX_Print(("tt+------------+------------+n"));
  2156.     }
  2158.     /* Find out which blocks are to be verified */
  2159.     /* Read the data and compare */
  2161.     for ( Section = wtFIRST_LANG_BLOCK; ( Section < wtFIRST_LANG_BLOCK+wtLANG_BLOCKS ) && ( VerifyFailed == FALSE ); Section ++ )
  2162.     {
  2163.         if ( SectionInfo[Section].Block != 0xFF )
  2164.         {
  2165.             Bank = BlockInfo[ SectionInfo[Section].Block ].Bank;
  2166.             Length = BlockInfo[ SectionInfo[Section].Block ].Length;
  2167.             ReadOffset = SectionInfo[Section].Address - BaseAddress[Bank];
  2169.             /* allocate temp buffer to put flash data in */
  2170.             Buffer_p = memory_allocate( SystemPartition, Length );
  2171.             if ( Buffer_p != NULL )
  2172.             {
  2173.                 STTBX_Print(("block %2dt| 0x%08x | 0x%08x | ",
  2174.                          SectionInfo[Section].Block,
  2175.                          SectionInfo[Section].Address,
  2176.                          SectionInfo[Section].Address + SectionInfo[Section].Size - 1 ));
  2178.                 ErrCode = STFLASH_Read( FLASHHndl[Bank],
  2179.                                         ReadOffset,
  2180.                                         Buffer_p,
  2181.                                         SectionInfo[Section].Size,
  2182.                                         &NumberOfBytes );
  2183.                 if(ErrCode != ST_NO_ERROR)
  2184.                 {
  2185.                     STTBX_Print(("STFLASH_Read %sn",wts_GetErrorText(ErrCode)));
  2186.                 }
  2188.                 if ( memcmp( Buffer_p,(U8*)&FlashData_p[SectionInfo[Section-wtFIRST_LANG_BLOCK].Offset],
  2189.                              SectionInfo[Section-wtFIRST_LANG_BLOCK].Size ) != 0 )
  2190.                 {
  2191.                     STTBX_Print(("Verify FAILEDn"));
  2192.                     VerifyFailed = TRUE;
  2193.                 }
  2194.                 else
  2195.                     STTBX_Print(("VERIFIEDn"));
  2197.                 /* deallocate temp buffer */
  2198.                 memory_deallocate( SystemPartition, Buffer_p );
  2199.             }
  2200.         }
  2201.     }
  2203.     FreeFileDataBuffer();
  2204.     
  2205.     if ( VerifyFailed == TRUE )
  2206.     {
  2207.         STTBX_Print(("!!!! VERIFY Failed !!!!n"));
  2208.         return TRUE;
  2209.     }
  2210.     else
  2211.     {
  2212.         STTBX_Print(("tt+------------+------------+n"));
  2213.         return FALSE;
  2214.     }
  2216. } /* end VerifyLNBFlash */
  2218. /*-------------------------------------------------------------------------
  2219.  * Function : VerifyFlash
  2220.  *            Function to Read Hex file and verify flash with contents
  2221.  * Input    :
  2222.  * Output   :
  2223.  * Return   : None
  2224.  * ----------------------------------------------------------------------*/
  2225. BOOL VerifyFlash( void )
  2226. {
  2227.     ST_ErrorCode_t      ErrCode = ST_NO_ERROR;
  2228.     int                 Section, Bank;
  2229.     U32                 Length;
  2230.     U32                 ReadOffset;
  2231.     U32                 NumberOfBytes;
  2232.     U8                  *Buffer_p;
  2233.     BOOL                VerifyFailed;
  2235.     /* check data size */
  2236.     if ( FlashSize == 0 )
  2237.         VerifyFailed = TRUE;
  2238.     else
  2239.     {
  2240.         VerifyFailed = FALSE;
  2241.         STTBX_Print(("tt+------------+------------+n"));
  2242.     }
  2244.     /* Find out which blocks are to be verified */
  2245.     /* Read the data and compare */
  2247.     for ( Section = 0; ( Section < wtNUM_SECTIONS ) && ( VerifyFailed == FALSE ); Section ++ )
  2248.     {
  2249.         if ( SectionInfo[Section].Block != 0xFF )
  2250.         {
  2251.             Bank = BlockInfo[ SectionInfo[Section].Block ].Bank;
  2252.             Length = BlockInfo[ SectionInfo[Section].Block ].Length;
  2253.             ReadOffset = SectionInfo[Section].Address - BaseAddress[Bank];
  2255.             /* allocate temp buffer to put flash data in */
  2256.             Buffer_p = memory_allocate( SystemPartition, Length );
  2257.             if ( Buffer_p != NULL )
  2258.             {
  2259.                 STTBX_Print(("block %2dt| 0x%08x | 0x%08x | ",
  2260.                          SectionInfo[Section].Block,
  2261.                          SectionInfo[Section].Address,
  2262.                          SectionInfo[Section].Address + SectionInfo[Section].Size - 1 ));
  2264.                 ErrCode = STFLASH_Read( FLASHHndl[Bank],
  2265.                                         ReadOffset,
  2266.                                         Buffer_p,
  2267.                                         SectionInfo[Section].Size,
  2268.                                         &NumberOfBytes );
  2269.                 if(ErrCode != ST_NO_ERROR)
  2270.                 {
  2271.                     STTBX_Print(("STFLASH_Read %sn",wts_GetErrorText(ErrCode)));
  2272.                 }
  2274.                 if ( memcmp( Buffer_p,(U8*)&FlashData_p[SectionInfo[Section].Offset],
  2275.                              SectionInfo[Section].Size ) != 0 )
  2276.                 {
  2277.                     STTBX_Print(("Verify FAILEDn"));
  2278.                     VerifyFailed = TRUE;
  2279.                 }
  2280.                 else
  2281.                     STTBX_Print(("VERIFIEDn"));
  2283.                 /* deallocate temp buffer */
  2284.                 memory_deallocate( SystemPartition, Buffer_p );
  2285.             }
  2286.         }
  2287.     }
  2289.     FreeFileDataBuffer();
  2290.     
  2291.     if ( VerifyFailed == TRUE )
  2292.     {
  2293.         STTBX_Print(("!!!! VERIFY Failed !!!!n"));
  2294.         return TRUE;
  2295.     }
  2296.     else
  2297.     {
  2298.         STTBX_Print(("tt+------------+------------+n"));
  2299.         return FALSE;
  2300.     }
  2302. } /* end VerifyFlash */
  2304. /* Testtool Functions --------------------------------------------------- */
  2306. #ifdef TESTTOOL
  2307. /*-------------------------------------------------------------------------
  2308.  * Function : TTFLASH_GetParams
  2309.  *            
  2310.  * Input    : *pars_p, *result_sym_p
  2311.  * Output   :
  2312.  * Return   : TRUE if error, FALSE if success
  2313.  * ----------------------------------------------------------------------*/
  2314. static BOOL TTFLASH_GetParams( STTST_Parse_t *pars_p, char *Result )
  2315. {
  2316.     ST_ErrorCode_t      ErrCode;
  2317.     STFLASH_Params_t    FLASHParams;
  2318.     STFLASH_Params_t    *FLASHParams_p;
  2319.     U8                  BankNum;
  2320.     U8                  Block;
  2321.     U32                 BlockStart;
  2323.     /* Get Flash bank parameter from command line */
  2324.     STTST_GetInteger( pars_p, BANK0, (S32 *)&BankNum );
  2326.     ErrCode = FLASH_GetParams(BankNum, &FLASHParams);
  2328.     FLASHParams_p = &FLASHParams;
  2329.     BlockStart = (U32) FLASHParams_p->InitParams.BaseAddress;
  2331.     STTBX_Print(("Bank %d, Blocks %dn", BankNum,
  2332.                  FLASHParams_p->InitParams.NumberOfBlocks ));
  2333.     STTBX_Print(("Base Address      0x%08xn", FLASHParams_p->InitParams.BaseAddress ));
  2334.     STTBX_Print(("VppAddress        0x%08xn",FLASHParams_p->InitParams.VppAddress ));
  2335.     STTBX_Print(("Manufacturer Code 0x%08Xn", FLASHParams_p->ManufactCode ));
  2336.     STTBX_Print(("Device Code       0x%08Xn", FLASHParams_p->DeviceCode ));
  2337.     STTBX_Print(("AccessWidths      Min %d, Max %dn",
  2338.                  FLASHParams_p->InitParams.MinAccessWidth,
  2339.                  FLASHParams_p->InitParams.MaxAccessWidth ));
  2341.     STTBX_Print(("Block Start      Size     Typen"));
  2342.     for ( Block = 0; Block < FLASHParams_p->InitParams.NumberOfBlocks; Block ++)
  2343.     {
  2344.         STTBX_Print(("%5d 0x%08x %8d ",
  2345.                      Block,
  2346.                      BlockStart,
  2347.                      FLASHParams_p->InitParams.Blocks[Block].Length ));
  2348.         switch( FLASHParams_p->InitParams.Blocks[Block].Type )
  2349.         {
  2350.         case STFLASH_EMPTY_BLOCK:
  2351.             STTBX_Print(("Emptyn"));
  2352.             break;
  2354.         case STFLASH_BOOT_BLOCK:
  2355.             STTBX_Print(("Bootn"));
  2356.             break;
  2358.         case STFLASH_PARAMETER_BLOCK:
  2359.             STTBX_Print(("Parametern"));
  2360.             break;
  2362.         case STFLASH_MAIN_BLOCK:
  2363.             STTBX_Print(("Mainn"));
  2364.             break;
  2366.         default:
  2367.             STTBX_Print(("Unknownn"));
  2368.             break;
  2369.             
  2370.         }
  2371.         BlockStart += FLASHParams_p->InitParams.Blocks[Block].Length;
  2372.     }
  2374.     return ( ErrCode == ST_NO_ERROR ? FALSE : TRUE);
  2376. } /* end TTFLASH_GetParams */
  2378. /*-------------------------------------------------------------------------
  2379.  * Function : TT_SetupBlockInfo
  2380.  *            Setup FLASH Block Info
  2381.  * Input    :
  2382.  * Output   :
  2383.  * Return   : None
  2384.  * ----------------------------------------------------------------------*/
  2385. static BOOL TT_SetupBlockInfo( STTST_Parse_t *pars_p, char *Result )
  2386. {
  2387.     ST_ErrorCode_t      ErrCode;
  2388.     
  2389.     ErrCode = FLASH_SetupBlockInfo();
  2390.     
  2391.     return ( ErrCode != ST_NO_ERROR ? TRUE : FALSE );
  2392. }
  2394. /*-------------------------------------------------------------------------
  2395.  * Function : TT_FlashSetup
  2396.  *            Setup FLASH Block Info
  2397.  * Input    :
  2398.  * Output   :
  2399.  * Return   : None
  2400.  * ----------------------------------------------------------------------*/
  2401. static BOOL TT_FlashSetup( STTST_Parse_t *pars_p, char *Result )
  2402. {
  2403.     ST_ErrorCode_t      ErrCode;
  2404.     
  2405.     ErrCode = FLASH_Setup();
  2406.     
  2407.     return ( ErrCode != ST_NO_ERROR ? TRUE : FALSE );
  2408. }
  2411. /*-------------------------------------------------------------------------
  2412.  * Function : TT_ReadFile
  2413.  *            Function to Read Hex file
  2414.  * Input    :
  2415.  * Output   :
  2416.  * Return   : None
  2417.  * ----------------------------------------------------------------------*/
  2418. static BOOL TT_ReadFile( STTST_Parse_t *pars_p, char *Result )
  2419. {
  2420.     char        Filename[81];
  2422.     STTST_GetString( pars_p, "flash.hex", Filename, 80 );
  2424.     /* Read File */
  2425.     /* Convert from file format to memory format */
  2426.     
  2427.     STTBX_Print(("filename = %sn",Filename));
  2429.     if ( FlashSize == 0 )
  2430.         FlashSize = FLASH_ReadFile( Filename );
  2431.     
  2432.     return ( FlashSize == 0 ? TRUE : FALSE );
  2433. }
  2435. /*-------------------------------------------------------------------------
  2436.  * Function : TT_EraseFlash
  2437.  *            Function to erase flash for loaded data
  2438.  * Input    :
  2439.  * Output   :
  2440.  * Return   : None
  2441.  * ----------------------------------------------------------------------*/
  2442. static BOOL TT_EraseFlash( STTST_Parse_t *pars_p, char *Result )
  2443. {
  2444.     char        Text[11];
  2445.     BOOL        EraseAll;
  2447.     STTST_GetString( pars_p, "", Text, 10 );
  2448.     if ( strcmp( Text, "ALL" ) == 0 )
  2449.     {
  2450.         EraseAll = TRUE;
  2451.         STTBX_Print(("EraseAll = TRUEn"));
  2452.     }
  2453.     else
  2454.     {
  2455.         EraseAll = FALSE;
  2456.         STTBX_Print(("EraseAll = FALSEn"));
  2457.     }    
  2458.     return EraseFlash( EraseAll );
  2459. }
  2461. /*-------------------------------------------------------------------------
  2462.  * Function : TT_ProgramFlash
  2463.  *            Function to program flash with loaded data
  2464.  * Input    :
  2465.  * Output   :
  2466.  * Return   : None
  2467.  * ----------------------------------------------------------------------*/
  2468. static BOOL TT_ProgramFlash( STTST_Parse_t *pars_p, char *Result )
  2469. {
  2470.     return ProgramFlash();
  2471. }
  2473. /*-------------------------------------------------------------------------
  2474.  * Function : TT_VerifyFlash
  2475.  *            Function to verify flash with loaded data
  2476.  * Input    :
  2477.  * Output   :
  2478.  * Return   : None
  2479.  * ----------------------------------------------------------------------*/
  2480. static BOOL TT_VerifyFlash( STTST_Parse_t *pars_p, char *Result )
  2481. {
  2482.     return VerifyFlash();
  2483. }
  2485. #endif /* TESTTOOL */
  2487. /*-------------------------------------------------------------------------
  2488.  * Function : FLASH_InitCommands
  2489.  *            Definition of the macros
  2490.  *            (commands and constants to be used with Testtool)
  2491.  * Input    :
  2492.  * Output   :
  2493.  * Return   : TRUE if error, FALSE if success
  2494.  * ----------------------------------------------------------------------*/
  2495. BOOL FLASH_InitCommand( void )
  2496. {
  2497.     BOOL RetErr;
  2499.     RetErr = FALSE;
  2500.     
  2501.   #ifdef TESTTOOL  
  2502.     RetErr |= STTST_RegisterCommand("FLASH_GETPARMS", TTFLASH_GetParams, "Get FLASH Parameters");
  2503.     RetErr |= STTST_RegisterCommand("FLASH_BLOCKINFO",    TT_SetupBlockInfo, "Get Flash Block Data");
  2504.     RetErr |= STTST_RegisterCommand("FLASH_SETUP",    TT_FlashSetup, "Setup Flash Bank(Init&Open) Data");
  2505.     RetErr |= STTST_RegisterCommand("FLASH_ERASE",    TT_EraseFlash, "<ALL> Erase Flash");
  2506.     RetErr |= STTST_RegisterCommand("FLASH_PROGRAM",  TT_ProgramFlash, "Program Flash");
  2507.     RetErr |= STTST_RegisterCommand("FLASH_READ", TT_ReadFile, "<Filename> Read Flash Data");
  2508.     RetErr |= STTST_RegisterCommand("FLASH_VERIFY",   TT_VerifyFlash, "Verify Flash");
  2509.   #endif
  2510.     
  2511.     return( RetErr );
  2512. } /* end FLASH_InitCommand */
  2514. /* EOF --------------------------------------------------------------------- */