arch/mips/bcm63xx/prom.c

   1 /*
   2  * This file is subject to the terms and conditions of the GNU General Public
   3  * License.  See the file "COPYING" in the main directory of this archive
   4  * for more details.
   5  *
   6  * Copyright (C) 2008 Maxime Bizon <mbizon@freebox.fr>
   7  */
   8
   9 #include <linux/init.h>
  10 #include <linux/bootmem.h>
  11 #include <linux/smp.h>
  12 #include <asm/bootinfo.h>
  13 #include <asm/bmips.h>
  14 #include <asm/smp-ops.h>
  15 #include <asm/mipsregs.h>
  16 #include <bcm63xx_board.h>
  17 #include <bcm63xx_cpu.h>
  18 #include <bcm63xx_io.h>
  19 #include <bcm63xx_regs.h>
  20 #include <bcm63xx_gpio.h>
  21
  22 void __init prom_init(void)
  23 {
  24         u32 reg, mask;
  25
  26         bcm63xx_cpu_init();
  27
  28         /* stop any running watchdog */
  29         bcm_wdt_writel(WDT_STOP_1, WDT_CTL_REG);
  30         bcm_wdt_writel(WDT_STOP_2, WDT_CTL_REG);
  31
  32         /* disable all hardware blocks clock for now */
  33         if (BCMCPU_IS_3368())
  34                 mask = CKCTL_3368_ALL_SAFE_EN;
  35         else if (BCMCPU_IS_6328())
  36                 mask = CKCTL_6328_ALL_SAFE_EN;
  37         else if (BCMCPU_IS_6338())
  38                 mask = CKCTL_6338_ALL_SAFE_EN;
  39         else if (BCMCPU_IS_6345())
  40                 mask = CKCTL_6345_ALL_SAFE_EN;
  41         else if (BCMCPU_IS_6348())
  42                 mask = CKCTL_6348_ALL_SAFE_EN;
  43         else if (BCMCPU_IS_6358())
  44                 mask = CKCTL_6358_ALL_SAFE_EN;
  45         else if (BCMCPU_IS_6362())
  46                 mask = CKCTL_6362_ALL_SAFE_EN;
  47         else if (BCMCPU_IS_6368())
  48                 mask = CKCTL_6368_ALL_SAFE_EN;
  49         else
  50                 mask = 0;
  51
  52         reg = bcm_perf_readl(PERF_CKCTL_REG);
  53         reg &= ~mask;
  54         bcm_perf_writel(reg, PERF_CKCTL_REG);
  55
  56         /* register gpiochip */
  57         bcm63xx_gpio_init();
  58
  59         /* do low level board init */
  60         board_prom_init();
  61
  62         /* set up SMP */
  63         if (!register_bmips_smp_ops()) {
  64                 /*
  65                  * BCM6328 might not have its second CPU enabled, while BCM3368
  66                  * and BCM6358 need special handling for their shared TLB, so
  67                  * disable SMP for now.
  68                  */
  69                 if (BCMCPU_IS_6328()) {
  70                         reg = bcm_readl(BCM_6328_OTP_BASE +
  71                                         OTP_USER_BITS_6328_REG(3));
  72
  73                         if (reg & OTP_6328_REG3_TP1_DISABLED)
  74                                 bmips_smp_enabled = 0;
  75                 } else if (BCMCPU_IS_3368() || BCMCPU_IS_6358()) {
  76                         bmips_smp_enabled = 0;
  77                 }
  78
  79                 if (!bmips_smp_enabled)
  80                         return;
  81
  82                 /*
  83                  * The bootloader has set up the CPU1 reset vector at
  84                  * 0xa000_0200.
  85                  * This conflicts with the special interrupt vector (IV).
  86                  * The bootloader has also set up CPU1 to respond to the wrong
  87                  * IPI interrupt.
  88                  * Here we will start up CPU1 in the background and ask it to
  89                  * reconfigure itself then go back to sleep.
  90                  */
  91                 memcpy((void *)0xa0000200, &bmips_smp_movevec, 0x20);
  92                 __sync();
  93                 set_c0_cause(C_SW0);
  94                 cpumask_set_cpu(1, &bmips_booted_mask);
  95
  96                 /*
  97                  * FIXME: we really should have some sort of hazard barrier here
  98                  */
  99         }
 100 }
 101
 102 void __init prom_free_prom_memory(void)
 103 {
 104 }