arch/arm/mach-lpc17xx/libs/hal/hal_machperiph.c

   1
   2 #include <system_def.h>
   3 #include <cpu_def.h>
   4 #include <hal_machperiph.h>
   5
   6
   7 /*----------------------------------------------------------------------------
   8   Check the register settings
   9  *----------------------------------------------------------------------------*/
  10 #define CHECK_RANGE(val, min, max)                ((val < min) || (val > max))
  11 #define CHECK_RSVD(val, mask)                     (val & mask)
  12
  13 /* Clock Configuration -------------------------------------------------------*/
  14 #if (CHECK_RSVD((SCS_Val),       ~0x00000030))
  15    #error "SCS: Invalid values of reserved bits!"
  16 #endif
  17
  18 #if (CHECK_RANGE((CLKSRCSEL_Val), 0, 2))
  19    #error "CLKSRCSEL: Value out of range!"
  20 #endif
  21
  22 #if (CHECK_RSVD((PLL0CFG_Val),   ~0x00FF7FFF))
  23    #error "PLL0CFG: Invalid values of reserved bits!"
  24 #endif
  25
  26 #if (CHECK_RSVD((PLL1CFG_Val),   ~0x0000007F))
  27    #error "PLL1CFG: Invalid values of reserved bits!"
  28 #endif
  29
  30 #if ((CCLKCFG_Val != 0) && (((CCLKCFG_Val - 1) % 2)))
  31    #error "CCLKCFG: CCLKSEL field does not contain only odd values or 0!"
  32 #endif
  33
  34 #if (CHECK_RSVD((USBCLKCFG_Val), ~0x0000000F))
  35    #error "USBCLKCFG: Invalid values of reserved bits!"
  36 #endif
  37
  38 #if (CHECK_RSVD((PCLKSEL0_Val),   0x000C0C00))
  39    #error "PCLKSEL0: Invalid values of reserved bits!"
  40 #endif
  41
  42 #if (CHECK_RSVD((PCLKSEL1_Val),   0x03000300))
  43    #error "PCLKSEL1: Invalid values of reserved bits!"
  44 #endif
  45
  46 #if (CHECK_RSVD((PCONP_Val),      0x10100821))
  47    #error "PCONP: Invalid values of reserved bits!"
  48 #endif
  49
  50 /* Flash Accelerator Configuration -------------------------------------------*/
  51 #if (CHECK_RSVD((FLASHCFG_Val), ~0x0000F07F))
  52    #error "FLASHCFG: Invalid values of reserved bits!"
  53 #endif
  54
  55 /*----------------------------------------------------------------------------
  56   Clock Variable definitions
  57  *----------------------------------------------------------------------------*/
  58 unsigned int system_frequency = IRC_OSC; /*!< System Clock Frequency (Core Clock)  */
  59
  60 void system_clock_init(void)
  61 {
  62 #if (CLOCK_SETUP)                       /* Clock Setup                        */
  63   SC->SCS       = SCS_Val;
  64   if (SCS_Val & (1 << 5)) {             /* If Main Oscillator is enabled      */
  65     while ((SC->SCS & (1 << 6)) == 0);  /* Wait for Oscillator to be ready    */
  66   }
  67
  68 #if (PLL0_SETUP)
  69   SC->CLKSRCSEL = CLKSRCSEL_Val;        /* Select Clock Source for PLL0       */
  70   SC->PLL0CFG   = PLL0CFG_Val;
  71   SC->PLL0CON   = 0x01;                 /* PLL0 Enable                        */
  72   SC->PLL0FEED  = 0xAA;
  73   SC->PLL0FEED  = 0x55;
  74   while (!(SC->PLL0STAT & (1 << 26)));  /* Wait for PLOCK0                    */
  75   SC->CCLKCFG   = CCLKCFG_Val;          /* Setup Clock Divider                */
  76
  77   SC->PLL0CON   = 0x03;                 /* PLL0 Enable & Connect              */
  78   SC->PLL0FEED  = 0xAA;
  79   SC->PLL0FEED  = 0x55;
  80 #endif
  81
  82 #if (PLL1_SETUP)
  83   SC->PLL1CFG   = PLL1CFG_Val;
  84   SC->PLL1CON   = 0x01;                 /* PLL1 Enable                        */
  85   SC->PLL1FEED  = 0xAA;
  86   SC->PLL1FEED  = 0x55;
  87   while (!(SC->PLL1STAT & (1 << 10)));  /* Wait for PLOCK1                    */
  88
  89   SC->PLL1CON   = 0x03;                 /* PLL1 Enable & Connect              */
  90   SC->PLL1FEED  = 0xAA;
  91   SC->PLL1FEED  = 0x55;
  92 #endif
  93 #endif
  94
  95   /* Determine clock frequency according to clock register values             */
  96   if (((SC->PLL0STAT >> 24) & 3) == 3) {/* If PLL0 enabled and connected      */
  97     switch (SC->CLKSRCSEL & 0x03) {
  98       case 0:                           /* Internal RC oscillator => PLL0     */
  99       case 3:                           /* Reserved, default to Internal RC   */
 100         system_frequency = (IRC_OSC *
 101                           (((2 * ((SC->PLL0STAT & 0x7FFF) + 1))) /
 102                           (((SC->PLL0STAT >> 16) & 0xFF) + 1))   /
 103                           ((SC->CCLKCFG & 0xFF)+ 1));
 104         break;
 105       case 1:                           /* Main oscillator => PLL0            */
 106         system_frequency = (OSC_CLK *
 107                           (((2 * ((SC->PLL0STAT & 0x7FFF) + 1))) /
 108                           (((SC->PLL0STAT >> 16) & 0xFF) + 1))   /
 109                           ((SC->CCLKCFG & 0xFF)+ 1));
 110         break;
 111       case 2:                           /* RTC oscillator => PLL0             */
 112         system_frequency = (RTC_CLK *
 113                           (((2 * ((SC->PLL0STAT & 0x7FFF) + 1))) /
 114                           (((SC->PLL0STAT >> 16) & 0xFF) + 1))   /
 115                           ((SC->CCLKCFG & 0xFF)+ 1));
 116         break;
 117     }
 118   } else {
 119     switch (SC->CLKSRCSEL & 0x03) {
 120       case 0:                           /* Internal RC oscillator => PLL0     */
 121       case 3:                           /* Reserved, default to Internal RC   */
 122         system_frequency = IRC_OSC / ((SC->CCLKCFG & 0xFF)+ 1);
 123         break;
 124       case 1:                           /* Main oscillator => PLL0            */
 125         system_frequency = OSC_CLK / ((SC->CCLKCFG & 0xFF)+ 1);
 126         break;
 127       case 2:                           /* RTC oscillator => PLL0             */
 128         system_frequency = RTC_CLK / ((SC->CCLKCFG & 0xFF)+ 1);
 129         break;
 130     }
 131   }
 132
 133 #if (FLASH_SETUP == 1)                  /* Flash Accelerator Setup            */
 134   SC->FLASHCFG  = FLASHCFG_Val;
 135 #endif
 136 }
 137
 138 void lpc_watchdog_feed()
 139 {
 140   unsigned long flags;
 141
 142   save_and_cli(flags);
 143   WDT->WDFEED = 0xAA;
 144   WDT->WDFEED = 0x55;
 145   restore_flags(flags);
 146 }
 147
 148 void lpc_watchdog_init(int on,int timeout_ms)
 149 {
 150   if (!on) return;
 151   WDT->WDCLKSEL = 1;
 152   WDT->WDTC = (PCLK/4)/(1000/timeout_ms);
 153   WDT->WDMOD = 0x03;                               /* Enable watchdog timer and reset */
 154 }