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

源码开发语言/平台
当前位置：首页 > 源码/资料 > 嵌入式/单片机编程 > Windows CE > 查看源码
2440lib.c
资源名称：src.rar　[点击查看]
上传用户：jankzhpno
上传日期：2022-08-03
资源大小：4763k
文件大小：27k
源码类别：

Windows CE

开发平台：

Visual C++

2440lib.c：源码内容
  1. //===================================================================
  2. // File Name : 2440lib.c
  3. // Function  : S3C2410 PLL,Uart, LED, Port Init
  4. // Date      : March 20, 2002
  5. // Version   : 0.0
  6. // History
  7. //   0.0 : Programming start (February 20,2002) -> SOP
  8. //===================================================================
  10. #include "def.h"
  11. #include "option.h"
  12. #include "2440addr.h"
  13. #include "2440lib.h"
  14. #include "2440slib.h" 
  16. #include <stdarg.h>
  17. #include <string.h>
  18. #include <stdlib.h>
  19. #include <stdio.h>
  20. #include <ctype.h>
  22. extern char Image$$RW$$Limit[];
  23. void *mallocPt=Image$$RW$$Limit;
  25. //***************************[ SYSTEM ]***************************************************
  26. void Delay(int time)
  27. {
  28. U32 val = (PCLK>>3)/1000-1;
  30. rTCFG0 &= ~(0xff<<8);
  31. rTCFG0 |= 3<<8; //prescaler = 3+1
  32. rTCFG1 &= ~(0xf<<12);
  33. rTCFG1 |= 0<<12; //mux = 1/2
  35. rTCNTB3 = val;
  36. rTCMPB3 = val>>1; // 50%
  37. rTCON &= ~(0xf<<16);
  38. rTCON |= 0xb<<16; //interval, inv-off, update TCNTB3&TCMPB3, start timer 3
  39. rTCON &= ~(2<<16); //clear manual update bit
  40. while(time--) {
  41. while(rTCNTO3>=val>>1);
  42. while(rTCNTO3<val>>1);
  43. };
  44. }
  46. //***************************[ PORTS ]****************************************************
  47. void Port_Init0(void)
  48. {
  49.     //CAUTION:Follow the configuration order for setting the ports. 
  50.     // 1) setting value(GPnDAT) 
  51.     // 2) setting control register  (GPnCON)
  52.     // 3) configure pull-up resistor(GPnUP)  
  54.     //32bit data bus configuration  
  55.     //*** PORT A GROUP
  56.     //Ports  : GPA22 GPA21  GPA20 GPA19 GPA18 GPA17 GPA16 GPA15 GPA14 GPA13 GPA12  
  57.     //Signal : nFCE nRSTOUT nFRE   nFWE  ALE   CLE  nGCS5 nGCS4 nGCS3 nGCS2 nGCS1 
  58.     //Binary :  1     1      1  , 1   1   1    1   ,  1     1     1     1
  59.     //Ports  : GPA11   GPA10  GPA9   GPA8   GPA7   GPA6   GPA5   GPA4   GPA3   GPA2   GPA1  GPA0
  60.     //Signal : ADDR26 ADDR25 ADDR24 ADDR23 ADDR22 ADDR21 ADDR20 ADDR19 ADDR18 ADDR17 ADDR16 ADDR0 
  61.     //Binary :  1       1      1      1   , 1       1      1      1   ,  1       1     1      1         
  62.     rGPACON = 0x7fffff; 
  64.     //**** PORT B GROUP
  65.     //Ports  : GPB10    GPB9    GPB8    GPB7    GPB6     GPB5    GPB4   GPB3   GPB2     GPB1      GPB0
  66.     //Signal : nXDREQ0 nXDACK0 nXDREQ1 nXDACK1 nSS_KBD nDIS_OFF L3CLOCK L3DATA L3MODE nIrDATXDEN Keyboard
  67.     //Setting: INPUT  OUTPUT   INPUT  OUTPUT   INPUT   OUTPUT   OUTPUT OUTPUT OUTPUT   OUTPUT    OUTPUT 
  68.     //Binary :   00  ,  01       00  ,   01      00   ,  01       01  ,   01     01   ,  01        01  
  69.     rGPBCON = 0x044555;
  70.     rGPBUP  = 0x7ff;     // The pull up function is disabled GPB[10:0]
  72.     //*** PORT C GROUP for youlong
  73.     //Ports  : GPC15 GPC14 GPC13 GPC12 GPC11 GPC10 GPC9 GPC8  GPC7   GPC6   GPC5 GPC4 GPC3  GPC2  GPC1 GPC0
  74.     //Signal : VD7   VD6   VD5   VD4   VD3   VD2   VD1  VD0 LCDVF2 LCDVF1 LCDVF0 VM VFRAME VLINE VCLK LEND  
  75.     //Binary :  10   10  , 10    10  , 10    10  , 10   10  , 10     10  ,  10   10 , 10     10 , 10   10
  76.     rGPCCON = 0xaaaaaaaa;       
  77.     rGPCUP  = 0xffff;     // The pull up function is disabled GPC[15:0] 
  78.     
  80.     //*** PORT D GROUP
  81.     //Ports  : GPD15 GPD14 GPD13 GPD12 GPD11 GPD10 GPD9 GPD8 GPD7 GPD6 GPD5 GPD4 GPD3 GPD2 GPD1 GPD0
  82.     //Signal : VD23  VD22  VD21  VD20  VD19  VD18  VD17 VD16 VD15 VD14 VD13 VD12 VD11 VD10 VD9  VD8
  83.     //Binary : 10    10  , 10    10  , 10    10  , 10   10 , 10   10 , 10   10 , 10   10 ,10   10
  84.     rGPDCON = 0xaaaaaaaa;       
  85.     rGPDUP  = 0xffff;     // The pull up function is disabled GPD[15:0]
  87.     //*** PORT E GROUP
  88.     //Ports  : GPE15  GPE14 GPE13   GPE12   GPE11   GPE10   GPE9    GPE8     GPE7  GPE6  GPE5   GPE4  
  89.     //Signal : IICSDA IICSCL SPICLK SPIMOSI SPIMISO SDDATA3 SDDATA2 SDDATA1 SDDATA0 SDCMD SDCLK IN 
  90.     //Binary :  10     10  ,  10      10  ,  10      10   ,  10      10   ,   10    10  , 10     00  ,     
  91.     //-------------------------------------------------------------------------------------------------------
  92.     //Ports  :  GPE3   GPE2  GPE1    GPE0    
  93.     //Signal :  IN     IN    IN      IN  
  94.     //Binary :  00     00  ,  00      00 
  95.     //rGPECON = 0xaaaaaaaa;       
  96.     //rGPEUP  = 0xffff;     // The pull up function is disabled GPE[15:0]
  97. rGPECON = 0xaaaaa800; // For added AC97 setting      
  98.     rGPEUP  = 0xffff;     
  100.      //*** PORT F GROUP
  101.     //Ports  : GPF7   GPF6   GPF5   GPF4      GPF3     GPF2  GPF1   GPF0
  102.     //Signal : nLED_8 nLED_4 nLED_2 nLED_1 nIRQ_PCMCIA EINT2 KBDINT EINT0
  103.     //Setting: Output Output Output Output    EINT3    EINT2 EINT1  EINT0
  104.     //Binary :  01      01 ,  01     01  ,     10       10  , 10     10
  105.     rGPFCON = 0x55aa;
  106.     rGPFUP  = 0xff;     // The pull up function is disabled GPF[7:0]
  108.     //*** PORT G GROUP
  109.     //Ports  : GPG15 GPG14 GPG13 GPG12 GPG11    GPG10    GPG9     GPG8     GPG7      GPG6    
  110.     //Signal : nYPON  YMON nXPON XMON  EINT19 DMAMODE1 DMAMODE0 DMASTART KBDSPICLK KBDSPIMOSI
  111.     //Setting: nYPON  YMON nXPON XMON  EINT19  Output   Output   Output   SPICLK1    SPIMOSI1
  112.     //Binary :   11    11 , 11    11  , 10      01    ,   01       01   ,    11         11
  113.     //-----------------------------------------------------------------------------------------
  114.     //Ports  :    GPG5       GPG4    GPG3    GPG2    GPG1    GPG0    
  115.     //Signal : KBDSPIMISO LCD_PWREN EINT11 nSS_SPI IRQ_LAN IRQ_PCMCIA
  116.     //Setting:  SPIMISO1  LCD_PWRDN EINT11   nSS0   EINT9    EINT8
  117.     //Binary :     11         11   ,  10      11  ,  10        10
  118.     rGPGCON = 0xff95ffba;
  119.     rGPGUP  = 0xffff;    // The pull up function is disabled GPG[15:0]
  121.     //*** PORT H GROUP
  122.     //Ports  :  GPH10    GPH9  GPH8 GPH7  GPH6  GPH5 GPH4 GPH3 GPH2 GPH1  GPH0 
  123.     //Signal : CLKOUT1 CLKOUT0 UCLK nCTS1 nRTS1 RXD1 TXD1 RXD0 TXD0 nRTS0 nCTS0
  124.     //Binary :   10   ,  10     10 , 11    11  , 10   10 , 10   10 , 10    10
  125.     rGPHCON = 0x2afaaa;
  126.     rGPHUP  = 0x7ff;    // The pull up function is disabled GPH[10:0]
  128. // Added for S3C2440X, DonGo
  129. //*** PORT J GROUP
  130.     //Ports  : GPJ12   GPJ11       GPJ10    GPJ9    GPJ8      GPJ7      GPJ6      GPJ5      GPJ4      GPJ3      GPJ2      GPJ1     GPJ0 
  131.     //Signal : CAMRESET CAMPCLKOUT CAMHREF CAMVSYNC CAMPCLKIN CAMDAT[7] CAMDAT[6] CAMDAT[5] CAMDAT[4] CAMDAT[3] CAMDAT[2] CAMDAT[1] CAMDAT[0] 
  132.     //Binary :   10      10       10        10       10        10        10        10       10         10        10        10      10
  133.     rGPJCON = 0x02aaaaaa;
  134.     rGPJUP  = 0x1fff;    // The pull up function is disabled GPH[10:0]
  135.     
  136.     //External interrupt will be falling edge triggered. 
  137.     rEXTINT0 = 0x22222222;    // EINT[7:0]
  138.     rEXTINT1 = 0x22222222;    // EINT[15:8]
  139.     rEXTINT2 = 0x22222222;    // EINT[23:16]
  140. }
  142. void Port_Init(void)
  143. {
  144.     //CAUTION:Follow the configuration order for setting the ports. 
  145.     // 1) setting value(GPnDAT) 
  146.     // 2) setting control register  (GPnCON)
  147.     // 3) configure pull-up resistor(GPnUP)  
  149.     //32bit data bus configuration  
  150.     //*** PORT A GROUP
  151.     //Ports  : GPA22 GPA21  GPA20 GPA19 GPA18 GPA17 GPA16 GPA15 GPA14 GPA13 GPA12  
  152.     //Signal : nFCE nRSTOUT nFRE   nFWE  ALE   CLE  nGCS5 nGCS4 nGCS3 nGCS2 nGCS1 
  153.     //Binary :  1     1      1  , 1   1   1    1   ,  1     1     1     1
  154.     //Ports  : GPA11   GPA10  GPA9   GPA8   GPA7   GPA6   GPA5   GPA4   GPA3   GPA2   GPA1  GPA0
  155.     //Signal : ADDR26 ADDR25 ADDR24 ADDR23 ADDR22 ADDR21 ADDR20 ADDR19 ADDR18 ADDR17 ADDR16 ADDR0 
  156.     //Binary :  1       1      1      1   , 1       1      1      1   ,  1       1     1      1         
  157.     rGPACON = 0x7fffff; 
  159.     //**** PORT B GROUP
  160.     //Ports  : GPB10    GPB9    GPB8    GPB7    GPB6     GPB5    GPB4   GPB3   GPB2     GPB1      GPB0
  161.     //Signal : nXDREQ0 nXDACK0 nXDREQ1 nXDACK1 nSS_KBD nDIS_OFF L3CLOCK L3DATA L3MODE nIrDATXDEN Keyboard
  162.     //Setting: INPUT  OUTPUT   INPUT  OUTPUT   INPUT   OUTPUT   OUTPUT OUTPUT OUTPUT   OUTPUT    OUTPUT 
  163.     //Binary :   00  ,  01       00  ,   01      00   ,  01       01  ,   01     01   ,  01        01  
  164.     //rGPBCON = 0x000150;(youlong)
  165.     rGPBCON = 0x015550;
  166.     rGPBUP  = 0x7ff;     // The pull up function is disabled GPB[10:0]
  168.     //*** PORT C GROUP for youlong
  169.     //Ports  : GPC15 GPC14 GPC13 GPC12 GPC11 GPC10 GPC9 GPC8  GPC7   GPC6   GPC5 GPC4 GPC3  GPC2  GPC1 GPC0
  170.     //Signal : VD7   VD6   VD5   VD4   VD3   VD2   VD1  VD0 LCDVF2 LCDVF1 LCDVF0 VM VFRAME VLINE VCLK LEND  
  171.     //Binary :  10   10  , 10    10  , 10    10  , 10   10  , 10     10  ,  10   10 , 10     10 , 10   10
  172.     //rGPCCON = 0xaaaaaaaa;       
  173.     //rGPCUP  = 0xffff;     // The pull up function is disabled GPC[15:0] 
  174.     
  175.     //*** PORT C GROUP
  176.     //Ports  : GPC15 GPC14 GPC13 GPC12 GPC11 GPC10 GPC9 GPC8  GPC7   GPC6   GPC5 GPC4 GPC3  GPC2  GPC1 GPC0
  177.     //Signal : VD7   VD6   VD5   VD4   VD3   VD2   VD1  VD0 LCDVF2 LCDVF1 LCDVF0 VM VFRAME VLINE VCLK LEND  
  178.     //Binary :  10   10  , 10    10  , 10    10  , 10   01  , 01     01  ,  01   10 , 10     10 , 10   10
  179.     rGPCCON = 0xaaa956aa;       
  180.     rGPCUP  = 0xffff;     // The pull up function is disabled GPC[15:0]     
  182.     //*** PORT D GROUP
  183.     //Ports  : GPD15 GPD14 GPD13 GPD12 GPD11 GPD10 GPD9 GPD8 GPD7 GPD6 GPD5 GPD4 GPD3 GPD2 GPD1 GPD0
  184.     //Signal : VD23  VD22  VD21  VD20  VD19  VD18  VD17 VD16 VD15 VD14 VD13 VD12 VD11 VD10 VD9  VD8
  185.     //Binary : 10    10  , 10    10  , 10    10  , 10   10 , 10   10 , 10   10 , 10   10 ,10   10
  186.     rGPDCON = 0xaaaaaaaa;       
  187.     rGPDUP  = 0xffff;     // The pull up function is disabled GPD[15:0]
  189.     //*** PORT E GROUP
  190.     //Ports  : GPE15  GPE14 GPE13   GPE12   GPE11   GPE10   GPE9    GPE8     GPE7  GPE6  GPE5   GPE4  
  191.     //Signal : IICSDA IICSCL SPICLK SPIMOSI SPIMISO SDDATA3 SDDATA2 SDDATA1 SDDATA0 SDCMD SDCLK IN 
  192.     //Binary :  10     10  ,  10      10  ,  10      10   ,  10      10   ,   10    10  , 10     00  ,     
  193.     //-------------------------------------------------------------------------------------------------------
  194.     //Ports  :  GPE3   GPE2  GPE1    GPE0    
  195.     //Signal :  IN     IN    IN      IN  
  196.     //Binary :  00     00  ,  00      00 
  197.     //rGPECON = 0xaaaaaaaa;       
  198.     //rGPEUP  = 0xffff;     // The pull up function is disabled GPE[15:0]
  199. rGPECON = 0xa02aa800; // For added AC97 setting      
  200.     rGPEUP  = 0xffff;     
  202.      //*** PORT F GROUP
  203.     //Ports  : GPF7   GPF6   GPF5   GPF4      GPF3     GPF2  GPF1   GPF0
  204.     //Signal : nLED_8 nLED_4 nLED_2 nLED_1 nIRQ_PCMCIA EINT2 KBDINT EINT0
  205.     //Setting: Output Output Output Output    EINT3    EINT2 EINT1  EINT0
  206.     //Binary :  01      01 ,  01     01  ,     10       10  , 10     10
  207.     rGPFCON = 0x55aa;
  208.     rGPFUP  = 0xff;     // The pull up function is disabled GPF[7:0]
  210.     //*** PORT G GROUP
  211.     //Ports  : GPG15 GPG14 GPG13 GPG12 GPG11    GPG10    GPG9     GPG8     GPG7      GPG6    
  212.     //Signal : nYPON  YMON nXPON XMON  EINT19 DMAMODE1 DMAMODE0 DMASTART KBDSPICLK KBDSPIMOSI
  213.     //Setting: nYPON  YMON nXPON XMON  EINT19  Output   Output   Output   SPICLK1    SPIMOSI1
  214.     //Binary :   11    11 , 11    11  , 10      01    ,   01       01   ,    11         11
  215.     //-----------------------------------------------------------------------------------------
  216.     //Ports  :    GPG5       GPG4    GPG3    GPG2    GPG1    GPG0    
  217.     //Signal : KBDSPIMISO LCD_PWREN EINT11 nSS_SPI IRQ_LAN IRQ_PCMCIA
  218.     //Setting:  SPIMISO1  LCD_PWRDN EINT11   nSS0   EINT9    EINT8
  219.     //Binary :     11         11   ,  10      11  ,  10        10
  220.     rGPGCON = 0x00a2aaaa;// GPG9 input without pull-up
  221.     rGPGUP  = 0xffff;    // The pull up function is disabled GPG[15:0]
  223.     //*** PORT H GROUP
  224.     //Ports  :  GPH10    GPH9  GPH8 GPH7  GPH6  GPH5 GPH4 GPH3 GPH2 GPH1  GPH0 
  225.     //Signal : CLKOUT1 CLKOUT0 UCLK nCTS1 nRTS1 RXD1 TXD1 RXD0 TXD0 nRTS0 nCTS0
  226.     //Binary :   10   ,  10     10 , 11    11  , 10   10 , 10   10 , 10    10
  227.     rGPHCON = 0x00faaa;
  228.     rGPHUP  = 0x7ff;    // The pull up function is disabled GPH[10:0]
  230. // Added for S3C2440X, DonGo
  231. //*** PORT J GROUP
  232.     //Ports  : GPJ12   GPJ11       GPJ10    GPJ9    GPJ8      GPJ7      GPJ6      GPJ5      GPJ4      GPJ3      GPJ2      GPJ1     GPJ0 
  233.     //Signal : CAMRESET CAMPCLKOUT CAMHREF CAMVSYNC CAMPCLKIN CAMDAT[7] CAMDAT[6] CAMDAT[5] CAMDAT[4] CAMDAT[3] CAMDAT[2] CAMDAT[1] CAMDAT[0] 
  234.     //Binary :   10      10       10        10       10        10        10        10       10         10        10        10      10
  235.     rGPJCON = 0x02aaaaaa;
  236.     rGPJUP  = 0x1fff;    // The pull up function is disabled GPH[10:0]
  237.     
  238.     //External interrupt will be falling edge triggered. 
  239.     rEXTINT0 = 0x22222222;    // EINT[7:0]
  240.     rEXTINT1 = 0x22222222;    // EINT[15:8]
  241.     rEXTINT2 = 0x22222222;    // EINT[23:16]
  242. }
  244. //***************************[ UART ]******************************
  245. static int whichUart=0;
  247. void Uart_Init(int pclk,int baud)
  248. {
  249.     int i;
  250.     if(pclk == 0)
  251.     pclk    = PCLK;
  252.     rUFCON0 = 0x0;   //UART channel 0 FIFO control register, FIFO disable
  253.     rUFCON1 = 0x0;   //UART channel 1 FIFO control register, FIFO disable
  254.     rUFCON2 = 0x0;   //UART channel 2 FIFO control register, FIFO disable
  255.     rUMCON0 = 0x0;   //UART chaneel 0 MODEM control register, AFC disable
  256.     rUMCON1 = 0x0;   //UART chaneel 1 MODEM control register, AFC disable
  257. //UART0
  258.     rULCON0 = 0x3;   //Line control register : Normal,No parity,1 stop,8 bits
  259.      //    [10]       [9]     [8]        [7]        [6]      [5]         [4]           [3:2]        [1:0]
  260.      // Clock Sel,  Tx Int,  Rx Int, Rx Time Out, Rx err, Loop-back, Send break,  Transmit Mode, Receive Mode
  261.      //     0          1       0    ,     0          1        0           0     ,       01          01
  262.      //   PCLK       Level    Pulse    Disable    Generate  Normal      Normal        Interrupt or Polling
  263.     rUCON0  = 0x245;   // Control register
  264.     rUBRDIV0=( (int)(pclk/16./baud+0.5) -1 );   //Baud rate divisior register 0
  265. //UART1
  266.     rULCON1 = 0x3;
  267.     rUCON1  = 0x245;
  268.     rUBRDIV1=( (int)(pclk/16./baud+0.5) -1 );
  269. //UART2
  270.     rULCON2 = 0x3;
  271.     rUCON2  = 0x245;
  272.     rUBRDIV2=( (int)(pclk/16./baud+0.5) -1 );    
  274.     for(i=0;i<100;i++);
  275. }
  277. //===================================================================
  278. void Uart_Select(int ch)
  279. {
  280.     whichUart = ch;
  281. }
  283. //===================================================================
  284. void Uart_TxEmpty(int ch)
  285. {
  286.     if(ch==0)
  287.         while(!(rUTRSTAT0 & 0x4)); //Wait until tx shifter is empty.
  288.           
  289.     else if(ch==1)
  290.         while(!(rUTRSTAT1 & 0x4)); //Wait until tx shifter is empty.
  291.         
  292.     else if(ch==2)
  293.         while(!(rUTRSTAT2 & 0x4)); //Wait until tx shifter is empty.
  294. }
  296. //=====================================================================
  297. char Uart_Getch(void)
  298. {
  299.     if(whichUart==0)
  300.     {       
  301.         while(!(rUTRSTAT0 & 0x1)); //Receive data ready
  302.         return RdURXH0();
  303.     }
  304.     else if(whichUart==1)
  305.     {       
  306.         while(!(rUTRSTAT1 & 0x1)); //Receive data ready
  307.         return RdURXH1();
  308.     }
  309.     else if(whichUart==2)
  310.     {
  311.         while(!(rUTRSTAT2 & 0x1)); //Receive data ready
  312.         return RdURXH2();
  313.     }
  314.     
  315.     return 0 ;
  316. }
  318. //====================================================================
  319. char Uart_GetKey(void)
  320. {
  321.     if(whichUart==0)
  322.     {       
  323.         if(rUTRSTAT0 & 0x1)    //Receive data ready
  324.             return RdURXH0();
  325.         else
  326.             return 0;
  327.     }
  328.     else if(whichUart==1)
  329.     {
  330.         if(rUTRSTAT1 & 0x1)    //Receive data ready
  331.             return RdURXH1();
  332.         else
  333.             return 0;
  334.     }
  335.     else if(whichUart==2)
  336.     {       
  337.         if(rUTRSTAT2 & 0x1)    //Receive data ready
  338.             return RdURXH2();
  339.         else
  340.             return 0;
  341.     }    
  343. return 0 ;
  344. }
  346. //====================================================================
  347. void Uart_GetString(char *string)
  348. {
  349.     char *string2 = string;
  350.     char c;
  351.     while((c = Uart_Getch())!='r')
  352.     {
  353.         if(c=='b')
  354.         {
  355.             if( (int)string2 < (int)string )
  356.             {
  357.                 Uart_Printf("b b");
  358.                 string--;
  359.             }
  360.         }
  361.         else 
  362.         {
  363.             *string++ = c;
  364.             Uart_SendByte(c);
  365.         }
  366.     }
  367.     *string='';
  368.     Uart_SendByte('n');
  369. }
  371. //=====================================================================
  372. int Uart_GetIntNum(void)
  373. {
  374.     char str[30];
  375.     char *string = str;
  376.     int base     = 10;
  377.     int minus    = 0;
  378.     int result   = 0;
  379.     int lastIndex;    
  380.     int i;
  381.     
  382.     Uart_GetString(string);
  383.     
  384.     if(string[0]=='-')
  385.     {
  386.         minus = 1;
  387.         string++;
  388.     }
  389.     
  390.     if(string[0]=='0' && (string[1]=='x' || string[1]=='X'))
  391.     {
  392.         base    = 16;
  393.         string += 2;
  394.     }
  395.     
  396.     lastIndex = strlen(string) - 1;
  397.     
  398.     if(lastIndex<0)
  399.         return -1;
  400.     
  401.     if(string[lastIndex]=='h' || string[lastIndex]=='H' )
  402.     {
  403.         base = 16;
  404.         string[lastIndex] = 0;
  405.         lastIndex--;
  406.     }
  408.     if(base==10)
  409.     {
  410.         result = atoi(string);
  411.         result = minus ? (-1*result):result;
  412.     }
  413.     else
  414.     {
  415.         for(i=0;i<=lastIndex;i++)
  416.         {
  417.             if(isalpha(string[i]))
  418.             {
  419.                 if(isupper(string[i]))
  420.                     result = (result<<4) + string[i] - 'A' + 10;
  421.                 else
  422.                     result = (result<<4) + string[i] - 'a' + 10;
  423.             }
  424.             else
  425.                 result = (result<<4) + string[i] - '0';
  426.         }
  427.         result = minus ? (-1*result):result;
  428.     }
  429.     return result;
  430. }
  432. //*****************************************************************************
  433. //get a number for the uart
  434. //*****************************************************************************
  435. int Uart_GetIntNum_GJ(void)
  436. {
  437.     char string[16] ;
  438.     char *p_string = string ;
  439.     char c;
  440.     int i = 0 ;
  441.     int data = 0 ;
  443.     while(   ( c = Uart_Getch()) != 'r'  )
  444.     {
  445. if(c=='b') p_string--;
  446. else *p_string++=c;
  448. Uart_SendByte( c ) ;
  449.     }
  451.     *p_string = '';
  453. i = 0 ;
  454. while( string[i] != '' )
  455. {
  456. data = data * 10 ;
  457. if( string[i]<'0'||string[i]>'9' )
  458. return -1 ;
  459. data = data + ( string[i]-'0' ) ;
  460. i++ ;
  461. }
  463. return data ;
  464. }
  465. //*****************************************************************************
  467. //=====================================================================
  468. void Uart_SendByte(int data)
  469. {
  470.     if(whichUart==0)
  471.     {
  472.         if(data=='n')
  473.         {
  474.             while(!(rUTRSTAT0 & 0x2));
  475.            // Delay(1);                 //because the slow response of hyper_terminal 
  476.             WrUTXH0('r');
  477.         }
  478.         while(!(rUTRSTAT0 & 0x2));   //Wait until THR is empty.
  479.       //  Delay(1);
  480.         WrUTXH0(data);
  481.     }
  482.     else if(whichUart==1)
  483.     {
  484.         if(data=='n')
  485.         {
  486.             while(!(rUTRSTAT1 & 0x2));
  487.             //Delay(1);                 //because the slow response of hyper_terminal 
  488.             rUTXH1 = 'r';
  489.         }
  490.         while(!(rUTRSTAT1 & 0x2));   //Wait until THR is empty.
  491.         //Delay(1);
  492.         rUTXH1 = data;
  493.     }   
  494.     else if(whichUart==2)
  495.     {
  496.         if(data=='n')
  497.         {
  498.             while(!(rUTRSTAT2 & 0x2));
  499.             //Delay(1);                 //because the slow response of hyper_terminal 
  500.             rUTXH2 = 'r';
  501.         }
  502.         while(!(rUTRSTAT2 & 0x2));   //Wait until THR is empty.
  503.         //Delay(1);
  504.         rUTXH2 = data;
  505.     }       
  506. }               
  508. //====================================================================
  509. void Uart_SendString(char *pt)
  510. {
  511.     while(*pt)
  512.         Uart_SendByte(*pt++);
  513. }
  515. //=====================================================================
  516. //If you don't use vsprintf(), the code size is reduced very much.
  517. void Uart_Printf(char *fmt,...)
  518. {
  519.     va_list ap;
  520.     char string[256];
  522.     va_start(ap,fmt);
  523.     vsprintf(string,fmt,ap);
  524.     Uart_SendString(string);
  525.     va_end(ap);
  526. }
  529. //**************************[ BOARD LED ]*********************************
  530. void Led_Display(int data)
  531. {
  532.           //Active is low.(LED On)
  533.           // GPF7  GPF6   GPF5   GPF4
  534.           //nLED_8 nLED4 nLED_2 nLED_1
  535. //    rGPFDAT = (rGPFDAT & 0xf) | !((data & 0xf)<<4);
  536. //    rGPFDAT = (rGPFDAT & ~(0xf<<4)) | ((~data & 0xf)<<4);    
  537.           //Active is low.(LED On)
  538.           // GPF7  GPF6   GPF5   GPF4
  539.           //nLED_8 nLED4 nLED_2 nLED_1
  540. //    rGPFDAT = (rGPFDAT & 0xf) | !((data & 0xf)<<4);
  541. rGPBDAT = (rGPBDAT & ~(0xf<<5)) | ((~data & 0xf)<<5);  
  542. //rGPCDAT = (rGPBDAT & ~(0xf<<5)) | ((~data & 0xf0)<<5);    
  543. }
  545. //***************************[ BOARD BEEP ]*******************************
  546. /*
  547. void Beep(U32 freq, U32 ms)
  548. {
  549. rGPBCON &= ~3; //set GPB0 as tout0, pwm output
  550. rGPBCON |= 2;
  552. rTCFG0 &= ~0xff;
  553. rTCFG0 |= 15; //prescaler = 15+1
  554. rTCFG1 &= ~0xf;
  555. rTCFG1 |= 2; //mux = 1/8
  556. rTCNTB0 = (PCLK>>7)/freq;
  557. rTCMPB0 = rTCNTB0>>1; // 50%
  558. rTCON &= ~0x1f;
  559. rTCON |= 0xb; //disable deadzone, auto-reload, inv-off, update TCNTB0&TCMPB0, start timer 0
  560. rTCON &= ~2; //clear manual update bit
  562. Delay(ms);
  565. rGPBCON &= ~3; //set GPB0 as output
  566. rGPBCON |= 1;
  567. rGPBDAT &= ~1;
  568. }*/
  569. void Buzzer_Freq_Set( U32 freq )
  570. {
  571. rGPBCON &= ~3; //set GPB0 as tout0, pwm output
  572. rGPBCON |= 2;
  574. rTCFG0 &= ~0xff;
  575. rTCFG0 |= 15; //prescaler = 15+1
  576. rTCFG1 &= ~0xf;
  577. rTCFG1 |= 2; //mux = 1/8
  578. rTCNTB0 = (PCLK>>7)/freq;
  579. rTCMPB0 = rTCNTB0>>1; // 50%
  580. rTCON &= ~0x1f;
  581. rTCON |= 0xb; //disable deadzone, auto-reload, inv-off, update TCNTB0&TCMPB0, start timer 0
  582. rTCON &= ~2; //clear manual update bit
  583. }
  585. void Buzzer_Stop( void )
  586. {
  587. rGPBCON &= ~3; //set GPB0 as output
  588. rGPBCON |= 1;
  589. rGPBDAT &= ~1;
  590. }
  592. //***************************[ BOARD BEEP ]*******************************
  593. void Beep(U32 freq, U32 ms)
  594. {
  595. Buzzer_Freq_Set( freq ) ;
  596. Delay( ms ) ;
  597. Buzzer_Stop() ;
  598. }
  600. /****************************************************************************
  601. 【功能说明】蜂鸣器PWM测试
  602. ****************************************************************************/
  603. void BUZZER_PWM_Test( void )
  604. {
  605. U16 freq = 1000 ;
  607. Uart_Printf( "nBUZZER TEST ( PWM Control )n" );
  608.     Uart_Printf( "Press +/- to increase/reduce the frequency of BUZZER !n" ) ;
  609. Uart_Printf( "Press 'ESC' key to Exit this program !nn" );
  611. Buzzer_Freq_Set( freq ) ;
  613.     while( 1 )
  614.     {
  615. U8 key = Uart_Getch();
  617. if( key == '+' )
  618. {
  619. if( freq < 20000 )
  620. freq += 10 ;
  622. Buzzer_Freq_Set( freq ) ;
  623. }
  625. if( key == '-' )
  626. {
  627. if( freq > 11 )
  628. freq -= 10 ;
  630. Buzzer_Freq_Set( freq ) ;
  631. }
  633. Uart_Printf( "tFreq = %dn", freq ) ;
  634. if( key == ESC_KEY )
  635. {
  636. Buzzer_Stop() ;
  637. return ;
  638. }
  640. }
  642. }
  644. //********************** BOARD LCD backlight ]****************************
  645. void LcdBkLtSet(U32 HiRatio)
  646. {
  647. #define FREQ_PWM1 1000
  649. if(!HiRatio)
  650. {
  651. rGPBCON  = rGPBCON & (~(3<<2)) | (1<<2) ; //GPB1设置为output
  652. rGPBDAT &= ~(1<<1);
  653. return;
  654. }
  655. rGPBCON = rGPBCON & (~(3<<2)) | (2<<2) ; //GPB1设置为TOUT1
  657. if( HiRatio > 100 )
  658. HiRatio = 100 ;
  660. rTCON = rTCON & (~(0xf<<8)) ; // clear manual update bit, stop Timer1
  662. rTCFG0  &= 0xffffff00; // set Timer 0&1 prescaler 0
  663. rTCFG0 |= 15; //prescaler = 15+1
  665. rTCFG1  &= 0xffffff0f; // set Timer 1 MUX 1/16
  666. rTCFG1  |= 0x00000030; // set Timer 1 MUX 1/16
  668. rTCNTB1  = ( 100000000>>8 )/FREQ_PWM1; //if set inverter off, when TCNT2<=TCMP2, TOUT is high, TCNT2>TCMP2, TOUT is low
  669. rTCMPB1  = ( rTCNTB1*(100-HiRatio))/100 ; //if set inverter on,  when TCNT2<=TCMP2, TOUT is low,  TCNT2>TCMP2, TOUT is high
  671. rTCON = rTCON & (~(0xf<<8)) | (0x0e<<8) ;
  672. //自动重装,输出取反关闭,更新TCNTBn、TCMPBn,死区控制器关闭
  673. rTCON = rTCON & (~(0xf<<8)) | (0x0d<<8) ; //开启背光控制
  674. }
  676. /****************************************************************************
  677. 【功能说明】LCD背光亮度控制，PWM控制占空比
  678. ****************************************************************************/
  679. void LCD_BackLight_Control( void )
  680. {
  681. U8 HiRatio = 50 ;
  682.     Uart_Printf( "nNOTE : ONLY SOME type LCD kit  SUPPORT backlight adjust!!!n" ) ;
  684.     Uart_Printf( "Press +/- to increase/reduce the light of LCD !n" ) ;
  685. Uart_Printf( "Press 'ESC' to Exit this test program !nn" );
  687. LcdBkLtSet( HiRatio ) ;
  689.     while( 1 )
  690.     {
  691. U8 key = Uart_Getch();
  693. if( key == '+' )
  694. {
  695. if( HiRatio < 100 )
  696. HiRatio += 1 ;
  697. }
  699. if( key == '-' )
  700. {
  701. if( HiRatio > 1 )
  702. HiRatio -= 1 ;
  703. }
  705. if( key == ESC_KEY ) break ;
  707. LcdBkLtSet( HiRatio ) ;
  708. Uart_Printf( "LCD backlight HiRatio %dn", HiRatio ) ;
  709. }
  711. }
  713. //*************************[ Timer ]********************************
  714. void Timer_Start(int divider)  //0:16us,1:32us 2:64us 3:128us
  715. {
  716.     rWTCON = ((PCLK/1000000-1)<<8)|(divider<<3);  //Watch-dog timer control register
  717.     rWTDAT = 0xffff;  //Watch-dog timer data register
  718.     rWTCNT = 0xffff;  //Watch-dog count register
  720.       // Watch-dog timer enable & interrupt  disable
  721.     rWTCON = (rWTCON & ~(1<<5) & ~(1<<2)) |(1<<5);
  722. }
  724. //=================================================================
  725. int Timer_Stop(void)
  726. {
  727.     rWTCON = ((PCLK/1000000-1)<<8);
  728.     return (0xffff - rWTCNT);
  729. }
  732. //*************************[ MPLL ]*******************************
  733. void ChangeMPllValue(int mdiv,int pdiv,int sdiv)
  734. {
  735.     rMPLLCON = (mdiv<<12) | (pdiv<<4) | sdiv;
  736. }
  739. //************************[ HCLK, PCLK ]***************************
  740. /*
  741. // for 2410.
  742. void ChangeClockDivider(int hdivn,int pdivn)
  743. {
  744.      // hdivn,pdivn FCLK:HCLK:PCLK
  745.      //     0,0         1:1:1 
  746.      //     0,1         1:1:2 
  747.      //     1,0         1:2:2
  748.      //     1,1         1:2:4
  749.     rCLKDIVN = (hdivn<<1) | pdivn;    
  751.     if(hdivn)
  752.         MMU_SetAsyncBusMode();
  753.     else 
  754.         MMU_SetFastBusMode();
  755. }
  756. */
  757. // Modified for 2440.
  758. void ChangeClockDivider(int hdivn_val,int pdivn_val)
  759. {
  760. int hdivn=2, pdivn=0;
  762.      // hdivn_val (FCLK:HCLK)ratio hdivn
  763.      // 11           1:1       (0)
  764.      // 12           1:2       (1)
  765.      // 13           1:3       (3) 
  766.      // 14           1:4       (2)
  767.      // pdivn_val (HCLK:PCLK)ratio pdivn
  768.      // 11           1:1       (0)
  769.      // 12           1:2       (1)
  770. switch(hdivn_val) {
  771. case 11: hdivn=0; break;
  772. case 12: hdivn=1; break;
  773. case 13:
  774. case 16: hdivn=3; break;
  775. case 14: 
  776. case 18: hdivn=2; break;
  777. }
  779. switch(pdivn_val) {
  780. case 11: pdivn=0; break;
  781. case 12: pdivn=1; break;
  782. }
  784. //Uart_Printf("Clock division change [hdiv:%x, pdiv:%x]n", hdivn, pdivn);
  785. rCLKDIVN = (hdivn<<1) | pdivn;
  787. switch(hdivn_val) {
  788. case 16: // when 1, HCLK=FCLK/8.
  789. rCAMDIVN = (rCAMDIVN & ~(3<<8)) | (1<<8); 
  790. break; 
  791. case 18:  // when 1, HCLK=FCLK/6.
  792. rCAMDIVN = (rCAMDIVN & ~(3<<8)) | (1<<9); 
  793. break;
  794. }
  796.     if(hdivn!=0)
  797.         MMU_SetAsyncBusMode();
  798.     else 
  799.         MMU_SetFastBusMode();
  800. }
  804. //**************************[ UPLL ]*******************************
  805. void ChangeUPllValue(int mdiv,int pdiv,int sdiv)
  806. {
  807.     rUPLLCON = (mdiv<<12) | (pdiv<<4) | sdiv;
  808. }
  811. //*************************[ General Library ]**********************
  812. void * malloc(unsigned nbyte) 
  813. //Very simple; Use malloc() & free() like Stack
  814. //void *mallocPt=Image$$RW$$Limit;
  815. {
  816.     void *returnPt = mallocPt;
  818.     mallocPt = (int *)mallocPt+nbyte/4+((nbyte%4)>0); //To align 4byte
  820.     if( (int)mallocPt > HEAPEND )
  821.     {
  822.         mallocPt = returnPt;
  823.         return NULL;
  824.     }
  825.     return returnPt;
  826. }
  828. //-------------------------------------------------------------------
  829. void free(void *pt)
  830. {
  831.     mallocPt = pt;
  832. }