ARM 2440裸奔实现电子时钟

2440 ARM裸奔实现电子时钟，对我们学习ARM体系很有帮助，原创全部源码下载： LCD--ZHIKU.rar (1 MB, 下载次数: 15)

2016-4-7 01:20 上传

点击文件名下载附件
下载积分: 黑币 -5

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. //===================================================================
   
9. 
   
10. #include "def.h"
    
11. #include "option.h"
    
12. #include "2440addr.h"
    
13. #include "2440lib.h"
    
14. #include "2440slib.h"
    
15. 
    
16. #include <stdarg.h>
    
17. #include <string.h>
    
18. #include <stdlib.h>
    
19. #include <stdio.h>
    
20. #include <ctype.h>
    
21. 
    
22. extern char Image$RW$Limit[];
    
23. void *mallocPt=Image$RW$Limit;
    
24. 
    
25. //***************************[ SYSTEM ]***************************************************
    
26. void Delay(int time)
    
27. {
    
28.         U32 val = (PCLK>>3)/1000-1;
    
29.        
    
30.         rTCFG0 &= ~(0xff<<8);
    
31.         rTCFG0 |= 3<<8;                        //prescaler = 3+1
    
32.         rTCFG1 &= ~(0xf<<12);
    
33.         rTCFG1 |= 0<<12;                //mux = 1/2
    
34. 
    
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. }
    
45. 
    
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)  
    
53. 
    
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;
    
63. 
    
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]
    
71. 
    
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.    
    
79. 
    
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]
    
86. 
    
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;     
    
99. 
    
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]
     
107. 
     
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]
     
120. 
     
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]
     
127. 
     
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. }
     
141. 
     
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)  
     
148. 
     
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;
     
158. 
     
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]
     
167. 
     
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]     
     
181. 
     
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]
     
188. 
     
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;     
     
201. 
     
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]
     
209. 
     
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]
     
222. 
     
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]
     
229. 
     
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. }
     
243. 
     
244. //***************************[ UART ]******************************
     
245. static int whichUart=0;
     
246. 
     
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 );   
     
273. 
     
274.     for(i=0;i<100;i++);
     
275. }
     
276. 
     
277. //===================================================================
     
278. void Uart_Select(int ch)
     
279. {
     
280.     whichUart = ch;
     
281. }
     
282. 
     
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. }
     
295. 
     
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. }
     
317. 
     
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.     }   
     
342. 
     
343.         return 0 ;
     
344. }
     
345. 
     
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='\0';
     
368.     Uart_SendByte('\n');
     
369. }
     
370. 
     
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.     }
     
407. 
     
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. }
     
431. 
     
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 ;
     
442. 
     
443.     while(   ( c = Uart_Getch()) != '\r'  )
     
444.     {
     
445.                 if(c=='\b')                p_string--;
     
446.                 else                *p_string++=c;
     
447.                
     
448.                 Uart_SendByte( c ) ;
     
449.     }
     
450. 
     
451.     *p_string = '\0';
     
452. 
     
453.         i = 0 ;
     
454.         while( string[i] != '\0' )
     
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.         }       
     
462.        
     
463.         return data ;
     
464. }
     
465. //*****************************************************************************
     
466. 
     
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. }               
     
507. 
     
508. //====================================================================
     
509. void Uart_SendString(char *pt)
     
510. {
     
511.     while(*pt)
     
512.         Uart_SendByte(*pt++);
     
513. }
     
514. 
     
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];
     
521. 
     
522.     va_start(ap,fmt);
     
523.     vsprintf(string,fmt,ap);
     
524.     Uart_SendString(string);
     
525.     va_end(ap);
     
526. }
     
527. 
     
528. 
     
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. }
     
544. 
     
545. //***************************[ BOARD BEEP ]*******************************
     
546. /*
     
547. void Beep(U32 freq, U32 ms)
     
548. {
     
549.         rGPBCON &= ~3;                        //set GPB0 as tout0, pwm output
     
550.         rGPBCON |= 2;
     
551.                
     
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
     
561.        
     
562.         Delay(ms);
     
563.        
     
564.        
     
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;
     
573.                
     
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. }
     
584. 
     
585. void Buzzer_Stop( void )
     
586. {
     
587.         rGPBCON &= ~3;                        //set GPB0 as output
     
588.         rGPBCON |= 1;
     
589.         rGPBDAT &= ~1;
     
590. }
     
591. 
     
592. //***************************[ BOARD BEEP ]*******************************
     
593. void Beep(U32 freq, U32 ms)
     
594. {
     
595.         Buzzer_Freq_Set( freq ) ;
     
596.         Delay( ms ) ;
     
597.         Buzzer_Stop() ;
     
598. }
     
599. 
     
600. /****************************************************************************
     
601. 【功能说明】蜂鸣器PWM测试
     
602. ****************************************************************************/
     
603. void BUZZER_PWM_Test( void )
     
