arch/arm/cpu/armv7/mx6/soc.c

   1 /*
   2  * (C) Copyright 2007
   3  * Sascha Hauer, Pengutronix
   4  *
   5  * (C) Copyright 2009 Freescale Semiconductor, Inc.
   6  *
   7  * See file CREDITS for list of people who contributed to this
   8  * project.
   9  *
  10  * This program is free software; you can redistribute it and/or
  11  * modify it under the terms of the GNU General Public License as
  12  * published by the Free Software Foundation; either version 2 of
  13  * the License, or (at your option) any later version.
  14  *
  15  * This program is distributed in the hope that it will be useful,
  16  * but WITHOUT ANY WARRANTY; without even the implied warranty of
  17  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
  18  * GNU General Public License for more details.
  19  *
  20  * You should have received a copy of the GNU General Public License
  21  * along with this program; if not, write to the Free Software
  22  * Foundation, Inc., 59 Temple Place, Suite 330, Boston,
  23  * MA 02111-1307 USA
  24  */
  25
  26 #include <common.h>
  27 #include <asm/errno.h>
  28 #include <asm/io.h>
  29 #include <asm/arch/imx-regs.h>
  30 #include <asm/arch/clock.h>
  31 #include <asm/arch/sys_proto.h>
  32
  33 u32 get_cpu_rev(void)
  34 {
  35         struct anatop_regs *anatop = (struct anatop_regs *)ANATOP_BASE_ADDR;
  36         int reg = readl(&anatop->digprog);
  37
  38         /* Read mx6 variant: quad, dual or solo */
  39         int system_rev = (reg >> 4) & 0xFF000;
  40         /* Read mx6 silicon revision */
  41         system_rev |= (reg & 0xFF) + 0x10;
  42
  43         return system_rev;
  44 }
  45
  46 void init_aips(void)
  47 {
  48         struct aipstz_regs *aips1, *aips2;
  49
  50         aips1 = (struct aipstz_regs *)AIPS1_BASE_ADDR;
  51         aips2 = (struct aipstz_regs *)AIPS2_BASE_ADDR;
  52
  53         /*
  54          * Set all MPROTx to be non-bufferable, trusted for R/W,
  55          * not forced to user-mode.
  56          */
  57         writel(0x77777777, &aips1->mprot0);
  58         writel(0x77777777, &aips1->mprot1);
  59         writel(0x77777777, &aips2->mprot0);
  60         writel(0x77777777, &aips2->mprot1);
  61
  62         /*
  63          * Set all OPACRx to be non-bufferable, not require
  64          * supervisor privilege level for access,allow for
  65          * write access and untrusted master access.
  66          */
  67         writel(0x00000000, &aips1->opacr0);
  68         writel(0x00000000, &aips1->opacr1);
  69         writel(0x00000000, &aips1->opacr2);
  70         writel(0x00000000, &aips1->opacr3);
  71         writel(0x00000000, &aips1->opacr4);
  72         writel(0x00000000, &aips2->opacr0);
  73         writel(0x00000000, &aips2->opacr1);
  74         writel(0x00000000, &aips2->opacr2);
  75         writel(0x00000000, &aips2->opacr3);
  76         writel(0x00000000, &aips2->opacr4);
  77 }
  78
  79 /*
  80  * Set the VDDSOC
  81  *
  82  * Mask out the REG_CORE[22:18] bits (REG2_TRIG) and set
  83  * them to the specified millivolt level.
  84  * Possible values are from 0.725V to 1.450V in steps of
  85  * 0.025V (25mV).
  86  */
  87 void set_vddsoc(u32 mv)
  88 {
  89         struct anatop_regs *anatop = (struct anatop_regs *)ANATOP_BASE_ADDR;
  90         u32 val, reg = readl(&anatop->reg_core);
  91
  92         if (mv < 725)
  93                 val = 0x00;     /* Power gated off */
  94         else if (mv > 1450)
  95                 val = 0x1F;     /* Power FET switched full on. No regulation */
  96         else
  97                 val = (mv - 700) / 25;
  98
  99         /*
 100          * Mask out the REG_CORE[22:18] bits (REG2_TRIG)
 101          * and set them to the calculated value (0.7V + val * 0.25V)
 102          */
 103         reg = (reg & ~(0x1F << 18)) | (val << 18);
 104         writel(reg, &anatop->reg_core);
 105 }
 106
 107 int arch_cpu_init(void)
 108 {
 109         init_aips();
 110
 111         set_vddsoc(1200);       /* Set VDDSOC to 1.2V */
 112
 113         return 0;
 114 }
 115
 116 #ifndef CONFIG_SYS_DCACHE_OFF
 117 void enable_caches(void)
 118 {
 119         /* Enable D-cache. I-cache is already enabled in start.S */
 120         dcache_enable();
 121 }
 122 #endif
 123
 124 #if defined(CONFIG_FEC_MXC)
 125 void imx_get_mac_from_fuse(int dev_id, unsigned char *mac)
 126 {
 127         struct iim_regs *iim = (struct iim_regs *)IMX_IIM_BASE;
 128         struct fuse_bank *bank = &iim->bank[4];
 129         struct fuse_bank4_regs *fuse =
 130                         (struct fuse_bank4_regs *)bank->fuse_regs;
 131
 132         u32 value = readl(&fuse->mac_addr_high);
 133         mac[0] = (value >> 8);
 134         mac[1] = value ;
 135
 136         value = readl(&fuse->mac_addr_low);
 137         mac[2] = value >> 24 ;
 138         mac[3] = value >> 16 ;
 139         mac[4] = value >> 8 ;
 140         mac[5] = value ;
 141
 142 }
 143 #endif