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

源码开发语言/平台
当前位置：首页 > 源码/资料 > 嵌入式/单片机编程 > uCOS > 查看源码
2440lib.c
资源名称：mini2440_uCos2_ucgui.rar　[点击查看]
上传用户：zbk8730
上传日期：2017-08-10
资源大小：12168k
文件大小：24k
源码类别：

uCOS

开发平台：

C/C++

2440lib.c：源码内容
  1. //===================================================================
  2. // File Name : 2440lib.c
  3. // Function  : S3C2440 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 "option.h"
  11. #include "2440addr.h"
  12. #include "2440lib.h"
  13. #include "2440slib.h" 
  15. #include <stdarg.h>
  16. #include <string.h>
  17. #include <stdlib.h>
  18. #include <stdio.h>
  19. #include <ctype.h>
  21. extern char Image$$RW$$Limit[];
  22. void *mallocPt=Image$$RW$$Limit;
  24. //***************************[ SYSTEM ]***************************************************
  25. static int delayLoopCount;
  27. void Delay(int time)
  28. {
  29.        // time=0: adjust the Delay function by WatchDog timer.
  30.        // time>0: the number of loop time
  31.        // resolution of time is 100us.
  32.   int i, adjust=0;
  34.      if(time==0)
  35.      {
  36.         time   = 200;
  37.          adjust = 1;
  38.          delayLoopCount = 800;
  40.              //PCLK/1M,Watch-dog disable,1/64,interrupt disable,reset disable
  41.          rWTCON = ((PCLK/1000000-1)<<8)|(2<<3); 
  42.          rWTDAT = 0xffff;                              //for first update
  43.          rWTCNT = 0xffff;                              //resolution=64us @any PCLK 
  44. rWTCON = ((PCLK/1000000-1)<<8)|(2<<3)|(1<<5); //Watch-dog timer start
  45.      }
  47.      for(;time>0;time--)
  48.         for(i=0;i<delayLoopCount;i++);
  50.      if(adjust==1)
  51.      {
  52.          rWTCON = ((PCLK/1000000-1)<<8)|(2<<3); //Watch-dog timer stop
  53.          i = 0xffff - rWTCNT;                     //1count->64us, 200*800 cycle runtime = 64*i us
  55. //Uart_Printf("nrWTCNT=%x ", rWTCNT);
  56. //Uart_Printf("ni (0xffff -rWTCNT)=%d", i);
  58.          delayLoopCount = 16000000/(i*64);         //200*800:64*i=1*x:100 -> x=160000*100/(64*i)   
  59.          //Uart_Printf("ndelayLoopCount=%d", delayLoopCount);
  60.      }
  61.     
  62. }
  65. //***************************[ PORTS ]****************************************************
  66. void Port_Init(void)
  67. {
  68.     //CAUTION:Follow the configuration order for setting the ports. 
  69.     // 1) setting value(GPnDAT) 
  70.     // 2) setting control register  (GPnCON)
  71.     // 3) configure pull-up resistor(GPnUP)  
  73.     //32bit data bus configuration  
  74.     //*** PORT A GROUP
  75.     //Ports  : GPA22 GPA21  GPA20 GPA19 GPA18 GPA17 GPA16 GPA15 GPA14 GPA13 GPA12  
  76.     //Signal : nFCE nRSTOUT nFRE   nFWE  ALE   CLE  nGCS5 nGCS4 nGCS3 nGCS2 nGCS1 
  77.     //Binary :  1     1      1  , 1   1   1    1   ,  1     1     1     1
  78.     //Ports  : GPA11   GPA10  GPA9   GPA8   GPA7   GPA6   GPA5   GPA4   GPA3   GPA2   GPA1  GPA0
  79.     //Signal : ADDR26 ADDR25 ADDR24 ADDR23 ADDR22 ADDR21 ADDR20 ADDR19 ADDR18 ADDR17 ADDR16 ADDR0 
  80.     //Binary :  1       1      1      1   , 1       1      1      1   ,  1       1     1      1         
  81.     rGPACON = 0x7fffff; 
  83.     //**** PORT B GROUP
  84.     //Ports  : GPB10    GPB9    GPB8    GPB7    GPB6     GPB5    GPB4   GPB3   GPB2     GPB1      GPB0
  85.     //Signal : nXDREQ0 nXDACK0 nXDREQ1 nXDACK1 nSS_KBD nDIS_OFF L3CLOCK L3DATA L3MODE nIrDATXDEN Keyboard
  86.     //Setting: OUTPUT  OUTPUT   OUTPUT  OUTPUT   OUTPUT   OUTPUT   OUTPUT OUTPUT OUTPUT   OUTPUT    OUTPUT 
  87.     //Binary :   01  ,  01       01  ,   01      01   ,  01       01  ,   01     01   ,  01        01  
  88.     rGPBCON = 0x155555;
  89.     rGPBUP  = 0x7ff;     // The pull up function is disabled GPB[10:0]
  91.     //*** PORT C GROUP
  92.     //Ports  : GPC15 GPC14 GPC13 GPC12 GPC11 GPC10 GPC9 GPC8  GPC7   GPC6   GPC5 GPC4 GPC3  GPC2  GPC1 GPC0
  93.     //Signal : VD7   VD6   VD5   VD4   VD3   VD2   VD1  VD0 LCDVF2 LCDVF1 LCDVF0 VM VFRAME VLINE VCLK LEND  
  94.     //Binary :  10   10  , 10    10  , 10    10  , 10   10  , 10     10  ,  10   10 , 10     10 , 10   10
  95.     rGPCCON = 0xaaaaaaaa;       
  96.     rGPCUP  = 0xffff;     // The pull up function is disabled GPC[15:0] 
  98.     //*** PORT D GROUP
  99.     //Ports  : GPD15 GPD14 GPD13 GPD12 GPD11 GPD10 GPD9 GPD8 GPD7 GPD6 GPD5 GPD4 GPD3 GPD2 GPD1 GPD0
  100.     //Signal : VD23  VD22  VD21  VD20  VD19  VD18  VD17 VD16 VD15 VD14 VD13 VD12 VD11 VD10 VD9  VD8
  101.     //Binary : 10    10  , 10    10  , 10    10  , 10   10 , 10   10 , 10   10 , 10   10 ,10   10
  102.     rGPDCON = 0xaaaaaaaa;       
  103.     rGPDUP  = 0xffff;     // The pull up function is disabled GPD[15:0]
  105.     //*** PORT E GROUP
  106.     //Ports  : GPE15  GPE14 GPE13   GPE12   GPE11   GPE10   GPE9    GPE8     GPE7  GPE6  GPE5   GPE4  
  107.     //Signal : IICSDA IICSCL SPICLK SPIMOSI SPIMISO SDDATA3 SDDATA2 SDDATA1 SDDATA0 SDCMD SDCLK I2SSDO 
  108.     //Binary :  10     10  ,  10      10  ,  10      10   ,  10      10   ,   10    10  , 10     10  ,     
  109.     //-------------------------------------------------------------------------------------------------------
  110.     //Ports  :  GPE3   GPE2  GPE1    GPE0    
  111.     //Signal : I2SSDI CDCLK I2SSCLK I2SLRCK     
  112.     //Binary :  10     10  ,  10      10 
  113.     rGPECON = 0xaaaaaaaa;       
  114.     rGPEUP  = 0xffff;     // The pull up function is disabled GPE[15:0]
  117.     //*** PORT F GROUP
  118.     //Ports  : GPF7   GPF6   GPF5   GPF4      GPF3     GPF2  GPF1   GPF0
  119.     //Signal : nLED_8 nLED_4 nLED_2 nLED_1 nIRQ_PCMCIA EINT2 KBDINT EINT0
  120.     //Setting: Output Output Output Output    EINT3    EINT2 EINT1  EINT0
  121.     //Binary :  01      01 ,  01     01  ,     10       10  , 10     10
  122.     rGPFCON = 0x55aa;
  123.     rGPFUP  = 0xff;     // The pull up function is disabled GPF[7:0]
  125.     //*** PORT G GROUP
  126.     //Ports  : GPG15 GPG14 GPG13 GPG12 GPG11    GPG10    GPG9     GPG8     GPG7      GPG6    
  127.     //Signal : nYPON  YMON nXPON XMON  EINT19 DMAMODE1 DMAMODE0 DMASTART KBDSPICLK KBDSPIMOSI
  128.     //Setting: nYPON  YMON nXPON XMON  EINT19  Output   Output   Output   SPICLK1    SPIMOSI1
  129.     //Binary :   11    11 , 11    11  , 10      01    ,   01       01   ,    11         11
  130.     //-----------------------------------------------------------------------------------------
  131.     //Ports  :    GPG5       GPG4    GPG3    GPG2    GPG1    GPG0    
  132.     //Signal : KBDSPIMISO LCD_PWREN EINT11 nSS_SPI IRQ_LAN IRQ_PCMCIA
  133.     //Setting:  SPIMISO1  LCD_PWRDN EINT11   nSS0   EINT9    EINT8
  134.     //Binary :     11         11   ,  10      11  ,  10        10
  135.     rGPGCON = 0xff95ffba;
  136.     rGPGUP  = 0xffff;    // The pull up function is disabled GPG[15:0]
  138.     //*** PORT H GROUP
  139.     //Ports  :  GPH10    GPH9  GPH8 GPH7  GPH6  GPH5 GPH4 GPH3 GPH2 GPH1  GPH0 
  140.     //Signal : CLKOUT1 CLKOUT0 UCLK nCTS1 nRTS1 RXD1 TXD1 RXD0 TXD0 nRTS0 nCTS0
  141.     //Binary :   10   ,  10     10 , 11    11  , 10   10 , 10   10 , 10    10
  142.     rGPHCON = 0x2afaaa;
  143.     rGPHUP  = 0x7ff;    // The pull up function is disabled GPH[10:0]
  145.     // Added for S3C2440, DonGo
  146.     //PORT J GROUP
  147.     //Ports :  GPJ12    GPJ11     GPJ10 GPJ9  GPJ8      GPJ7 GPJ6  GPJ5 GPJ4  GPJ3  GPJ2  GPJ1  GPJ0
  148.     //Signal : CAMRESET CAMCLKOUT CAMHREF CAMVS CAMPCLKIN CAMD7 CAMD6 CAMD5 CAMD4 CAMD3 CAMD2 CAMD1 CAMD0
  149.     //Setting: Out      Out      CAMHREF CAMVS CAMPCLKIN CAMD7 CAMD6 CAMD5 CAMD4 CAMD3 CAMD2 CAMD1 CAMD0
  150.     //Binary : 01   01        10      10    10        10    10    10    10    10    10    10    10
  151.     //PU_OFF : 1   0  1     1     1         1     1     1 1 1     1     1     1
  152.     //---------------------------------------------------------------------------------------
  153.     rGPJDAT = (1<<12)|(0<<11);
  154.     rGPJCON = 0x016aaaa;
  155.     rGPJUP = ~((0<<12)|(1<<11));
  157.     rGPJDAT = (0<<12)|(0<<11);
  158.     rGPJCON = 0x016aaaa;
  159.     rGPJUP = 0x1fff;//~((1<<12)|(1<<11));
  162.     //rGPJCON = 0x02aaaaaa;
  163.     //rGPJUP  = 0x1fff;    // The pull up function is disabled GPH[10:0]
  165.     //External interrupt will be falling edge triggered. 
  166.     rEXTINT0 = 0x22222222;    // EINT[7:0]
  167.     rEXTINT1 = 0x22222222;    // EINT[15:8]
  168.     rEXTINT2 = 0x22222222;    // EINT[23:16]
  169. }
  172. //***************************[ UART ]******************************
  173. static int whichUart=0;
  175. void Uart_Init(int pclk,int baud)
  176. {
  177.     int i;
  178.     if(pclk == 0)
  179.     pclk    = PCLK;
  180.     rUFCON0 = 0x0;   //UART channel 0 FIFO control register, FIFO disable
  181.     rUFCON1 = 0x0;   //UART channel 1 FIFO control register, FIFO disable
  182.     rUFCON2 = 0x0;   //UART channel 2 FIFO control register, FIFO disable
  183.     rUMCON0 = 0x0;   //UART chaneel 0 MODEM control register, AFC disable
  184.     rUMCON1 = 0x0;   //UART chaneel 1 MODEM control register, AFC disable
  185. //UART0
  186.     rULCON0 = 0x3;   //Line control register : Normal,No parity,1 stop,8 bits
  187.      //    [10]       [9]     [8]        [7]        [6]      [5]         [4]           [3:2]        [1:0]
  188.      // Clock Sel,  Tx Int,  Rx Int, Rx Time Out, Rx err, Loop-back, Send break,  Transmit Mode, Receive Mode
  189.      //     0          1       0    ,     0          1        0           0     ,       01          01
  190.      //   PCLK       Level    Pulse    Disable    Generate  Normal      Normal        Interrupt or Polling
  191.     rUCON0  = 0x245;   // Control register
  192.     rUBRDIV0=( (int)(pclk/16./baud+0.5) -1 );   //Baud rate divisior register 0
  193. //UART1
  194.     rULCON1 = 0x3;
  195.     rUCON1  = 0x245;
  196.     rUBRDIV1=( (int)(pclk/16./baud+0.5) -1 );
  197. //UART2
  198.     rULCON2 = 0x3;
  199.     rUCON2  = 0x245;
  200.     rUBRDIV2=( (int)(pclk/16./baud+0.5) -1 );    
  202. Uart_TxEmpty(whichUart);
  203.     //for(i=0;i<100;i++);
  204. }
  206. //===================================================================
  207. void Uart_Select(int ch)
  208. {
  209.     whichUart = ch;
  210. }
  212. //===================================================================
  213. void Uart_TxEmpty(int ch)
  214. {
  215.     if(ch==0)
  216.         while(!(rUTRSTAT0 & 0x4)); //Wait until tx shifter is empty.
  217.           
  218.     else if(ch==1)
  219.         while(!(rUTRSTAT1 & 0x4)); //Wait until tx shifter is empty.
  220.         
  221.     else if(ch==2)
  222.         while(!(rUTRSTAT2 & 0x4)); //Wait until tx shifter is empty.
  223. }
  225. //=====================================================================
  226. char Uart_Getch(void)
  227. {
  228.     if(whichUart==0)
  229.     {       
  230.         while(!(rUTRSTAT0 & 0x1)); //Receive data ready
  231.         return RdURXH0();
  232.     }
  233.     else if(whichUart==1)
  234.     {       
  235.         while(!(rUTRSTAT1 & 0x1)); //Receive data ready
  236.         return RdURXH1();
  237.     }
  238.     else if(whichUart==2)
  239.     {
  240.         while(!(rUTRSTAT2 & 0x1)); //Receive data ready
  241.         return RdURXH2();
  242.     }
  243. }
  245. //====================================================================
  246. char Uart_GetKey(void)
  247. {
  248.     if(whichUart==0)
  249.     {       
  250.         if(rUTRSTAT0 & 0x1)    //Receive data ready
  251.             return RdURXH0();
  252.         else
  253.             return 0;
  254.     }
  255.     else if(whichUart==1)
  256.     {
  257.         if(rUTRSTAT1 & 0x1)    //Receive data ready
  258.             return RdURXH1();
  259.         else
  260.             return 0;
  261.     }
  262.     else if(whichUart==2)
  263.     {       
  264.         if(rUTRSTAT2 & 0x1)    //Receive data ready
  265.             return RdURXH2();
  266.         else
  267.             return 0;
  268.     }    
  269. }
  271. //====================================================================
  272. void Uart_GetString(char *string)
  273. {
  274.     char *string2 = string;
  275.     char c;
  276.     while((c = Uart_Getch())!='r')
  277.     {
  278.         if(c=='b')
  279.         {
  280.             if( (int)string2 < (int)string )
  281.             {
  282.                 Uart_Printf("b b");
  283.                 string--;
  284.             }
  285.         }
  286.         else 
  287.         {
  288.             *string++ = c;
  289.             Uart_SendByte(c);
  290.         }
  291.     }
  292.     *string='';
  293.     Uart_SendByte('n');
  294. }
  296. //=====================================================================
  297. int Uart_GetIntNum(void)
  298. {
  299.     char str[30];
  300.     char *string = str;
  301.     int base     = 10;
  302.     int minus    = 0;
  303.     int result   = 0;
  304.     int lastIndex;    
  305.     int i;
  306.     
  307.     Uart_GetString(string);
  308.     
  309.     if(string[0]=='-')
  310.     {
  311.         minus = 1;
  312.         string++;
  313.     }
  314.     
  315.     if(string[0]=='0' && (string[1]=='x' || string[1]=='X'))
  316.     {
  317.         base    = 16;
  318.         string += 2;
  319.     }
  320.     
  321.     lastIndex = strlen(string) - 1;
  322.     
  323.     if(lastIndex<0)
  324.         return -1;
  325.     
  326.     if(string[lastIndex]=='h' || string[lastIndex]=='H' )
  327.     {
  328.         base = 16;
  329.         string[lastIndex] = 0;
  330.         lastIndex--;
  331.     }
  333.     if(base==10)
  334.     {
  335.         result = atoi(string);
  336.         result = minus ? (-1*result):result;
  337.     }
  338.     else
  339.     {
  340.         for(i=0;i<=lastIndex;i++)
  341.         {
  342.             if(isalpha(string[i]))
  343.             {
  344.                 if(isupper(string[i]))
  345.                     result = (result<<4) + string[i] - 'A' + 10;
  346.                 else
  347.                     result = (result<<4) + string[i] - 'a' + 10;
  348.             }
  349.             else
  350.                 result = (result<<4) + string[i] - '0';
  351.         }
  352.         result = minus ? (-1*result):result;
  353.     }
  354.     return result;
  355. }
  357. //=====================================================================
  358. void Uart_SendByte(int data)
  359. {
  360.     if(whichUart==0)
  361.     {
  362.         if(data=='n')
  363.         {
  364.             while(!(rUTRSTAT0 & 0x2));
  365.             Delay(10);                 //because the slow response of hyper_terminal 
  366.             WrUTXH0('r');
  367.         }
  368.         while(!(rUTRSTAT0 & 0x2));   //Wait until THR is empty.
  369.         Delay(10);
  370.         WrUTXH0(data);
  371.     }
  372.     else if(whichUart==1)
  373.     {
  374.         if(data=='n')
  375.         {
  376.             while(!(rUTRSTAT1 & 0x2));
  377.             Delay(10);                 //because the slow response of hyper_terminal 
  378.             rUTXH1 = 'r';
  379.         }
  380.         while(!(rUTRSTAT1 & 0x2));   //Wait until THR is empty.
  381.         Delay(10);
  382.         rUTXH1 = data;
  383.     }   
  384.     else if(whichUart==2)
  385.     {
  386.         if(data=='n')
  387.         {
  388.             while(!(rUTRSTAT2 & 0x2));
  389.             Delay(10);                 //because the slow response of hyper_terminal 
  390.             rUTXH2 = 'r';
  391.         }
  392.         while(!(rUTRSTAT2 & 0x2));   //Wait until THR is empty.
  393.         Delay(10);
  394.         rUTXH2 = data;
  395.     }       
  396. }               
  398. //====================================================================
  399. void Uart_SendString(char *pt)
  400. {
  401.     while(*pt)
  402.         Uart_SendByte(*pt++);
  403. }
  405. #if !USE_MAIN
  406. //If you don't use vsprintf(), the code size is reduced very much.
  407. void Uart_Printf(const char *fmt,...)
  408. {
  409.     va_list ap;
  410.     char string[50];
  412.     va_start(ap,fmt);
  413.     vsprintf(string,fmt,ap);
  414.     va_end(ap);
  415.     Uart_SendString(string);
  416. }
  417. #endif
  419. //**************************[ BOARD LED ]*********************************
  420. void Led_Display(int data)
  421. {
  422.           //Active is low.(LED On)
  423.           // GPF7  GPF6   GPF5   GPF4
  424.           //nLED_8 nLED4 nLED_2 nLED_1
  425. //    rGPFDAT = (rGPFDAT & 0xf) | !((data & 0xf)<<4);
  426.     rGPFDAT = (rGPFDAT & ~(0xf<<4)) | ((~data & 0xf)<<4);    
  427. }
  429. //********************** BOARD LCD backlight ]****************************
  430. void LcdBkLtSet(U32 HiRatio)
  431. {
  432. #define FREQ_PWM1 1000
  434. if(!HiRatio)
  435. {
  436. rGPBCON  = rGPBCON & (~(3<<2)) | (1<<2) ; //GPB1设置为output
  437. rGPBDAT &= ~(1<<1);
  438. return;
  439. }
  440. rGPBCON = rGPBCON & (~(3<<2)) | (2<<2) ; //GPB1设置为TOUT1
  442. if( HiRatio > 100 )
  443. HiRatio = 100 ;
  445. rTCON = rTCON & (~(0xf<<8)) ; // clear manual update bit, stop Timer1
  447. rTCFG0  &= 0xffffff00; // set Timer 0&1 prescaler 0
  448. rTCFG0 |= 15; //prescaler = 15+1
  450. rTCFG1  &= 0xffffff0f; // set Timer 1 MUX 1/16
  451. rTCFG1  |= 0x00000030; // set Timer 1 MUX 1/16
  453. rTCNTB1  = ( 100000000>>8 )/FREQ_PWM1; //if set inverter off, when TCNT2<=TCMP2, TOUT is high, TCNT2>TCMP2, TOUT is low
  454. rTCMPB1  = ( rTCNTB1*(100-HiRatio))/100 ; //if set inverter on,  when TCNT2<=TCMP2, TOUT is low,  TCNT2>TCMP2, TOUT is high
  456. rTCON = rTCON & (~(0xf<<8)) | (0x0e<<8) ;
  457. //自动重装,输出取反关闭,更新TCNTBn、TCMPBn,死区控制器关闭
  458. rTCON = rTCON & (~(0xf<<8)) | (0x0d<<8) ; //开启背光控制
  459. }
  461. /****************************************************************************
  462. 【功能说明】LCD背光亮度控制，PWM控制占空比
  463. ****************************************************************************/
  464. void LCD_BackLight_Control( void )
  465. {
  466. U8 HiRatio = 50 ;
  467.     Uart_Printf( "nNOTE : ONLY SOME type LCD kit  SUPPORT backlight adjust!!!n" ) ;
  469.     Uart_Printf( "Press +/- to increase/reduce the light of LCD !n" ) ;
  470. Uart_Printf( "Press 'ESC' to Exit this test program !nn" );
  472. LcdBkLtSet( HiRatio ) ;
  474.     while( 1 )
  475.     {
  476. U8 key = Uart_Getch();
  478. if( key == '+' )
  479. {
  480. if( HiRatio < 100 )
  481. HiRatio += 1 ;
  482. }
  484. if( key == '-' )
  485. {
  486. if( HiRatio > 1 )
  487. HiRatio -= 1 ;
  488. }
  490. if( key == ESC_KEY ) break ;
  492. LcdBkLtSet( HiRatio ) ;
  493. Uart_Printf( "LCD backlight HiRatio %dn", HiRatio ) ;
  494. }
  496. }
  497. //*************************[ Timer ]********************************
  498. void Timer_Start(int divider)  //0:16us,1:32us 2:64us 3:128us
  499. {
  500.     rWTCON = ((PCLK/1000000-1)<<8)|(divider<<3);  //Watch-dog timer control register
  501.     rWTDAT = 0xffff;  //Watch-dog timer data register
  502.     rWTCNT = 0xffff;  //Watch-dog count register
  504.       // Watch-dog timer enable & interrupt  disable
  505.     rWTCON = (rWTCON & ~(1<<5) & ~(1<<2)) |(1<<5);
  506. }
  508. //=================================================================
  509. int Timer_Stop(void)
  510. {
  511.     rWTCON = ((PCLK/1000000-1)<<8);
  512.     return (0xffff - rWTCNT);
  513. }
  516. //*************************[ MPLL ]*******************************
  517. void ChangeMPllValue(int mdiv,int pdiv,int sdiv)
  518. {
  519. //Led_Display(0x8);
  521.     rMPLLCON = (mdiv<<12) | (pdiv<<4) | sdiv;
  522. //Led_Display(0x0);
  523. }
  526. //************************[ HCLK, PCLK ]***************************
  527. /*
  528. // for 2410.
  529. void ChangeClockDivider(int hdivn,int pdivn)
  530. {
  531.      // hdivn,pdivn FCLK:HCLK:PCLK
  532.      //     0,0         1:1:1 
  533.      //     0,1         1:1:2 
  534.      //     1,0         1:2:2
  535.      //     1,1         1:2:4
  536.     rCLKDIVN = (hdivn<<1) | pdivn;    
  538.     if(hdivn)
  539.         MMU_SetAsyncBusMode();
  540.     else 
  541.         MMU_SetFastBusMode();
  542. }
  543. */
  544. // Modified for 2440.
  545. void ChangeClockDivider(int hdivn_val,int pdivn_val)
  546. {
  547. int hdivn=2, pdivn=0;
  549.      // hdivn_val (FCLK:HCLK)ratio hdivn
  550.      // 11           1:1       (0)
  551.      // 12           1:2       (1)
  552.      // 13           1:3       (3) 
  553.      // 14           1:4       (2)
  554.      // pdivn_val (HCLK:PCLK)ratio pdivn
  555.      // 11           1:1       (0)
  556.      // 12           1:2       (1)
  557. switch(hdivn_val) {
  558. case 11: hdivn=0; break;
  559. case 12: hdivn=1; break;
  560. case 13: hdivn=3; break;
  561. case 16: hdivn=3; break;
  562. case 14: hdivn=2; break;
  563. case 18: hdivn=2; break;
  564. }
  566. switch(pdivn_val) {
  567. case 11: pdivn=0; break;
  568. case 12: pdivn=1; break;
  569. }
  571. //Uart_Printf("Clock division change [hdiv:%x, pdiv:%x]n", hdivn, pdivn);
  572. rCLKDIVN = (hdivn<<1) | pdivn;
  573. //Uart_Printf("rCLKDIVN:%x]n", rCLKDIVN);
  575. switch(hdivn_val) {
  576. case 16: // when 1, HCLK=FCLK/6.
  577. rCAMDIVN = (rCAMDIVN & ~(3<<8)) | (1<<8); 
  578. break; 
  579. case 18:  // when 1, HCLK=FCLK/8.
  580. rCAMDIVN = (rCAMDIVN & ~(3<<8)) | (1<<9); 
  581. break;
  582. }
  583. //Uart_Printf("rCAMDIVN:%x]n", rCAMDIVN);
  585.     if(hdivn!=0)
  586.         MMU_SetAsyncBusMode();
  587.     else 
  588.         MMU_SetFastBusMode();
  589. }
  593. //**************************[ UPLL ]*******************************
  594. void ChangeUPllValue(int mdiv,int pdiv,int sdiv)
  595. {
  596.     rUPLLCON = (mdiv<<12) | (pdiv<<4) | sdiv;
  597. }
  599. void ChangeSromParameter(char bank, char minacc)  // only for Tacc
  600. {
  601.     int acc;
  603.     //1000000/(hclk/1000000.)=Unit Period(ns)*1000
  604.     acc = (int)(minacc*(HCLK/1000000.)/1000+0.5);
  606.     if(acc<=1)
  607. acc=0;    
  608.     else if(acc==2)
  609.   acc=1;
  610.     else if(acc==3)
  611.   acc=2;
  612.     else if(acc==4)
  613.   acc=3;
  614.     else if((5<acc)&&(acc<=6))
  615.     acc=4;
  616.     else if((7<acc)&&(acc<=8))
  617.   acc=5;
  618.     else if((9<acc)&&(acc<=10))
  619.     acc=6;
  620.     else if(11<acc)
  621.   acc=7;
  623.     switch(bank)
  624.     {
  625.   case 0 : rBANKCON0 |= (acc<<8); break;
  626.   case 1 : rBANKCON1 |= (acc<<8); break;
  627.   case 2 : rBANKCON2 |= (acc<<8); break;
  628.   case 3 : rBANKCON3 |= (acc<<8); break;
  629.   case 4 : rBANKCON4 |= (acc<<8); break;
  630.   case 5 : rBANKCON5 |= (acc<<8); break;
  631.     }
  632. }
  635. // each timing parameter's unit is nano second..
  636. void ChangeSdramParameter(char bank_num, int minrc, int minrcd, int minrp, int refresh, int col_addr, int cl, char banksize)
  637. {
  638.     int rc, rcd, rp, rcnt, scan;
  640.     //1000000/(hclk/1000000.)=Unit Period(ns)*1000
  641.     rc = (int)(minrc*(HCLK/1000000.)/1000+0.5)-4;
  642.     rcd = (int)(minrcd*(HCLK/1000000.)/1000+0.5)-2;
  643.     rp = (int)(minrp*(HCLK/1000000.)/1000+0.5)-2;
  644. rcnt = (int)(2048+1-(HCLK/1000000.)*(refresh/1000.)+0.5);
  645. scan = col_addr-8;
  647. if (rc<0) rc=0; if (rc>3) rc = 3;
  648. if (rcd<0) rcd=0; if (rcd>2) rcd = 2;
  649. if (rp<0) rp=0; if (rp>2) rp = 2;
  650. if (cl==1) cl = 0;
  651. switch(banksize)
  652. {
  653. case 2 : banksize = 4; break;
  654. case 4 : banksize = 5; break;
  655. case 8 : banksize = 6; break;
  656. case 16 : banksize = 7; break;
  657. case 32 : banksize = 0; break;
  658. case 64 : banksize = 1; break;
  659. default : banksize = 2; break; // 128MB/128MB
  660. }
  662. // Uart_Printf("rc=%d, rcd=%d, rp=%d, rcnt=%d, scan=%d, cl=%d, banksize=%dn", rc, rcd, rp, rcnt, scan, cl, banksize);
  664.     switch(bank_num)
  665.     {
  666.     case 0:
  667.     case 6:
  668. default:
  669. rBANKCON6 = ( rBANKCON6 & ~((3<<15)|(0xf<<0)) ) | (3<<15)|(rcd<<2)|(scan); // SDRAM, Trcd, column address number
  670. rMRSRB6 = (rMRSRB6 & ~(3<<4)) | (cl<<4);
  671. break;
  672. case 1:
  673.     case 7: // bank 7
  674. rBANKCON7 = ( rBANKCON7 & ~((3<<15)|(0xf<<0)) ) | (3<<15)|(rcd<<2)|(scan); // SDRAM, Trcd, column address number
  675. rMRSRB7 = (rMRSRB7 & ~(3<<4)) | (cl<<4);
  676. break;
  677.     }
  678. rREFRESH = (rREFRESH & ~(0x3f<<18)) | (1<<23)|(0<<22)|(rp<<20)|(rc<<18)|(rcnt); // refresh enable, auto refresh, Trp, Trc, Refresh counter
  679. rBANKSIZE = (rBANKSIZE & ~(7<<0)) | (banksize); // SCLK power save mode, 128/128 bank
  681. }
  683. void Max1718_Set(int voltage)
  684. {
  686.      int vtg;
  687. //////////////////////////////////////////////
  688. //   D4    D3  D2   D1     D0
  689. // 0  1 0  0  0 // 1.35V
  690. // 0  1 0  0  1 // 1.30V
  691. // 0  1 0  1  0 // 1.25V
  692. // 0  1 0  1  1 // 1.20V
  693. // 0  1 1  0  0 // 1.15V
  694. // 0  1 1  0  1 // 1.10V
  695. // 0  1 1  1  0 // 1.05V
  696. // 0  1 1  1  1 // 1.00V
  697. // 1  0 0  0  1 // 0.95V
  698. // 1  0 0  1  1 // 0.90V
  699. // 1  0 1  0  1 // 0.85V
  700. // 1  0 1  1  1 // 0.80V
  702.     vtg=voltage;
  703. rGPBCON = (rGPBCON&~((3<<20) |(3<<16) |(3<<14))) | (1<<20) | (1<<16) | (1<<14);
  704. // GPB7, 8, 10 : Output
  705. rGPFCON=(rGPFCON&~(0xff<<8))|(0x55<<8);  // GPF4~7: Output , shared with LED4~7
  707.      switch (vtg)
  708. {
  709. case 135:
  710.  rGPBDAT=(rGPBDAT&~(1<<7)) |(0<<7); //D4
  711.       rGPFDAT=(rGPFDAT&~(0xf<<4))|(1<<7)|(0<<6)|(0<<5)|(0<<4); //D3~0
  712.       break;
  715. case 130:
  716.  rGPBDAT=(rGPBDAT&~(1<<7)) |(0<<7); //D4
  717.  rGPFDAT=(rGPFDAT&~(0xf<<4))|(1<<7)|(0<<6)|(0<<5)|(1<<4); //D3~0
  718.  break;
  719.        
  720. case 125:
  721.  rGPBDAT=(rGPBDAT&~(1<<7)) |(0<<7); //D4
  722.  rGPFDAT=(rGPFDAT&~(0xf<<4))|(1<<7)|(0<<6)|(1<<5)|(0<<4); //D3~0
  723. break;
  725. case 120:
  726.  rGPBDAT=(rGPBDAT&~(1<<7)) |(0<<7); //D4
  727.  rGPFDAT=(rGPFDAT&~(0xf<<4))|(1<<7)|(0<<6)|(1<<5)|(1<<4); //D3~0
  728.  break;
  730. case 115:
  731.  rGPBDAT=(rGPBDAT&~(1<<7)) |(0<<7); //D4
  732.  rGPFDAT=(rGPFDAT&~(0xf<<4))|(1<<7)|(1<<6)|(0<<5)|(0<<4); //D3~0
  733.  break;
  735. case 110:
  736.  rGPBDAT=(rGPBDAT&~(1<<7)) |(0<<7); //D4
  737.  rGPFDAT=(rGPFDAT&~(0xf<<4))|(1<<7)|(1<<6)|(0<<5)|(1<<4); //D3~0
  738.  break;
  740. case 105:
  741.  rGPBDAT=(rGPBDAT&~(1<<7)) |(0<<7); //D4
  742.  rGPFDAT=(rGPFDAT&~(0xf<<4))|(1<<7)|(1<<6)|(1<<5)|(0<<4); //D3~0
  743.  break;
  745. case 100:
  746.  rGPBDAT=(rGPBDAT&~(1<<7)) |(0<<7); //D4
  747.  rGPFDAT=(rGPFDAT&~(0xf<<4))|(1<<7)|(1<<6)|(1<<5)|(1<<4); //D3~0
  748. break;
  750. case 95:
  751.  rGPBDAT=(rGPBDAT&~(1<<7)) |(1<<7); //D4
  752.  rGPFDAT=(rGPFDAT&~(0xf<<4))|(0<<7)|(0<<6)|(0<<5)|(1<<4); //D3~0
  753.  break;
  755. case 90:
  756.  rGPBDAT=(rGPBDAT&~(1<<7)) |(1<<7); //D4
  757.  rGPFDAT=(rGPFDAT&~(0xf<<4))|(0<<7)|(0<<6)|(1<<5)|(1<<4); //D3~0
  758.  break;
  760. case 85:
  761.  rGPBDAT=(rGPBDAT&~(1<<7)) |(1<<7); //D4
  762. rGPFDAT=(rGPFDAT&~(0xf<<4))|(0<<7)|(1<<6)|(0<<5)|(1<<4); //D3~0
  763.  break;
  765.        case 80:
  766.  rGPBDAT=(rGPBDAT&~(1<<7)) |(1<<7); //D4
  767.        rGPFDAT=(rGPFDAT&~(0xf<<4))|(0<<7)|(1<<6)|(1<<5)|(1<<4); //D3~0
  768.  break;
  770.        default: // 1.2V
  771.  rGPBDAT=(rGPBDAT&~(1<<7)) |(0<<7); //D4
  772.  rGPFDAT=(rGPFDAT&~(0xf<<4))|(1<<7)|(0<<6)|(1<<5)|(1<<4); //D3~0
  773.  break;
  776. }
  777.  
  778. rGPBDAT&=~(1<<8);   //Latch enable
  779. rGPBDAT|=(1<<10);   //Output enable
  780. rGPBDAT|=(1<<8);  //Latch disable
  782. }