604. {
     
605.         U16 freq = 1000 ;
     
606.        
     
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 !\n\n" );
     
610.        
     
611.         Buzzer_Freq_Set( freq ) ;
     
612. 
     
613.     while( 1 )
     
614.     {
     
615.                 U8 key = Uart_Getch();
     
616. 
     
617.                 if( key == '+' )
     
618.                 {
     
619.                         if( freq < 20000 )
     
620.                                 freq += 10 ;
     
621.                                
     
622.                         Buzzer_Freq_Set( freq ) ;
     
623.                 }
     
624. 
     
625.                 if( key == '-' )
     
626.                 {
     
627.                         if( freq > 11 )
     
628.                                 freq -= 10 ;
     
629.                                
     
630.                         Buzzer_Freq_Set( freq ) ;
     
631.                 }
     
632.                
     
633.                 Uart_Printf( "\tFreq = %d\n", freq ) ;
     
634.                 if( key == ESC_KEY )
     
635.                 {
     
636.                         Buzzer_Stop() ;
     
637.                         return ;
     
638.                 }
     
639. 
     
640.         }
     
641. 
     
642. }
     
643. 
     
644. //********************** BOARD LCD backlight ]****************************
     
645. void LcdBkLtSet(U32 HiRatio)
     
646. {
     
647. #define FREQ_PWM1                1000
     
648. 
     
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
     
656.        
     
657.         if( HiRatio > 100 )
     
658.                 HiRatio = 100 ;       
     
659.        
     
660.         rTCON = rTCON & (~(0xf<<8)) ;                        // clear manual update bit, stop Timer1
     
661. 
     
662.         rTCFG0         &= 0xffffff00;                                        // set Timer 0&1 prescaler 0
     
663.         rTCFG0 |= 15;                                                        //prescaler = 15+1
     
664. 
     
665.         rTCFG1         &= 0xffffff0f;                                        // set Timer 1 MUX 1/16
     
666.         rTCFG1  |= 0x00000030;                                        // set Timer 1 MUX 1/16
     
667. 
     
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
     
670. 
     
671.         rTCON = rTCON & (~(0xf<<8)) | (0x0e<<8) ;
     
672.         //自动重装,输出取反关闭,更新TCNTBn、TCMPBn,死区控制器关闭
     
673.         rTCON = rTCON & (~(0xf<<8)) | (0x0d<<8) ;                //开启背光控制
     
674. }
     
675. 
     
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" ) ;
     
683. 
     
684.            Uart_Printf( "Press +/- to increase/reduce the light of LCD !\n" ) ;
     
685.         Uart_Printf( "Press 'ESC' to Exit this test program !\n\n" );
     
686.        
     
687.         LcdBkLtSet( HiRatio ) ;
     
688. 
     
689.     while( 1 )
     
690.     {
     
691.                 U8 key = Uart_Getch();
     
692. 
     
693.                 if( key == '+' )
     
694.                 {
     
695.                         if( HiRatio < 100 )
     
696.                                 HiRatio += 1 ;
     
697.                 }
     
698.                
     
699.                 if( key == '-' )
     
700.                 {
     
701.                         if( HiRatio > 1 )
     
702.                                 HiRatio -= 1 ;
     
703.                 }
     
704.                
     
705.                 if( key == ESC_KEY ) break ;
     
706.                
     
707.                 LcdBkLtSet( HiRatio ) ;
     
708.                 Uart_Printf( "LCD backlight HiRatio %d\n", HiRatio ) ;
     
709.         }
     
710. 
     
711. }
     
712. 
     
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
     
719. 
     
720.       // Watch-dog timer enable & interrupt  disable
     
721.     rWTCON = (rWTCON & ~(1<<5) & ~(1<<2)) |(1<<5);
     
722. }
     
723. 
     
724. //=================================================================
     
725. int Timer_Stop(void)
     
726. {
     
727.     rWTCON = ((PCLK/1000000-1)<<8);
     
728.     return (0xffff - rWTCNT);
     
729. }
     
730. 
     
731. 
     
732. //*************************[ MPLL ]*******************************
     
733. void ChangeMPllValue(int mdiv,int pdiv,int sdiv)
     
734. {
     
735.     rMPLLCON = (mdiv<<12) | (pdiv<<4) | sdiv;
     
736. }
     
737. 
     
738. 
     
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;   
     
750. 
     
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;
     
761.        
     
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.         }
     
778.        
     
779.         switch(pdivn_val) {
     
780.                 case 11: pdivn=0; break;
     
781.                 case 12: pdivn=1; break;
     
782.         }
     
783.        
     
784.         //Uart_Printf("Clock division change [hdiv:%x, pdiv:%x]\n", hdivn, pdivn);
     
785.         rCLKDIVN = (hdivn<<1) | pdivn;
     
786. 
     
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.         }
     
795.        
     
796.     if(hdivn!=0)
     
797.         MMU_SetAsyncBusMode();
     
798.     else
     
799.         MMU_SetFastBusMode();
     
800. }
     
801. 
     
802. 
     
803. 
     
804. //**************************[ UPLL ]*******************************
     
805. void ChangeUPllValue(int mdiv,int pdiv,int sdiv)
     
806. {
     
807.     rUPLLCON = (mdiv<<12) | (pdiv<<4) | sdiv;
     
808. }
     
809. 
     
810. 
     
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;
     
817. 
     
818.     mallocPt = (int *)mallocPt+nbyte/4+((nbyte%4)>0); //To align 4byte
     
819. 
     
820.     if( (int)mallocPt > HEAPEND )
     
821.     {
     
822.         mallocPt = returnPt;
     
823.         return NULL;
     
824.     }
     
825.     return returnPt;
     
826. }
     
827. 
     
828. //-------------------------------------------------------------------
     
829. void free(void *pt)
     
830. {
     
831.     mallocPt = pt;
     
832. }
     

复制代码