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

源码开发语言/平台
当前位置：首页 > 源码/资料 > 通讯/手机编程 > 传真(Fax)编程 > 查看源码
FlashBadBlockProcess.s43
资源名称：VsonBryanFaxConexant070517.rar　[点击查看]
上传用户：xhjmsc
上传日期：2019-09-13
资源大小：389k
文件大小：26k
源码类别：

传真(Fax)编程

开发平台：

C/C++

FlashBadBlockProcess.s43：源码内容
  1.         NAME FlashBadBlockProcess
  3.         RTMODEL "__double_size", "32"
  4.         RTMODEL "__pic", "no"
  5.         RTMODEL "__reg_r4", "free"
  6.         RTMODEL "__reg_r5", "free"
  7.         RTMODEL "__rt_version", "1"
  9.         RSEG CSTACK:DATA:SORT:NOROOT(1)
  11.         EXTERN ?Epilogue8
  12.         EXTERN ZERO_ADDRESS
  13.         FUNCTION ZERO_ADDRESS,0202H
  14.         EXTERN ERASE_ONE_BLOCK
  15.         FUNCTION ERASE_ONE_BLOCK,0202H
  16.         EXTERN ?ShiftLeft16_6
  17.         EXTERN ROW_ADDRESS_LOW
  18.         EXTERN ROW_ADDRESS_HIGH
  19.         EXTERN COMMAND_VAL
  20.         EXTERN COMMAND_LATCH_INTO
  21.         FUNCTION COMMAND_LATCH_INTO,0202H
  22.         EXTERN COLUMN_ADDRESS_LOW
  23.         EXTERN ADDRESS_VALUE
  24.         EXTERN ADDRESS_LATCH_INTO
  25.         FUNCTION ADDRESS_LATCH_INTO,0202H
  26.         EXTERN COLUMN_ADDRESS_HIGH
  27.         EXTERN aucUartRxBuf
  28.         EXTERN PROGRAM_256_BYTE
  29.         FUNCTION PROGRAM_256_BYTE,0202H
  30.         EXTERN PROGRAM_ONE_PAGE
  31.         FUNCTION PROGRAM_ONE_PAGE,0202H
  32.         EXTERN ?Epilogue6
  33.         EXTERN ?ShiftRight16u_6
  34.         EXTERN ?DivMod16u
  35.         EXTERN READ_256_BYTE
  36.         FUNCTION READ_256_BYTE,0202H
  37.         EXTERN ?longjmp_r4
  38.         EXTERN ?longjmp_r5
  39.         EXTERN ?setjmp_r4
  40.         EXTERN ?setjmp_r5
  42.         PUBWEAK ?setjmp_save_r4
  43.         PUBWEAK ?setjmp_save_r5
  44.         PUBLIC CalNextPageAddress
  45.         FUNCTION CalNextPageAddress,021203H
  46.         LOCFRAME CSTACK, 14, STACK
  47.         PUBLIC CheckInvalidBlock
  48.         FUNCTION CheckInvalidBlock,021203H
  49.         LOCFRAME CSTACK, 20, STACK
  50.         PUBLIC FlashFormat
  51.         FUNCTION FlashFormat,021203H
  52.         LOCFRAME CSTACK, 6, STACK
  53.         PUBWEAK P2IN
  54.         PUBWEAK P2OUT
  55.         PUBWEAK P5DIR
  56.         PUBWEAK P5IN
  57.         
  58.         CFI Names cfiNames0
  59.         CFI StackFrame CFA SP DATA
  60.         CFI Resource PC:16, SP:16, SR:16, R4:16, R5:16, R6:16, R7:16, R8:16
  61.         CFI Resource R9:16, R10:16, R11:16, R12:16, R13:16, R14:16, R15:16
  62.         CFI EndNames cfiNames0
  63.         
  64.         CFI Common cfiCommon0 Using cfiNames0
  65.         CFI CodeAlign 2
  66.         CFI DataAlign 2
  67.         CFI ReturnAddress PC CODE
  68.         CFI CFA SP+2
  69.         CFI PC Frame(CFA, -2)
  70.         CFI SR Undefined
  71.         CFI R4 SameValue
  72.         CFI R5 SameValue
  73.         CFI R6 SameValue
  74.         CFI R7 SameValue
  75.         CFI R8 SameValue
  76.         CFI R9 SameValue
  77.         CFI R10 SameValue
  78.         CFI R11 SameValue
  79.         CFI R12 Undefined
  80.         CFI R13 Undefined
  81.         CFI R14 Undefined
  82.         CFI R15 Undefined
  83.         CFI EndCommon cfiCommon0
  84.         
  85. // E:projectFaxProgramVson_Bryan_Fax_Conexant_070423filesFlashBadBlockProcess.c
  86. //    1 /***************************************
  87. //    2 Program:     FlashBadBlockProcess
  88. //    3 Author:      Bryan Cai
  89. //    4 Date:        2006.12.02
  90. //    5 ***************************************/
  91. //    6 
  92. //    7 #include "includeH.h"
  94.         ASEGN DATA16_AN:DATA:NOROOT,028H
  95. // unsigned char const volatile __data P2IN
  96. P2IN:
  97.         DS8 1
  99.         ASEGN DATA16_AN:DATA:NOROOT,029H
  100. // unsigned char volatile __data P2OUT
  101. P2OUT:
  102.         DS8 1
  104.         ASEGN DATA16_AN:DATA:NOROOT,030H
  105. // unsigned char const volatile __data P5IN
  106. P5IN:
  107.         DS8 1
  109.         ASEGN DATA16_AN:DATA:NOROOT,032H
  110. // unsigned char volatile __data P5DIR
  111. P5DIR:
  112.         DS8 1
  113. //    8 
  115.         RSEG CODE:CODE:NOROOT(1)
  116. //    9 void CheckInvalidBlock(void)
  117. CheckInvalidBlock:
  118.         CFI Block cfiBlock0 Using cfiCommon0
  119.         CFI Function CheckInvalidBlock
  120. //   10 {
  121.         FUNCALL CheckInvalidBlock, ZERO_ADDRESS
  122.         LOCFRAME CSTACK, 20, STACK
  123.         FUNCALL CheckInvalidBlock, ERASE_ONE_BLOCK
  124.         LOCFRAME CSTACK, 20, STACK
  125.         FUNCALL CheckInvalidBlock, ERASE_ONE_BLOCK
  126.         LOCFRAME CSTACK, 20, STACK
  127.         FUNCALL CheckInvalidBlock, COMMAND_LATCH_INTO
  128.         LOCFRAME CSTACK, 20, STACK
  129.         FUNCALL CheckInvalidBlock, ADDRESS_LATCH_INTO
  130.         LOCFRAME CSTACK, 20, STACK
  131.         FUNCALL CheckInvalidBlock, ADDRESS_LATCH_INTO
  132.         LOCFRAME CSTACK, 20, STACK
  133.         FUNCALL CheckInvalidBlock, ADDRESS_LATCH_INTO
  134.         LOCFRAME CSTACK, 20, STACK
  135.         FUNCALL CheckInvalidBlock, ADDRESS_LATCH_INTO
  136.         LOCFRAME CSTACK, 20, STACK
  137.         FUNCALL CheckInvalidBlock, COMMAND_LATCH_INTO
  138.         LOCFRAME CSTACK, 20, STACK
  139.         FUNCALL CheckInvalidBlock, PROGRAM_256_BYTE
  140.         LOCFRAME CSTACK, 20, STACK
  141.         FUNCALL CheckInvalidBlock, PROGRAM_ONE_PAGE
  142.         LOCFRAME CSTACK, 20, STACK
  143.         FUNCALL CheckInvalidBlock, COMMAND_LATCH_INTO
  144.         LOCFRAME CSTACK, 20, STACK
  145.         FUNCALL CheckInvalidBlock, ADDRESS_LATCH_INTO
  146.         LOCFRAME CSTACK, 20, STACK
  147.         FUNCALL CheckInvalidBlock, ADDRESS_LATCH_INTO
  148.         LOCFRAME CSTACK, 20, STACK
  149.         FUNCALL CheckInvalidBlock, ADDRESS_LATCH_INTO
  150.         LOCFRAME CSTACK, 20, STACK
  151.         FUNCALL CheckInvalidBlock, ADDRESS_LATCH_INTO
  152.         LOCFRAME CSTACK, 20, STACK
  153.         FUNCALL CheckInvalidBlock, COMMAND_LATCH_INTO
  154.         LOCFRAME CSTACK, 20, STACK
  155.         FUNCALL CheckInvalidBlock, PROGRAM_256_BYTE
  156.         LOCFRAME CSTACK, 20, STACK
  157.         FUNCALL CheckInvalidBlock, PROGRAM_256_BYTE
  158.         LOCFRAME CSTACK, 20, STACK
  159. PUSH.W R10
  160.         CFI R10 Frame(CFA, -4)
  161.         CFI CFA SP+4
  162. PUSH.W R11
  163.         CFI R11 Frame(CFA, -6)
  164.         CFI CFA SP+6
  165. PUSH.W R8
  166.         CFI R8 Frame(CFA, -8)
  167.         CFI CFA SP+8
  168. PUSH.W R9
  169.         CFI R9 Frame(CFA, -10)
  170.         CFI CFA SP+10
  171. PUSH.W R6
  172.         CFI R6 Frame(CFA, -12)
  173.         CFI CFA SP+12
  174. PUSH.W R7
  175.         CFI R7 Frame(CFA, -14)
  176.         CFI CFA SP+14
  177. PUSH.W R4
  178.         CFI R4 Frame(CFA, -16)
  179.         CFI CFA SP+16
  180. PUSH.W R5
  181.         CFI R5 Frame(CFA, -18)
  182.         CFI CFA SP+18
  183. SUB.W #0x2, SP
  184.         CFI CFA SP+20
  185. //   11   unsigned int wPageAddress=0, wBlockAddress=1,
  186. MOV.W #0x0, R7
  187. MOV.W #0x1, R10
  188. //   12                wByteCnt=0;
  189. MOV.W #0x0, R11
  190. //   13  unsigned char ucFlashWriteData=0,ucFlashReadData=0,
  191. MOV.B #0x0, R4
  192. MOV.B #0x0, R5
  193. //   14                ucRxIndex=0,ucGeneralCnt=0,
  194. MOV.B #0x0, R8
  195. MOV.B #0x0, 0x0(SP)
  196. //   15                ucBadBlockCnt=0,ucRxBufFullCnt=0;
  197. MOV.B #0x0, R9
  198. MOV.B #0x0, R6
  199. //   16    
  200. //   17  ZERO_ADDRESS();
  201. CALL #ZERO_ADDRESS
  202. //   18  ERASE_ONE_BLOCK();   // Erase block 0
  203. CALL #ERASE_ONE_BLOCK
  204. //   19  for (wBlockAddress=1;wBlockAddress<1024;wBlockAddress++)
  205. MOV.W #0x1, R10
  206. ??CheckInvalidBlock_5:
  207. CMP.W #0x400, R10
  208. JC ??CheckInvalidBlock_6
  209. //   20  {
  210. //   21     wPageAddress=wBlockAddress<<6;
  211. MOV.W R10, R12
  212. CALL #?ShiftLeft16_6
  213. MOV.W R12, R7
  214. //   22     ROW_ADDRESS_LOW=wPageAddress & 0XFF;
  215. MOV.B R7, &ROW_ADDRESS_LOW
  216. //   23     ROW_ADDRESS_HIGH=(wPageAddress>>8) & 0XFF; 
  217. MOV.W R7, R14
  218. SWPB R14
  219. AND.W #0xff, R14
  220. MOV.B R14, &ROW_ADDRESS_HIGH
  221. //   24     ERASE_ONE_BLOCK();
  222. CALL #ERASE_ONE_BLOCK
  223. //   25    for (ucGeneralCnt=0;ucGeneralCnt<64;ucGeneralCnt++,wPageAddress++)
  224. MOV.B #0x0, 0x0(SP)
  225. ??CheckInvalidBlock_4:
  226. CMP.B #0x40, 0x0(SP)
  227. JC ??CheckInvalidBlock_7
  228. //   26    {
  229. //   27     ROW_ADDRESS_LOW=wPageAddress & 0XFF;
  230. MOV.B R7, &ROW_ADDRESS_LOW
  231. //   28     ROW_ADDRESS_HIGH=(wPageAddress>>8) & 0XFF;
  232. MOV.W R7, R14
  233. SWPB R14
  234. AND.W #0xff, R14
  235. MOV.B R14, &ROW_ADDRESS_HIGH
  236. //   29     ucFlashWriteData=0xff;
  237. MOV.B #0xff, R4
  238. //   30     //PROGRAM_ONE_PAGE(ucFlashWriteData);
  239. //   31 //COMMAND
  240. //   32  COMMAND_VAL=0x00; //#0X00
  241. MOV.B #0x0, &COMMAND_VAL
  242. //   33  COMMAND_LATCH_INTO();
  243. CALL #COMMAND_LATCH_INTO
  244. //   34 //ADDRESS
  245. //   35  ADDRESS_VALUE=COLUMN_ADDRESS_LOW; //#0X00
  246. MOV.B &COLUMN_ADDRESS_LOW, &ADDRESS_VALUE
  247. //   36  ADDRESS_LATCH_INTO();
  248. CALL #ADDRESS_LATCH_INTO
  249. //   37 
  250. //   38  ADDRESS_VALUE=COLUMN_ADDRESS_HIGH; //#0X00
  251. MOV.B &COLUMN_ADDRESS_HIGH, &ADDRESS_VALUE
  252. //   39  ADDRESS_LATCH_INTO();
  253. CALL #ADDRESS_LATCH_INTO
  254. //   40 
  255. //   41  ADDRESS_VALUE=ROW_ADDRESS_LOW; //#0X00
  256. MOV.B &ROW_ADDRESS_LOW, &ADDRESS_VALUE
  257. //   42  ADDRESS_LATCH_INTO();
  258. CALL #ADDRESS_LATCH_INTO
  259. //   43 
  260. //   44  ADDRESS_VALUE=ROW_ADDRESS_HIGH; //#0X00
  261. MOV.B &ROW_ADDRESS_HIGH, &ADDRESS_VALUE
  262. //   45  ADDRESS_LATCH_INTO();
  263. CALL #ADDRESS_LATCH_INTO
  264. //   46  FLASH_CON_PORT_OUT &= ~ALE;
  265. BIC.B #0x2, &0x29
  266. //   47 
  267. //   48  COMMAND_VAL=0X30;
  268. MOV.B #0x30, &COMMAND_VAL
  269. //   49  COMMAND_LATCH_INTO();
  270. CALL #COMMAND_LATCH_INTO
  271. //   50  //ATcmdDelay();
  272. //   51  //for(wGeneralCnt=0;wGeneralCnt<0xff;wGeneralCnt++); //delay
  273. //   52  while((FLASH_CON_PORT_IN & RB)==0);
  274. ??CheckInvalidBlock_0:
  275. BIT.B #0x20, &0x28
  276. JNC ??CheckInvalidBlock_0
  277. //   53   DATA_PORT_IN_INITIAL;
  278. MOV.B #0x0, &0x32
  279. //   54   for(wByteCnt=0;wByteCnt<2112;wByteCnt++)
  280. MOV.W #0x0, R11
  281. ??CheckInvalidBlock_1:
  282. CMP.W #0x840, R11
  283. JC ??CheckInvalidBlock_8
  284. //   55   {
  285. //   56        FLASH_CON_PORT_OUT &=~ RE; //RE IS LOW,ENABLE READ DATA
  286. BIC.B #0x10, &0x29
  287. //   57      ucFlashReadData=DATA_PORT_IN;
  288. MOV.B &0x30, R5
  289. //   58      FLASH_CON_PORT_OUT |= RE;
  290. BIS.B #0x10, &0x29
  291. //   59        if (ucFlashReadData!=ucFlashWriteData)
  292. CMP.B R4, R5
  293. JEQ ??CheckInvalidBlock_9
  294. //   60        {
  295. //   61   
  296. //   62       if (ucBadBlockCnt++<128)
  297. MOV.B R9, R14
  298. MOV.B #0x1, R9
  299. ADD.B R14, R9
  300. CMP.B #0x80, R14
  301. JC ??CheckInvalidBlock_10
  302. //   63       {
  303. //   64        aucUartRxBuf[ucRxIndex++]=wBlockAddress & 0xff;      //low 8 byte
  304. MOV.B R8, R14
  305. AND.W #0xff, R14
  306. MOV.B R10, aucUartRxBuf(R14)
  307. ADD.B #0x1, R8
  308. //   65          aucUartRxBuf[ucRxIndex++]=(wBlockAddress>>8) & 0xff; //high 8 byte
  309. MOV.B R8, R15
  310. AND.W #0xff, R15
  311. MOV.W R10, R14
  312. SWPB R14
  313. AND.W #0xff, R14
  314. MOV.B R14, aucUartRxBuf(R15)
  315. ADD.B #0x1, R8
  316. JMP ??CheckInvalidBlock_8
  317. //   66       }//if
  318. //   67       else
  319. //   68       {
  320. //   69           COLUMN_ADDRESS_LOW=0X00;
  321. ??CheckInvalidBlock_10:
  322. MOV.B #0x0, &COLUMN_ADDRESS_LOW
  323. //   70                COLUMN_ADDRESS_HIGH=0X00;
  324. MOV.B #0x0, &COLUMN_ADDRESS_HIGH
  325. //   71                ROW_ADDRESS_LOW=ucRxBufFullCnt;
  326. MOV.B R6, &ROW_ADDRESS_LOW
  327. //   72                ROW_ADDRESS_HIGH=0X00;
  328. MOV.B #0x0, &ROW_ADDRESS_HIGH
  329. //   73           PROGRAM_256_BYTE();
  330. CALL #PROGRAM_256_BYTE
  331. //   74           ucRxBufFullCnt++;
  332. ADD.B #0x1, R6
  333. JMP ??CheckInvalidBlock_8
  334. //   75       }//else
  335. //   76       break;   
  336. //   77       }//if unequal
  337. //   78 
  338. //   79    }//for next byte
  339. ??CheckInvalidBlock_9:
  340. ADD.W #0x1, R11
  341. JMP ??CheckInvalidBlock_1
  342. //   80  if (ucFlashReadData!=ucFlashWriteData){break;}//next block
  343. ??CheckInvalidBlock_8:
  344. CMP.B R4, R5
  345. JNE ??CheckInvalidBlock_7
  346. //   81    
  347. //   82     ucFlashWriteData=0x00;
  348. MOV.B #0x0, R4
  349. //   83     PROGRAM_ONE_PAGE(ucFlashWriteData);
  350. MOV.B R4, R12
  351. CALL #PROGRAM_ONE_PAGE
  352. //   84 //COMMAND
  353. //   85  COMMAND_VAL=0x00; //#0X00
  354. MOV.B #0x0, &COMMAND_VAL
  355. //   86  COMMAND_LATCH_INTO();
  356. CALL #COMMAND_LATCH_INTO
  357. //   87 //ADDRESS
  358. //   88  ADDRESS_VALUE=COLUMN_ADDRESS_LOW; //#0X00
  359. MOV.B &COLUMN_ADDRESS_LOW, &ADDRESS_VALUE
  360. //   89  ADDRESS_LATCH_INTO();
  361. CALL #ADDRESS_LATCH_INTO
  362. //   90 
  363. //   91  ADDRESS_VALUE=COLUMN_ADDRESS_HIGH; //#0X00
  364. MOV.B &COLUMN_ADDRESS_HIGH, &ADDRESS_VALUE
  365. //   92  ADDRESS_LATCH_INTO();
  366. CALL #ADDRESS_LATCH_INTO
  367. //   93 
  368. //   94  ADDRESS_VALUE=ROW_ADDRESS_LOW; //#0X00
  369. MOV.B &ROW_ADDRESS_LOW, &ADDRESS_VALUE
  370. //   95  ADDRESS_LATCH_INTO();
  371. CALL #ADDRESS_LATCH_INTO
  372. //   96 
  373. //   97  ADDRESS_VALUE=ROW_ADDRESS_HIGH; //#0X00
  374. MOV.B &ROW_ADDRESS_HIGH, &ADDRESS_VALUE
  375. //   98  ADDRESS_LATCH_INTO();
  376. CALL #ADDRESS_LATCH_INTO
  377. //   99  FLASH_CON_PORT_OUT &=~ ALE;
  378. BIC.B #0x2, &0x29
  379. //  100 
  380. //  101  COMMAND_VAL=0X30;
  381. MOV.B #0x30, &COMMAND_VAL
  382. //  102  COMMAND_LATCH_INTO();
  383. CALL #COMMAND_LATCH_INTO
  384. //  103  //ATcmdDelay();
  385. //  104  //for(wGeneralCnt=0;wGeneralCnt<0xff;wGeneralCnt++); //delay
  386. //  105  while((FLASH_CON_PORT_IN & RB)==0);
  387. ??CheckInvalidBlock_2:
  388. BIT.B #0x20, &0x28
  389. JNC ??CheckInvalidBlock_2
  390. //  106   DATA_PORT_IN_INITIAL; //MCU INPUT,MCU READ A DATA
  391. MOV.B #0x0, &0x32
  392. //  107   for(wByteCnt=0;wByteCnt<2112;wByteCnt++)
  393. MOV.W #0x0, R11
  394. ??CheckInvalidBlock_3:
  395. CMP.W #0x840, R11
  396. JC ??CheckInvalidBlock_11
  397. //  108   {
  398. //  109          FLASH_CON_PORT_OUT &=~ RE; //RE IS LOW,ENABLE READ DATA
  399. BIC.B #0x10, &0x29
  400. //  110  ucFlashReadData=DATA_PORT_IN;
  401. MOV.B &0x30, R5
  402. //  111  FLASH_CON_PORT_OUT |= RE;
  403. BIS.B #0x10, &0x29
  404. //  112      
  405. //  113        if (ucFlashReadData!=ucFlashWriteData)
  406. CMP.B R4, R5
  407. JEQ ??CheckInvalidBlock_12
  408. //  114        {
  409. //  115       if (ucBadBlockCnt++<128)
  410. MOV.B R9, R14
  411. MOV.B #0x1, R9
  412. ADD.B R14, R9
  413. CMP.B #0x80, R14
  414. JC ??CheckInvalidBlock_13
  415. //  116       {
  416. //  117        aucUartRxBuf[ucRxIndex++]=wBlockAddress & 0xff;      //low 8 byte
  417. MOV.B R8, R14
  418. AND.W #0xff, R14
  419. MOV.B R10, aucUartRxBuf(R14)
  420. ADD.B #0x1, R8
  421. //  118          aucUartRxBuf[ucRxIndex++]=(wBlockAddress>>8) & 0xff; //high 8 byte
  422. MOV.B R8, R15
  423. AND.W #0xff, R15
  424. MOV.W R10, R14
  425. SWPB R14
  426. AND.W #0xff, R14
  427. MOV.B R14, aucUartRxBuf(R15)
  428. ADD.B #0x1, R8
  429. JMP ??CheckInvalidBlock_11
  430. //  119       }//if
  431. //  120       else
  432. //  121       {
  433. //  122           COLUMN_ADDRESS_LOW=0X00;
  434. ??CheckInvalidBlock_13:
  435. MOV.B #0x0, &COLUMN_ADDRESS_LOW
  436. //  123                COLUMN_ADDRESS_HIGH=0X00;
  437. MOV.B #0x0, &COLUMN_ADDRESS_HIGH
  438. //  124                ROW_ADDRESS_LOW=ucRxBufFullCnt;
  439. MOV.B R6, &ROW_ADDRESS_LOW
  440. //  125                ROW_ADDRESS_HIGH=0X00;
  441. MOV.B #0x0, &ROW_ADDRESS_HIGH
  442. //  126           PROGRAM_256_BYTE();
  443. CALL #PROGRAM_256_BYTE
  444. //  127           ucRxBufFullCnt++;
  445. ADD.B #0x1, R6
  446. JMP ??CheckInvalidBlock_11
  447. //  128       }//else 
  448. //  129       break;  
  449. //  130       }//if unequal
  450. //  131 
  451. //  132   }//for next byte
  452. ??CheckInvalidBlock_12:
  453. ADD.W #0x1, R11
  454. JMP ??CheckInvalidBlock_3
  455. //  133   if (ucFlashReadData!=ucFlashWriteData){break;}//next block
  456. ??CheckInvalidBlock_11:
  457. CMP.B R4, R5
  458. JNE ??CheckInvalidBlock_7
  459. //  134  }//for next page 
  460. ADD.B #0x1, 0x0(SP)
  461. ADD.W #0x1, R7
  462. JMP ??CheckInvalidBlock_4
  463. //  135   _NOP();
  464. ??CheckInvalidBlock_7:
  465. NOP
  466. //  136   }//for next block
  467. ADD.W #0x1, R10
  468. JMP ??CheckInvalidBlock_5
  469. //  137  if (ucBadBlockCnt!=0)
  470. ??CheckInvalidBlock_6:
  471. CMP.B #0x0, R9
  472. JEQ ??CheckInvalidBlock_14
  473. //  138  {
  474. //  139    COLUMN_ADDRESS_LOW=0X00;
  475. MOV.B #0x0, &COLUMN_ADDRESS_LOW
  476. //  140    COLUMN_ADDRESS_HIGH=0X00;
  477. MOV.B #0x0, &COLUMN_ADDRESS_HIGH
  478. //  141    ROW_ADDRESS_LOW=ucRxBufFullCnt;//first block
  479. MOV.B R6, &ROW_ADDRESS_LOW
  480. //  142    ROW_ADDRESS_HIGH=0X00;
  481. MOV.B #0x0, &ROW_ADDRESS_HIGH
  482. //  143    PROGRAM_256_BYTE();
  483. CALL #PROGRAM_256_BYTE
  484. //  144    ucRxBufFullCnt++;
  485. ADD.B #0x1, R6
  486. //  145  }
  487. //  146 }
  488. ??CheckInvalidBlock_14:
  489. ADD.W #0x2, SP
  490.         CFI CFA SP+18
  491. BR #?Epilogue8
  492.         CFI EndBlock cfiBlock0
  493. //  147 /*
  494. //  148 void CheckInvalidBlockForNewFlash(void) //64*256Bytes=2^14 bytes
  495. //  149 {
  496. //  150  unsigned int wPageAddress=0, wBlockAddress=0;
  497. //  151  unsigned char ucBadBlockCnt=0,ucRxIndex=0,
  498. //  152                ucRxBufFullCnt=0,ucFlashReadData,
  499. //  153                ucGeneralCnt;
  500. //  154 
  501. //  155 
  502. //  156  COLUMN_ADDRESS_LOW=0X00;   //check "FF" at the column address 2048 of 
  503. //  157  COLUMN_ADDRESS_HIGH=0X08;  //the 1st and 2nd page in the block
  504. //  158  while (!(wBlockAddress++==1023))
  505. //  159  {
  506. //  160  wPageAddress=wBlockAddress<<6;
  507. //  161  ROW_ADDRESS_LOW=wPageAddress & 0XFF;
  508. //  162  ROW_ADDRESS_HIGH=(wPageAddress>>8) & 0XFF;
  509. //  163  for (ucGeneralCnt=0;ucGeneralCnt<2;ucGeneralCnt++,wPageAddress++)
  510. //  164  {
  511. //  165 //COMMAND
  512. //  166    COMMAND_VAL=0x00; //#0X00 //00H READ1 0-2111BYTE
  513. //  167    COMMAND_LATCH_INTO();
  514. //  168 //ADDRESS
  515. //  169    ADDRESS_VALUE=COLUMN_ADDRESS_LOW;
  516. //  170    ADDRESS_LATCH_INTO();
  517. //  171 
  518. //  172    ADDRESS_VALUE=COLUMN_ADDRESS_HIGH;
  519. //  173    ADDRESS_LATCH_INTO();
  520. //  174 
  521. //  175    ADDRESS_VALUE=wPageAddress & 0xff; //ROW_ADDRESS_LOW; a bug of Dec. 07,2006
  522. //  176    ADDRESS_LATCH_INTO();
  523. //  177 
  524. //  178    ADDRESS_VALUE=(wPageAddress>>8) & 0xff;
  525. //  179    ADDRESS_LATCH_INTO();
  526. //  180    FLASH_CON_PORT_OUT &=~ ALE;
  527. //  181 
  528. //  182    COMMAND_VAL=0X30;
  529. //  183    COMMAND_LATCH_INTO();
  530. //  184    //ATcmdDelay();
  531. //  185    while((FLASH_CON_PORT_IN & RB)==0);
  532. //  186    DATA_PORT_IN_INITIAL;
  533. //  187    FLASH_CON_PORT_OUT &=~ RE; //RE IS LOW,ENABLE READ DATA
  534. //  188    ucFlashReadData=DATA_PORT_IN;
  535. //  189    FLASH_CON_PORT_OUT |= RE;
  536. //  190      if (0xff != ucFlashReadData)
  537. //  191       {
  538. //  192       if (ucBadBlockCnt++<128)
  539. //  193       {
  540. //  194        aucUartRxBuf[ucRxIndex++]=wBlockAddress & 0xff;      //low 8 byte
  541. //  195          aucUartRxBuf[ucRxIndex++]=(wBlockAddress>>8) & 0xff; //high 8 byte
  542. //  196       }//if
  543. //  197       else
  544. //  198       {
  545. //  199              COLUMN_ADDRESS_LOW=0X00;
  546. //  200                COLUMN_ADDRESS_HIGH=0X00;
  547. //  201                ROW_ADDRESS_LOW=ucRxBufFullCnt;
  548. //  202                ROW_ADDRESS_HIGH=0X00;
  549. //  203           PROGRAM_256_BYTE();
  550. //  204           ucRxBufFullCnt++;
  551. //  205       }//else
  552. //  206       break;  //first page or second page   
  553. //  207       }//if
  554. //  208      //else
  555. //  209       //ROW_ADDRESS_LOW++;  //next page-->2nd page in the block //a bug of Dec. 07,2006
  556. //  210    }//for
  557. //  211  }//while
  558. //  212 
  559. //  213  if (ucBadBlockCnt!=0)
  560. //  214  {
  561. //  215    COLUMN_ADDRESS_LOW=0X00;
  562. //  216    COLUMN_ADDRESS_HIGH=0X00;
  563. //  217    ROW_ADDRESS_LOW=ucRxBufFullCnt;//first block
  564. //  218    ROW_ADDRESS_HIGH=0X00;
  565. //  219    PROGRAM_256_BYTE();
  566. //  220 
  567. //  221    ucRxBufFullCnt++;
  568. //  222  }
  569. //  223 
  570. //  224  FlashFormat();
  571. //  225 
  572. //  226 } 
  573. //  227 */
  574. //  228 
  576.         RSEG CODE:CODE:NOROOT(1)
  577. //  229 unsigned int CalNextPageAddress(unsigned int wCurrentPageAddress)
  578. CalNextPageAddress:
  579.         CFI Block cfiBlock1 Using cfiCommon0
  580.         CFI Function CalNextPageAddress
  581. //  230 {
  582.         FUNCALL CalNextPageAddress, READ_256_BYTE
  583.         LOCFRAME CSTACK, 14, STACK
  584. PUSH.W R10
  585.         CFI R10 Frame(CFA, -4)
  586.         CFI CFA SP+4
  587. PUSH.W R11
  588.         CFI R11 Frame(CFA, -6)
  589.         CFI CFA SP+6
  590. PUSH.W R8
  591.         CFI R8 Frame(CFA, -8)
  592.         CFI CFA SP+8
  593. PUSH.W R9
  594.         CFI R9 Frame(CFA, -10)
  595.         CFI CFA SP+10
  596. PUSH.W R6
  597.         CFI R6 Frame(CFA, -12)
  598.         CFI CFA SP+12
  599. PUSH.W R7
  600.         CFI R7 Frame(CFA, -14)
  601.         CFI CFA SP+14
  602. MOV.W R12, R9
  603. //  231     unsigned char ucGeneralCnt=0,ucRxIndex=0,ucBadBlockCnt=0;
  604. MOV.B #0x0, R7
  605. MOV.B #0x0, R10
  606. MOV.B #0x0, R6
  607. //  232     unsigned int  wBlockAddress=0,wNextPageAddress=0;
  608. MOV.W #0x0, R11
  609. MOV.W #0x0, R8
  610. //  233               
  611. //  234     wNextPageAddress=wCurrentPageAddress;
  612. MOV.W R9, R8
  613. //  235     wBlockAddress=wCurrentPageAddress>>6;              
  614. MOV.W R9, R12
  615. CALL #?ShiftRight16u_6
  616. MOV.W R12, R11
  617. //  236     if (wCurrentPageAddress%64==0)
  618. MOV.W R9, R12
  619. MOV.W #0x40, R14
  620. CALL #?DivMod16u
  621. CMP.W #0x0, R14
  622. JNE ??CalNextPageAddress_2
  623. //  237     {
  624. //  238        for (ucGeneralCnt=0;ucGeneralCnt<64;ucGeneralCnt++,ROW_ADDRESS_LOW++)
  625. MOV.B #0x0, R7
  626. ??CalNextPageAddress_1:
  627. CMP.B #0x40, R7
  628. JC ??CalNextPageAddress_2
  629. //  239       {
  630. //  240          READ_256_BYTE();
  631. CALL #READ_256_BYTE
  632. //  241          for (ucRxIndex=0,ucBadBlockCnt=0;ucBadBlockCnt<128;ucBadBlockCnt++)
  633. MOV.B #0x0, R10
  634. MOV.B #0x0, R6
  635. ??CalNextPageAddress_0:
  636. CMP.B #0x80, R6
  637. JC ??CalNextPageAddress_3
  638. //  242          {
  639. //  243            if (aucUartRxBuf[ucRxIndex]==(wBlockAddress & 0xff) 
  640. //  244                 && aucUartRxBuf[ucRxIndex+1]==((wBlockAddress>>8) & 0xff))
  641. MOV.B R10, R14
  642. AND.W #0xff, R14
  643. MOV.B R11, R15
  644. AND.B #0xff, R15
  645. CMP.B R15, aucUartRxBuf(R14)
  646. JNE ??CalNextPageAddress_4
  647. MOV.W #aucUartRxBuf, R15
  648. MOV.B R10, R14
  649. AND.W #0xff, R14
  650. ADD.W R14, R15
  651. MOV.W R11, R14
  652. SWPB R14
  653. AND.W #0xff, R14
  654. CMP.B R14, 0x1(R15)
  655. JNE ??CalNextPageAddress_4
  656. //  245                {wNextPageAddress=wCurrentPageAddress+64; break;}
  657. MOV.W #0x40, R14
  658. ADD.W R9, R14
  659. MOV.W R14, R8
  660. JMP ??CalNextPageAddress_3
  661. //  246            if (aucUartRxBuf[ucRxIndex]==0xFF && aucUartRxBuf[ucRxIndex+1]==0xFF && 
  662. //  247               aucUartRxBuf[ucRxIndex+2]==0xFF &&aucUartRxBuf[ucRxIndex+3]==0xFF)
  663. ??CalNextPageAddress_4:
  664. MOV.B R10, R14
  665. AND.W #0xff, R14
  666. CMP.B #0xff, aucUartRxBuf(R14)
  667. JNE ??CalNextPageAddress_5
  668. MOV.W #aucUartRxBuf, R14
  669. MOV.B R10, R15
  670. AND.W #0xff, R15
  671. ADD.W R15, R14
  672. CMP.B #0xff, 0x1(R14)
  673. JNE ??CalNextPageAddress_5
  674. MOV.W #aucUartRxBuf, R14
  675. MOV.B R10, R15
  676. AND.W #0xff, R15
  677. ADD.W R15, R14
  678. CMP.B #0xff, 0x2(R14)
  679. JNE ??CalNextPageAddress_5
  680. MOV.W #aucUartRxBuf, R14
  681. MOV.B R10, R15
  682. AND.W #0xff, R15
  683. ADD.W R15, R14
  684. CMP.B #0xff, 0x3(R14)
  685. JEQ ??CalNextPageAddress_3
  686. //  248               {break;}
  687. //  249            ucRxIndex+=2;
  688. ??CalNextPageAddress_5:
  689. ADD.B #0x2, R10
  690. //  250          }//for
  691. ADD.B #0x1, R6
  692. JMP ??CalNextPageAddress_0
  693. //  251          if (aucUartRxBuf[ucRxIndex++]==(wBlockAddress & 0xff) 
  694. //  252                 && aucUartRxBuf[ucRxIndex++]==((wBlockAddress>>8) & 0xff))
  695. ??CalNextPageAddress_3:
  696. MOV.B R10, R14
  697. MOV.B #0x1, R10
  698. ADD.B R14, R10
  699. AND.W #0xff, R14
  700. MOV.B R11, R15
  701. AND.B #0xff, R15
  702. CMP.B R15, aucUartRxBuf(R14)
  703. JNE ??CalNextPageAddress_6
  704. MOV.B R10, R15
  705. MOV.B #0x1, R10
  706. ADD.B R15, R10
  707. AND.W #0xff, R15
  708. MOV.W R11, R14
  709. SWPB R14
  710. AND.W #0xff, R14
  711. CMP.B R14, aucUartRxBuf(R15)
  712. JNE ??CalNextPageAddress_6
  713. //  253                {wNextPageAddress=wCurrentPageAddress+64; break;}
  714. MOV.W #0x40, R14
  715. ADD.W R9, R14
  716. MOV.W R14, R8
  717. JMP ??CalNextPageAddress_2
  718. //  254          if (aucUartRxBuf[ucRxIndex]==0xFF && aucUartRxBuf[ucRxIndex+1]==0xFF && 
  719. //  255               aucUartRxBuf[ucRxIndex+2]==0xFF &&aucUartRxBuf[ucRxIndex+3]==0xFF)
  720. ??CalNextPageAddress_6:
  721. MOV.B R10, R14
  722. AND.W #0xff, R14
  723. CMP.B #0xff, aucUartRxBuf(R14)
  724. JNE ??CalNextPageAddress_7
  725. MOV.W #aucUartRxBuf, R14
  726. MOV.B R10, R15
  727. AND.W #0xff, R15
  728. ADD.W R15, R14
  729. CMP.B #0xff, 0x1(R14)
  730. JNE ??CalNextPageAddress_7
  731. MOV.W #aucUartRxBuf, R14
  732. MOV.B R10, R15
  733. AND.W #0xff, R15
  734. ADD.W R15, R14
  735. CMP.B #0xff, 0x2(R14)
  736. JNE ??CalNextPageAddress_7
  737. MOV.W #aucUartRxBuf, R14
  738. AND.W #0xff, R10
  739. ADD.W R10, R14
  740. CMP.B #0xff, 0x3(R14)
  741. JEQ ??CalNextPageAddress_2
  742. //  256               {break;}
  743. //  257       }//for
  744. ??CalNextPageAddress_7:
  745. ADD.B #0x1, R7
  746. ADD.B #0x1, &ROW_ADDRESS_LOW
  747. JMP ??CalNextPageAddress_1
  748. //  258     }//if
  749. //  259     return wNextPageAddress;
  750. ??CalNextPageAddress_2:
  751. MOV.W R8, R12
  752. BR #?Epilogue6
  753.         CFI EndBlock cfiBlock1
  754. //  260 }
  755. //  261 /*******************
  756. //  262 unsigned int CalNextBlockAddress(unsigned int wCurrentBlockAddress)
  757. //  263 {
  758. //  264     unsigned char ucGeneralCnt=0,ucRxIndex=0,ucBadBlockCnt=0;
  759. //  265     unsigned int  wBlockAddress=0,wNextBlockAddress=0;
  760. //  266               
  761. //  267     wNextBlockAddress=wCurrentBlockAddress;              
  762. //  268     for (ucGeneralCnt=0;ucGeneralCnt<64;ucGeneralCnt++,ROW_ADDRESS_LOW++)
  763. //  269       {
  764. //  270          
  765. //  271          READ_256_BYTE();
  766. //  272          for (ucRxIndex=0,ucBadBlockCnt=0;ucBadBlockCnt<128;ucBadBlockCnt++)
  767. //  273          {
  768. //  274            if (aucUartRxBuf[ucRxIndex++]==(wBlockAddress & 0xff) 
  769. //  275                 && aucUartRxBuf[ucRxIndex++]==((wBlockAddress>>8) & 0xff))
  770. //  276                {wNextBlockAddress=wCurrentBlockAddress+1; break;}
  771. //  277            if (aucUartRxBuf[ucRxIndex]==0xFF && aucUartRxBuf[ucRxIndex+1]==0xFF && 
  772. //  278               aucUartRxBuf[ucRxIndex+2]==0xFF &&aucUartRxBuf[ucRxIndex+3]==0xFF)
  773. //  279               {break;}
  774. //  280          }//for
  775. //  281          if (aucUartRxBuf[ucRxIndex]==0xFF && aucUartRxBuf[ucRxIndex+1]==0xFF && 
  776. //  282               aucUartRxBuf[ucRxIndex+2]==0xFF &&aucUartRxBuf[ucRxIndex+3]==0xFF)
  777. //  283               {break;}
  778. //  284       }//for
  779. //  285      return wNextBlockAddress;
  780. //  286 } 
  781. //  287 *******************************/ 
  783.         RSEG CODE:CODE:NOROOT(1)
  784. //  288 void FlashFormat(void)
  785. FlashFormat:
  786.         CFI Block cfiBlock2 Using cfiCommon0
  787.         CFI Function FlashFormat
  788. //  289 {
  789.         FUNCALL FlashFormat, ERASE_ONE_BLOCK
  790.         LOCFRAME CSTACK, 6, STACK
  791. PUSH.W R10
  792.         CFI R10 Frame(CFA, -4)
  793.         CFI CFA SP+4
  794. PUSH.W R11
  795.         CFI R11 Frame(CFA, -6)
  796.         CFI CFA SP+6
  797. //  290           unsigned int wBlockAddress=0,wPageAddress=0;
  798. MOV.W #0x0, R10
  799. MOV.W #0x0, R11
  800. //  291           for (wBlockAddress=1;wBlockAddress<1024;wBlockAddress++)
  801. MOV.W #0x1, R10
  802. ??FlashFormat_0:
  803. CMP.W #0x400, R10
  804. JC ??FlashFormat_1
  805. //  292          {
  806. //  293                  wPageAddress=wBlockAddress<<6;
  807. MOV.W R10, R12
  808. CALL #?ShiftLeft16_6
  809. MOV.W R12, R11
  810. //  294            ROW_ADDRESS_LOW=wPageAddress & 0XFF;
  811. MOV.B R11, &ROW_ADDRESS_LOW
  812. //  295            ROW_ADDRESS_HIGH=(wPageAddress>>8) & 0XFF; 
  813. MOV.W R11, R14
  814. SWPB R14
  815. AND.W #0xff, R14
  816. MOV.B R14, &ROW_ADDRESS_HIGH
  817. //  296            ERASE_ONE_BLOCK();
  818. CALL #ERASE_ONE_BLOCK
  819. //  297          }
  820. ADD.W #0x1, R10
  821. JMP ??FlashFormat_0
  822. //  298 } 
  823. ??FlashFormat_1:
  824. POP.W R11
  825.         CFI R11 SameValue
  826.         CFI CFA SP+4
  827. POP.W R10
  828.         CFI R10 SameValue
  829.         CFI CFA SP+2
  830. RET
  831.         CFI EndBlock cfiBlock2
  833.         RSEG CODE:CODE:NOROOT(1)
  834. ?setjmp_save_r4:
  835. REQUIRE ?setjmp_r4
  836. REQUIRE ?longjmp_r4
  838.         RSEG CODE:CODE:NOROOT(1)
  839. ?setjmp_save_r5:
  840. REQUIRE ?setjmp_r5
  841. REQUIRE ?longjmp_r5
  843.         END
  844. // 
  845. // 906 bytes in segment CODE
  846. //   4 bytes in segment DATA16_AN
  847. // 
  848. // 906 bytes of CODE memory
  849. //   0 bytes of DATA memory (+ 4 bytes shared)
  850. //
  851. //Errors: none
  852. //Warnings: none