bertos/cpu/cortex-m3/drv/clock.c

   1 /**
   2  * \file
   3  * <!--
   4  * This file is part of BeRTOS.
   5  *
   6  * Bertos is free software; you can redistribute it and/or modify
   7  * it under the terms of the GNU General Public License as published by
   8  * the Free Software Foundation; either version 2 of the License, or
   9  * (at your option) any later version.
  10  *
  11  * This program is distributed in the hope that it will be useful,
  12  * but WITHOUT ANY WARRANTY; without even the implied warranty of
  13  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
  14  * GNU General Public License for more details.
  15  *
  16  * You should have received a copy of the GNU General Public License
  17  * along with this program; if not, write to the Free Software
  18  * Foundation, Inc., 51 Franklin St, Fifth Floor, Boston, MA  02110-1301  USA
  19  *
  20  * As a special exception, you may use this file as part of a free software
  21  * library without restriction.  Specifically, if other files instantiate
  22  * templates or use macros or inline functions from this file, or you compile
  23  * this file and link it with other files to produce an executable, this
  24  * file does not by itself cause the resulting executable to be covered by
  25  * the GNU General Public License.  This exception does not however
  26  * invalidate any other reasons why the executable file might be covered by
  27  * the GNU General Public License.
  28  *
  29  * Copyright 2010 Develer S.r.l. (http://www.develer.com/)
  30  *
  31  * -->
  32  *
  33  * \brief LM3S1968 Clocking driver.
  34  *
  35  * \author Andrea Righi <arighi@develer.com>
  36  */
  37
  38 #include <cfg/compiler.h>
  39 #include <cfg/debug.h>
  40 #include "io/lm3s.h"
  41 #include "clock.h"
  42
  43 /* See: LM3S1968 Microcontroller DATASHEET, p.80 */
  44 static const unsigned long xtal_clk[] =
  45 {
  46         1000000,
  47         1843200,
  48         2000000,
  49         2457600,
  50         3579545,
  51         3686400,
  52         4000000,
  53         4096000,
  54         4915200,
  55         5000000,
  56         5120000,
  57         6000000,
  58         6144000,
  59         7372800,
  60         8000000,
  61         8192000,
  62         10000000,
  63         12000000,
  64         12288000,
  65         13560000,
  66         14318180,
  67         16000000,
  68         16384000,
  69 };
  70
  71 /* Extract the main oscillator frequency from the RCC register */
  72 #define RCC_TO_CLK(rcc) \
  73                 (xtal_clk[(((rcc) & SYSCTL_RCC_XTAL_MASK) >> \
  74                                 SYSCTL_RCC_XTAL_SHIFT)])
  75
  76 /* Extract the main oscillator frequency from the RCC register */
  77 #define RCC_TO_SYSDIV(rcc) \
  78                 (((rcc & SYSCTL_RCC_SYSDIV_MASK) >> \
  79                         SYSCTL_RCC_SYSDIV_SHIFT) + 1)
  80
  81 /*
  82  * Very small delay: each loop takes 3 cycles.
  83  */
  84 INLINE void __delay(unsigned long iterations)
  85 {
  86         asm volatile (
  87                 "1:     subs    %0, #1\n\t"
  88                 "       bne 1b\n\t"
  89                 : "=r"(iterations) : : "memory", "cc");
  90 }
  91
  92 unsigned long clock_get_rate(void)
  93 {
  94         unsigned long rcc, clk;
  95
  96         rcc = HWREG(SYSCTL_RCC);
  97
  98         /* Get the main oscillator frequency */
  99         clk = RCC_TO_CLK(rcc);
 100         /* Apply system clock divider */
 101         clk /= RCC_TO_SYSDIV(rcc);
 102
 103         return clk;
 104 }
 105
 106 void clock_set_rate(void)
 107 {
 108         reg32_t rcc, rcc2;
 109         int i;
 110
 111         rcc = HWREG(SYSCTL_RCC);
 112         rcc2 = HWREG(SYSCTL_RCC2);
 113
 114         /*
 115          * Step #1: bypass the PLL and system clock divider by setting the
 116          * BYPASS bit and clearing the USESYS bit in the RCC register. This
 117          * configures the system to run off a “raw” clock source (using the
 118          * main oscillator or internal oscillator) and allows for the new PLL
 119          * configuration to be validated before switching the system clock to
 120          * the PLL.
 121          */
 122         rcc |= SYSCTL_RCC_BYPASS;
 123         rcc &= ~SYSCTL_RCC_USESYSDIV;
 124         rcc2 |= SYSCTL_RCC2_BYPASS2;
 125
 126         /* Write back RCC/RCC2 registers */
 127         HWREG(SYSCTL_RCC) = rcc;
 128         HWREG(SYSCTL_RCC) = rcc2;
 129
 130         /*
 131          * Step #2: select the crystal value (XTAL) and oscillator source
 132          * (OSCSRC), and clear the PWRDN bit in RCC/RCC2. Setting the XTAL
 133          * field automatically pulls valid PLL configuration data for the
 134          * appropriate crystal, and clearing the PWRDN bit powers and enables
 135          * the PLL and its output.
 136          */
 137
 138         /* Enable the main oscillator first. */
 139         rcc &= ~(SYSCTL_RCC_IOSCDIS | SYSCTL_RCC_MOSCDIS);
 140         rcc |= SYSCTL_RCC_IOSCDIS;
 141
 142         /* Do not override RCC register fields */
 143         rcc2 &= ~SYSCTL_RCC2_USERCC2;
 144
 145         rcc &= ~(SYSCTL_RCC_XTAL_M | SYSCTL_RCC_OSCSRC_M | SYSCTL_RCC_PWRDN);
 146         rcc |= XTAL_FREQ | SYSCTL_RCC_OSCSRC_MAIN;
 147
 148         /* Clear the PLL lock interrupt. */
 149         HWREG(SYSCTL_MISC) = SYSCTL_INT_PLL_LOCK;
 150
 151         HWREG(SYSCTL_RCC) = rcc;
 152
 153         __delay(16);
 154
 155         /*
 156          * Step #3: select the desired system divider (SYSDIV) in RCC/RCC2 and
 157          * set the USESYS bit in RCC. The SYSDIV field determines the system
 158          * frequency for the microcontroller.
 159          */
 160         rcc &= ~(SYSCTL_RCC_SYSDIV_M | SYSCTL_RCC_USESYSDIV);
 161         for (i = 0; i < 15; i++)
 162         {
 163                 if (CPU_FREQ == RCC_TO_CLK(rcc))
 164                         break;
 165                 rcc |= SYSCTL_RCC_USESYSDIV;
 166         }
 167         if (i)
 168                 rcc |= i << SYSCTL_RCC_SYSDIV_SHIFT;
 169
 170         /*
 171          * Step #4: wait for the PLL to lock by polling the PLLLRIS bit in the
 172          * Raw Interrupt Status (RIS) register.
 173          */
 174         for (i = 0; i < 32768; i++)
 175                 if (HWREG(SYSCTL_RIS) & SYSCTL_INT_PLL_LOCK)
 176                         break;
 177
 178         /*
 179          * Step #5: enable use of the PLL by clearing the BYPASS bit in
 180          * RCC/RCC2.
 181          */
 182         rcc &= ~SYSCTL_RCC_BYPASS;
 183
 184         HWREG(SYSCTL_RCC) = rcc;
 185
 186         __delay(16);
 187 }