#define GLOBAL_CLK 1
#include <stdlib.h>
#include <string.h>
#include “def.h”
#include “option.h”
#include “2440addr.h”
#include “2440lib.h”
#include “2440slib.h”
#include “mmu.h”
#include “profile.h”
#include “memtest.h”
//extern置於變數或函式之前，以標示變數或函式的定義在別的檔案中
extern char Image$$RO$$Limit[];
extern char Image$$RO$$Base[];
extern char Image$$RW$$Limit[];
extern char Image$$RW$$Base[];
extern char Image$$ZI$$Limit[];
extern char Image$$ZI$$Base[];
//RO是程式中的指令和常量；RO就是readonly，
//RW是程式中的已初始化變數； RW就是read/write，
// ZI是程式中的未初始化的變數；ZI就是zero；
//|Image$$RO$$Limit|：表示RO區末地址後面的地址，即RW資料來源的起始地址
//|Image$$RW$$Base|：RW區在RAM裡的執行區起始地址，也就是編譯器選項RW_Base指定的地址
//|Image$$ZI$$Base|：ZI區在RAM裡面的起始地址
//|Image$$ZI$$Limit|：ZI區在RAM裡面的結束地址後面的一個地址
void Isr_Init(void);
void HaltUndef(void);
void HaltSwi(void);
void HaltPabort(void);
void HaltDabort(void);
void ClearMemory(void);
void Clk0_Enable(int clock_sel);
void Clk1_Enable(int clock_sel);
void Clk0_Disable(void);
void Clk1_Disable(void);
//extern置於變數或函式之前，以標示變數或函式的定義在別的檔案中
extern void Lcd_TFT_Init(void);
extern void Lcd_TFT_Test( void ) ;
extern void Test_Touchpanel(void) ;
extern void Test_Adc(void) ;
extern void KeyScan_Test(void) ;
extern void RTC_Display(void) ;
extern void Test_IrDA_Tx(void) ;
extern void PlayMusicTest(void) ;
extern void RecordTest( void ) ;
extern void Test_Iic(void) ;
extern void Test_SDI(void) ;
extern void Camera_Test( void ) ;
//volatile影響編譯器編譯的結果，指出volatile變數是隨時可能發生變化的，與volatile變數有關的運算，不要進行編譯優化。
volatile U32 downloadAddress;
//void (*restart)(void)，定義一個指標，指標名為restart，指標指向函式，函式的返回型別為void
// (void (*)(void))0×0，將0×0強制轉換，使其符合等號左邊的型別。
void (*restart)(void)=(void (*)(void))0×0;
volatile unsigned char *downPt;
volatile U32 downloadFileSize;
volatile U16 checkSum;
volatile unsigned int err=0;
volatile U32 totalDmaCount;
volatile int isUsbdSetConfiguration;
int download_run=0;
U32 tempDownloadAddress;
int menuUsed=0;
extern char Image$$RW$$Limit[];
U32 *pMagicNum=(U32 *)Image$$RW$$Limit;
int consoleNum;
在全域性變數之前，加上關鍵字static，全域性變數就被定義成為一個全域性靜態變數。
1）記憶體中的位置：靜態儲存區（靜態儲存區在整個程式執行期間都存在）
2）初始化：未經初始化的全域性靜態變數會被程式自動初始化為0
3）作用域：全域性靜態變數在宣告他的檔案之外是不可見的。準確地將從定義之處開始到檔案結尾
static U32 cpu_freq;
static U32 UPLL;
在函式的返回型別前加上關鍵字static，函式就被定義成為靜態函式。
函式的定義和宣告預設情況下是extern的，但靜態函式只是在宣告它的檔案當中可見，不能被其他檔案使用。
static void cal_cpu_bus_clk(void)
{
U32 val;
U8 m, p, s;
val = rMPLLCON;
m = (val>>12)&0xff; // m=92=MDIV
p = (val>>4)&0x3f; // p=1=PDIV
s = val&3; // s=1=SDIV
//(m+8)*FIN*2 不要超出32位數!
按照手冊上面的計算，Fout=2*m*Fin/(p*2s),其中Fin=12MHz。但m、p、s與上面的不一樣。公式中m=MDIV+8，p=PDIV+2,s=SDIV
(1<<s),將1左移S位。邏輯左移相當於乘以2的N次方。而邏輯右移，相當於除以2的N次方
FIN、FCLK在option.h中定義，FIN=12000000，經計算FCLK=400MHz
FCLK = ((m+8)*(FIN/100)*2)/((p+2)*(1<<s))*100;
val = rCLKDIVN;
m = (val>>1)&3;//m=2=HDIVN
p = val&1; // P=1=PDIVN
val = rCAMDIVN;
由於之前沒有設定過CAMDIVN暫存器，所以是預設值
s=0x0000_0000,其最後兩位00，代表沒移位之前的CAMDIVN[9][8]
s = val>>8;
switch (m) {
case 0:
HCLK = FCLK;
break;
case 1:
HCLK = FCLK>>1;
break;
case 2:
if(s&2)
m=2,CAMDIVN[9]=0,表示FCLK:HCK=1:4
HCLK = FCLK>>3;
else
HCLK = FCLK>>2;
break;
case 3:
if(s&1)
HCLK = FCLK/6;
else
HCLK = FCLK/3;
break;
}
if(p)
//p=1，表示HCLK:PCLK=1:2
PCLK = HCLK>>1;
else
PCLK = HCLK;
if(s&0×10)
cpu_freq = HCLK;
else
s=0，表示CPU頻率等於FCLK頻率
cpu_freq = FCLK;
UPLLCON在Main函式裡沒有設定，但在2440init裡有設定
val = rUPLLCON;
m=56=MDIV
m = (val>>12)&0xff;
p=2=PDIV
p = (val>>4)&0x3f;
s=2=SDIV
s = val&3;
UPLL的計算方法，同MPLL一樣，經計算知，UPLL=48MHz
UPLL = ((m+8)*FIN)/((p+2)*(1<<s));
根據2440init裡CLKVAL的值，CLKDIVN[3]=DIVN_UPLL=0
rCLKDIVN&8=0，所以UCLK=UPLL=48MHz
UCLK = (rCLKDIVN&8)?(UPLL>>1):UPLL;
}
void Temp_function() { Uart_Printf(“\nPlease input 1-11 to select test!!!\n”); }
定義一個結構體，沒有結構體型別名稱，但其結構體變數為CmdTip[]，為一個陣列。
結構體成員：
有一個指標，名為fun。其指向一個函式，函式的返回型別為void。
有一個指標，名為tip，其指向字元型。
函式的函式名就像陣列名一樣，其本身就是指標，代表函式的入口地址
struct {
void (*fun)(void);
char *tip;
}CmdTip[] = {
{ Temp_function, “Please input 1-11 to select test” } ,
{ BUZZER_PWM_Test, “Test PWM” } ,
{ RTC_Display, “RTC time display” } ,
{ Test_Adc, “Test ADC” } ,
{ KeyScan_Test, “Test interrupt and key scan” } ,
{ Test_Touchpanel, “Test Touchpanel” } ,
{ Lcd_TFT_Test, “Test TFT LCD” } ,
{ Test_Iic, “Test IIC EEPROM” } ,
{ PlayMusicTest, “UDA1341 play music” } ,
{ RecordTest, “UDA1341 record voice” } ,
{ Test_SDI, “Test SD Card” } ,
{ Camera_Test, “Test CMOS Camera”},
{ 0, 0}
};
View Code
1 #define GLOBAL_CLK 1
2
3 #include <stdlib.h>
4 #include <string.h>
5 #include “def.h”
6 #include “option.h”
7 #include “2440addr.h”
8 #include “2440lib.h”
9 #include “2440slib.h”
10 #include “mmu.h”
11 #include “profile.h”
12 #include “memtest.h”
13
14 //extern置於變數或函式之前，以標示變數或函式的定義在別的檔案中
15 extern char Image$$RO$$Limit[];
16 extern char Image$$RO$$Base[];
17 extern char Image$$RW$$Limit[];
18 extern char Image$$RW$$Base[];
19 extern char Image$$ZI$$Limit[];
20 extern char Image$$ZI$$Base[];
21 //RO是程式中的指令和常量；RO就是readonly，
22 //RW是程式中的已初始化變數； RW就是read/write，
23 // ZI是程式中的未初始化的變數；ZI就是zero；
24 //|Image$$RO$$Limit|：表示RO區末地址後面的地址，即RW資料來源的起始地址
25 //|Image$$RW$$Base|：RW區在RAM裡的執行區起始地址，也就是編譯器選項RW_Base指定的地址
26 //|Image$$ZI$$Base|：ZI區在RAM裡面的起始地址
27 //|Image$$ZI$$Limit|：ZI區在RAM裡面的結束地址後面的一個地址
28
29 void Isr_Init(void);
30 void HaltUndef(void);
31 void HaltSwi(void);
32 void HaltPabort(void);
33 void HaltDabort(void);
34 void ClearMemory(void);
35
36 void Clk0_Enable(int clock_sel);
37 void Clk1_Enable(int clock_sel);
38 void Clk0_Disable(void);
39 void Clk1_Disable(void);
40
41 //extern置於變數或函式之前，以標示變數或函式的定義在別的檔案中
42 extern void Lcd_TFT_Init(void);
43 extern void Lcd_TFT_Test( void ) ;
44 extern void Test_Touchpanel(void) ;
45 extern void Test_Adc(void) ;
46 extern void KeyScan_Test(void) ;
47 extern void RTC_Display(void) ;
48 extern void Test_IrDA_Tx(void) ;
49 extern void PlayMusicTest(void) ;
50 extern void RecordTest( void ) ;
51 extern void Test_Iic(void) ;
52 extern void Test_SDI(void) ;
53 extern void Camera_Test( void ) ;
54
55 //volatile影響編譯器編譯的結果，指出volatile變數是隨時可能發生變化的，與volatile變數有關的運算，不要進行編譯優化。
56 volatile U32 downloadAddress;
57
58 //void (*restart)(void)，定義一個指標，指標名為restart，指標指向函式，函式的返回型別為void
59 // (void (*)(void))0×0，將0×0強制轉換，使其符合等號左邊的型別。
60 void (*restart)(void)=(void (*)(void))0×0;
61
62 volatile unsigned char *downPt;
63 volatile U32 downloadFileSize;
64 volatile U16 checkSum;
65 volatile unsigned int err=0;
66 volatile U32 totalDmaCount;
67
68 volatile int isUsbdSetConfiguration;
69
70 int download_run=0;
71 U32 tempDownloadAddress;
72 int menuUsed=0;
73
74 extern char Image$$RW$$Limit[];
75 U32 *pMagicNum=(U32 *)Image$$RW$$Limit;
76 int consoleNum;
77
78 /*在全域性變數之前，加上關鍵字static，全域性變數就被定義成為一個全域性靜態變數。
79 1）記憶體中的位置：靜態儲存區（靜態儲存區在整個程式執行期間都存在）
80 2）初始化：未經初始化的全域性靜態變數會被程式自動初始化為0
81 3）作用域：全域性靜態變數在宣告他的檔案之外是不可見的。準確地將從定義之處開始到檔案結尾*/
82 static U32 cpu_freq;
83 static U32 UPLL;
84
85 /*在函式的返回型別前加上關鍵字static，函式就被定義成為靜態函式。
86 函式的定義和宣告預設情況下是extern的，但靜態函式只是在宣告它的檔案當中可見，不能被其他檔案使用。*/
87 static void cal_cpu_bus_clk(void)
88 {
89 U32 val;
90 U8 m, p, s;
91 val = rMPLLCON;
92 m = (val>>12)&0xff; // m=92=MDIV
93 p = (val>>4)&0x3f; // p=1=PDIV
94 s = val&3; // s=1=SDIV
95
96 //(m+8)*FIN*2 不要超出32位數!
97 /* 按照手冊上面的計算，Fout=2*m*Fin/(p*2s),其中Fin=12MHz。但m、p、s與上面的不一樣。公式中m=MDIV+8，p=PDIV+2,s=SDIV
98 (1<<s),將1左移S位。邏輯左移相當於乘以2的N次方。而邏輯右移，相當於除以2的N次方
99 FIN、FCLK在option.h中定義，FIN=12000000，經計算FCLK=400MHz*/
100 FCLK = ((m+8)*(FIN/100)*2)/((p+2)*(1<<s))*100;
101 val = rCLKDIVN;
102 m = (val>>1)&3;//m=2=HDIVN
103 p = val&1; // P=1=PDIVN
104 val = rCAMDIVN;
105 // 由於之前沒有設定過CAMDIVN暫存器，所以是預設值
106 s=0x0000_0000,其最後兩位00，代表沒移位之前的CAMDIVN[9][8]
107 s = val>>8;
108 switch (m) {
109 case 0:
110 HCLK = FCLK;
111 break;
112 case 1:
113 HCLK = FCLK>>1;
114 break;
115 case 2:
116 if(s&2)
117 m=2,CAMDIVN[9]=0,表示FCLK:HCK=1:4
118 HCLK = FCLK>>3;
119 else
120 HCLK = FCLK>>2;
121 break;
122 case 3:
123 if(s&1)
124 HCLK = FCLK/6;
125 else
126 HCLK = FCLK/3;
127 break;
128 }
129 if(p)
130 //p=1，表示HCLK:PCLK=1:2
131 PCLK = HCLK>>1;
132 else
133 PCLK = HCLK;
134 if(s&0×10)
135 cpu_freq = HCLK;
136 else
137 // s=0，表示CPU頻率等於FCLK頻率
138 cpu_freq = FCLK;
139 // UPLLCON在Main函式裡沒有設定，但在2440init裡有設定
140 val = rUPLLCON;
141 m=56=MDIV
142 m = (val>>12)&0xff;
143 p=2=PDIV
144 p = (val>>4)&0x3f;
145 s=2=SDIV
146 s = val&3;
147 //UPLL的計算方法，同MPLL一樣，經計算知，UPLL=48MHz
148 UPLL = ((m+8)*FIN)/((p+2)*(1<<s));
149 /*根據2440init裡CLKVAL的值，CLKDIVN[3]=DIVN_UPLL=0
150 rCLKDIVN&8=0，所以UCLK=UPLL=48MHz*/
151 UCLK = (rCLKDIVN&8)?(UPLL>>1):UPLL;
152 }
153
154 void Temp_function() { Uart_Printf(“\nPlease input 1-11 to select test!!!\n”); }
155
156 /* 定義一個結構體，沒有結構體型別名稱，但其結構體變數為CmdTip[]，為一個陣列。
157 結構體成員：
158 有一個指標，名為fun。其指向一個函式，函式的返回型別為void。
159 有一個指標，名為tip，其指向字元型。
160 函式的函式名就像陣列名一樣，其本身就是指標，代表函式的入口地址*/
161 struct {
162 void (*fun)(void);
163 char *tip;
164 }CmdTip[] = {
165 { Temp_function, “Please input 1-11 to select test” } ,
166 { BUZZER_PWM_Test, “Test PWM” } ,
167 { RTC_Display, “RTC time display” } ,
168 { Test_Adc, “Test ADC” } ,
169 { KeyScan_Test, “Test interrupt and key scan” } ,
170 { Test_Touchpanel, “Test Touchpanel” } ,
171 { Lcd_TFT_Test, “Test TFT LCD” } ,
172 { Test_Iic, “Test IIC EEPROM” } ,
173 { PlayMusicTest, “UDA1341 play music” } ,
174 { RecordTest, “UDA1341 record voice” } ,
175 { Test_SDI, “Test SD Card” } ,
176 { Camera_Test, “Test CMOS Camera”},
177 { 0, 0}
178 };
1 void Main(void)
2 {
3 char *mode;
4 int i;
5 U8 key;
6 U32 mpll_val = 0 ;
7 //U32 divn_upll = 0 ;
8 /*#if如果給定條件為真，則編譯下面程式碼，直到出現#else、#elif或#endif為止；否則就不編譯。
9 ADS10在option.h定義，ADS10=1，這段沒有任何作用*/
10 #if ADS10
11 // __rt_lib_init(); //for ADS 1.0
12 #endif
13 /*S3C2440有130個管腳。可以通過軟體配置每個管腳的功能來滿足系統及外設的要求。所以在程式開始之前，你必須定義每個管腳的配置。
14 埠初始化，設定GPA/B/C/D/E/F/G/H/J相應的管腳，EXTINT0/1/2/3*/
15 Port_Init();
16 /*設定中斷服務程式，初始化。
17 把所有中斷設定為IRQ模式，遮蔽所有中斷請求*/
18 Isr_Init();
19 i = 2 ; //don’t use 100M!
20 switch ( i ) {
21 case 0: //200
22 key = 12;
23 mpll_val = (92<<12)|(4<<4)|(1);
24 break;
25 case 1: //300
26 key = 13;
27 mpll_val = (67<<12)|(1<<4)|(1);
28 break;
29 case 2: //400
30 // 設定時鐘分頻比的值，FCLK:HCLK:PCLK
31 key = 14;
32 // 設定FCLK的值，MDIV=92,PDIV=1,SDIV=1
33 mpll_val = (92<<12)|(1<<4)|(1);
34 break;
35 case 3: //440!!!
36 key = 14;
37 mpll_val = (102<<12)|(1<<4)|(1);
38 break;
39 default:
40 key = 14;
41 mpll_val = (92<<12)|(1<<4)|(1);
42 break;
43 }
44 //init FCLK=400M, so change MPLL first
45 /*此函式在2440lib.c中定義。改變MPLLCON的值，MPLL的值影響FCLK。
46 但是設定MPLL，在2440init.s已經完成了，也是FCLK=400Mhz*/
47 ChangeMPllValue((mpll_val>>12)&0xff, (mpll_val>>4)&0x3f, mpll_val&3);
48 /*設定MPLLCON後，得到FCLK的值。再設定CLKDIVN，得到HCLK、PCLK的值此函式在2440lib.c中定義。使得FCLK:HCLK:PCLK=1:4:8。如果FCLK:HCLK!=1:1，還要執行，
MMU_SetAsyncBusMode()。同2440init.s一樣*/
49 ChangeClockDivider(key, 12);
50 //計算FCLK、HCLK、PCLK、UCLK、cpu_freq
51 cal_cpu_bus_clk();
52 consoleNum = 0; // Uart 1 select for debug.
53 //UART初始化。此函式定義在2440lib.c
54 Uart_Init( 0,115200 );
55 /*S3C2440共有三個UART。在2440lib.c的靜態變數whichUart=consoleNum。在此選擇UART0*/
56 Uart_Select( consoleNum );
57 //蜂鳴聲
58 Beep(2000, 100);
59 // 傳送位元組的函式
60 Uart_SendByte(‘\n’);
61 // 顯示字串的函式
62 Uart_Printf(“<***************************************>\n”);
63 Uart_Printf(“ TQ2440 Test Program\n”);
64 Uart_Printf(“ www.embedsky.net\n”);
65 // Uart_Printf(“ Build time is: %s %s\n”, __DATE__ , __TIME__ );
66 Uart_Printf(“<***************************************>\n”);
67
68 /*指標變數，本質上是一個變數，只是它是存放地址的變數，指標的型別代表的是它所指向的變數的型別。因此就有了指向整型、字元型、浮點型等其他型別的指標，但實際上所有型別的
69 指標變數存放的都是int型的地址。因此從本質上不同型別的指標變數並沒有區別。到底宣告不同型別的指標變數的背後是什麼？其實宣告不同型別的指標變數即是規定了該變數結合指標
70 運算子時讀取記憶體中的位元組數，同樣在指標移動和指標的運算（加、減），在記憶體中移動的最小位元組數。rMISCCR在2440addr中定義。
72 其原型為 #define rMISCCR (*(volatile unsigned *)0×56000080)。0×56000080為暫存器MISCCR的地址值。
73 *(volatile unsigned *)0×56000080 含義：因為()優先順序高於*，所以先執行(volatile unsigned *)0×56000080 這個表示將0×56000080強制轉化為指標型別，指標指向的
74 型別是unsigned，指標存放的地址為0×56000080。也就是說指標指向暫存器MISCCR。然後在執行()外面的*，表示取出指標所指向的值。整個表示式，就是取出暫存器MISCCR中存放
75 的值。但rMISCCR的值改變，暫存器MISCCR中的值也隨著改變。清零MISCCR[3]，即use USB1 as device*/
76 rMISCCR=rMISCCR&~(1<<3); // USBD is selected instead of USBH1
77 //清零MISCCR[13],即USB port1 suspend mode=normal mode
78 rMISCCR=rMISCCR&~(1<<13); // USB port 1 is enabled.
79
80 rDSC0 = 0x2aa;
81 rDSC1 = 0x2aaaaaaa;
82 //Enable NAND, USBD, PWM TImer, UART0,1 and GPIO clock,
83 //the others must be enabled in OS!!!
84 rCLKCON = 0xfffff0;
85
86 //記憶體儲存管理。裸奔暫時用不上
87 MMU_Init(); //
88
89 ISR_STARTADDRESS=0x33ff_ff00
90 // 將值（0x33ff_ff00+0xf0）的值，載入到pISR_SWI的地址中（0x33ff_ff00+0×8）
91 pISR_SWI=(_ISR_STARTADDRESS+0xf0); //for pSOS
92
93 GPB5=nLED1，GPB6=nLED2，GPB7=nLED3，GPB8=nLED4
94 // LED2、3亮
95 Led_Display(0×66);
96
97 mode=”DMA”;
98
99 //將GPH9設定為input，其值為10時，管腳功能是CLKOUT0
100 Clk0_Disable();
101 // 將GPH10設定為input，其值為10時，管腳功能是CLKOUT1
102 Clk1_Disable();
103 mpll_val = rMPLLCON;
104
105 Lcd_TFT_Init() ; // LCD initial
106 download_run=1; //The default menu is the Download & Run mode.
107
108 while(1)
109 {
110 U8 idx;
111 Uart_Printf(“\nPlease select function : \n”);
112 for(i=0; CmdTip[i].fun!=0; i++)
113 Uart_Printf(“%d : %s\n”, i, CmdTip[i].tip);
114 idx = Uart_GetIntNum_GJ() ;
115 if(idx<i)
116 {
117 (*CmdTip[idx].fun)();
118 Delay(20);
119 Uart_Init( 0,115200 );
120 }
121 }
122
123 }
1 void Isr_Init(void)
2 {
3 /*pISR_UNDEF在2440addr.h中定義。
4 _ISR_STARTADDRESS在option.h中定義。_ISR_STARTADDRESS=0x33ff_ff00*/
5 #define pISR_UNDEF (*(unsigned *)(_ISR_STARTADDRESS+0×4))//取出UNDEF中斷服務程式地址中的內容
6 //(unsigned)HaltUndef中HaltUndef為函式名，其代表函式的入口地址。
7 //這條語句的意思就是將HaltUndef函式的入口地址放到UNDEF中斷程式服務地址中。
8 pISR_UNDEF=(unsigned)HaltUndef;
9 pISR_SWI =(unsigned)HaltSwi;
10 pISR_PABORT=(unsigned)HaltPabort;
11 pISR_DABORT=(unsigned)HaltDabort;
12 //所有的中斷都設定為IRQ模式
13 rINTMOD=0×0; // All=IRQ mode
14 BIT_ALLMSK=0xffff_ffff//在2440addr.h中定義
15 //遮蔽所有的中斷的請求，這些中斷就是INTMOD中的那些中斷
16 rINTMSK=BIT_ALLMSK; // All interrupt is masked.
17 }
18
19 void HaltUndef(void)
20 {
21 Uart_Printf(“Undefined instruction exception!!!\n”);
22 while(1);
23 }
24
25 void HaltSwi(void)
26 {
27 Uart_Printf(“SWI exception!!!\n”);
28 while(1);
29 }
30
31 void HaltPabort(void)
32 {
33 Uart_Printf(“Pabort exception!!!\n”);
34 while(1);
35 }
36
37 void HaltDabort(void)
38 {
39 Uart_Printf(“Dabort exception!!!\n”);
40 while(1);
41 }
42
43 void ClearMemory(void)
44 {
45 int memError=0;
46 U32 *pt;
47 Uart_Printf(“Clear Memory (%xh-%xh):WR”,_RAM_STARTADDRESS,HEAPEND);
48
49 pt=(U32 *)_RAM_STARTADDRESS;
50 while((U32)pt < HEAPEND)
51 {
52 *pt=(U32)0×0;
53 pt++;
54 }
55 if(memError==0)Uart_Printf(“\b\bO.K.\n”);
56 }
57
58 void Clk0_Enable(int clock_sel)
59 { // 0:MPLLin, 1:UPLL, 2:FCLK, 3:HCLK, 4:PCLK, 5:DCLK0
60 rMISCCR = rMISCCR&~(7<<4) | (clock_sel<<4);
61 rGPHCON = rGPHCON&~(3<<18) | (2<<18);
62 }
63 void Clk1_Enable(int clock_sel)
64 { // 0:MPLLout, 1:UPLL, 2:RTC, 3:HCLK, 4:PCLK, 5:DCLK1
65 rMISCCR = rMISCCR&~(7<<8) | (clock_sel<<8);
66 rGPHCON = rGPHCON&~(3<<20) | (2<<20);
67 }
68 void Clk0_Disable(void)
69 {
70 rGPHCON = rGPHCON&~(3<<18); // GPH9 Input
71 }
72 void Clk1_Disable(void)
73 {
74 rGPHCON = rGPHCON&~(3<<20); // GPH10 Input
75 }