arch/mips/pmcs-msp71xx/msp_setup.c

   1 // SPDX-License-Identifier: GPL-2.0-or-later
   2 /*
   3  * The generic setup file for PMC-Sierra MSP processors
   4  *
   5  * Copyright 2005-2007 PMC-Sierra, Inc,
   6  * Author: Jun Sun, jsun@mvista.com or jsun@junsun.net
   7  */
   8
   9 #include <linux/delay.h>
  10
  11 #include <asm/bootinfo.h>
  12 #include <asm/cacheflush.h>
  13 #include <asm/idle.h>
  14 #include <asm/r4kcache.h>
  15 #include <asm/reboot.h>
  16 #include <asm/smp-ops.h>
  17 #include <asm/time.h>
  18
  19 #include <msp_prom.h>
  20 #include <msp_regs.h>
  21
  22 #if defined(CONFIG_PMC_MSP7120_GW)
  23 #include <msp_regops.h>
  24 #define MSP_BOARD_RESET_GPIO    9
  25 #endif
  26
  27 extern void msp_serial_setup(void);
  28
  29 #if defined(CONFIG_PMC_MSP7120_EVAL) || \
  30     defined(CONFIG_PMC_MSP7120_GW) || \
  31     defined(CONFIG_PMC_MSP7120_FPGA)
  32 /*
  33  * Performs the reset for MSP7120-based boards
  34  */
  35 void msp7120_reset(void)
  36 {
  37         void *start, *end, *iptr;
  38
  39         /* Diasble all interrupts */
  40         local_irq_disable();
  41 #ifdef CONFIG_SYS_SUPPORTS_MULTITHREADING
  42         dvpe();
  43 #endif
  44
  45         /* Cache the reset code of this function */
  46         __asm__ __volatile__ (
  47                 "       .set    push                            \n"
  48                 "       .set    arch=r4000                      \n"
  49                 "       la      %0,startpoint                   \n"
  50                 "       la      %1,endpoint                     \n"
  51                 "       .set    pop                             \n"
  52                 : "=r" (start), "=r" (end)
  53                 :
  54         );
  55
  56         for (iptr = (void *)((unsigned int)start & ~(L1_CACHE_BYTES - 1));
  57              iptr < end; iptr += L1_CACHE_BYTES)
  58                 cache_op(Fill, iptr);
  59
  60         __asm__ __volatile__ (
  61                 "startpoint:                                    \n"
  62         );
  63
  64         /* Put the DDRC into self-refresh mode */
  65         DDRC_INDIRECT_WRITE(DDRC_CTL(10), 0xb, 1 << 16);
  66
  67         /*
  68          * IMPORTANT!
  69          * DO NOT do anything from here on out that might even
  70          * think about fetching from RAM - i.e., don't call any
  71          * non-inlined functions, and be VERY sure that any inline
  72          * functions you do call do NOT access any sort of RAM
  73          * anywhere!
  74          */
  75
  76         /* Wait a bit for the DDRC to settle */
  77         mdelay(125);
  78
  79 #if defined(CONFIG_PMC_MSP7120_GW)
  80         /*
  81          * Set GPIO 9 HI, (tied to board reset logic)
  82          * GPIO 9 is the 4th GPIO of register 3
  83          *
  84          * NOTE: We cannot use the higher-level msp_gpio_mode()/out()
  85          * as GPIO char driver may not be enabled and it would look up
  86          * data inRAM!
  87          */
  88         set_value_reg32(GPIO_CFG3_REG, 0xf000, 0x8000);
  89         set_reg32(GPIO_DATA3_REG, 8);
  90
  91         /*
  92          * In case GPIO9 doesn't reset the board (jumper configurable!)
  93          * fallback to device reset below.
  94          */
  95 #endif
  96         /* Set bit 1 of the MSP7120 reset register */
  97         *RST_SET_REG = 0x00000001;
  98
  99         __asm__ __volatile__ (
 100                 "endpoint:                                      \n"
 101         );
 102 }
 103 #endif
 104
 105 void msp_restart(char *command)
 106 {
 107         printk(KERN_WARNING "Now rebooting .......\n");
 108
 109 #if defined(CONFIG_PMC_MSP7120_EVAL) || \
 110     defined(CONFIG_PMC_MSP7120_GW) || \
 111     defined(CONFIG_PMC_MSP7120_FPGA)
 112         msp7120_reset();
 113 #else
 114         /* No chip-specific reset code, just jump to the ROM reset vector */
 115         set_c0_status(ST0_BEV | ST0_ERL);
 116         change_c0_config(CONF_CM_CMASK, CONF_CM_UNCACHED);
 117         __flush_cache_all();
 118         write_c0_wired(0);
 119
 120         __asm__ __volatile__("jr\t%0"::"r"(0xbfc00000));
 121 #endif
 122 }
 123
 124 void msp_halt(void)
 125 {
 126         printk(KERN_WARNING "\n** You can safely turn off the power\n");
 127         while (1)
 128                 /* If possible call official function to get CPU WARs */
 129                 if (cpu_wait)
 130                         (*cpu_wait)();
 131                 else
 132                         __asm__(".set\tmips3\n\t" "wait\n\t" ".set\tmips0");
 133 }
 134
 135 void msp_power_off(void)
 136 {
 137         msp_halt();
 138 }
 139
 140 void __init plat_mem_setup(void)
 141 {
 142         _machine_restart = msp_restart;
 143         _machine_halt = msp_halt;
 144         pm_power_off = msp_power_off;
 145 }
 146
 147 void __init prom_init(void)
 148 {
 149         unsigned long family;
 150         unsigned long revision;
 151
 152         prom_argc = fw_arg0;
 153         prom_argv = (char **)fw_arg1;
 154         prom_envp = (char **)fw_arg2;
 155
 156         /*
 157          * Someday we can use this with PMON2000 to get a
 158          * platform call prom routines for output etc. without
 159          * having to use grody hacks.  For now it's unused.
 160          *
 161          * struct callvectors *cv = (struct callvectors *) fw_arg3;
 162          */
 163         family = identify_family();
 164         revision = identify_revision();
 165
 166         switch (family) {
 167         case FAMILY_FPGA:
 168                 if (FPGA_IS_MSP4200(revision)) {
 169                         /* Old-style revision ID */
 170                         mips_machtype = MACH_MSP4200_FPGA;
 171                 } else {
 172                         mips_machtype = MACH_MSP_OTHER;
 173                 }
 174                 break;
 175
 176         case FAMILY_MSP4200:
 177 #if defined(CONFIG_PMC_MSP4200_EVAL)
 178                 mips_machtype  = MACH_MSP4200_EVAL;
 179 #elif defined(CONFIG_PMC_MSP4200_GW)
 180                 mips_machtype  = MACH_MSP4200_GW;
 181 #else
 182                 mips_machtype = MACH_MSP_OTHER;
 183 #endif
 184                 break;
 185
 186         case FAMILY_MSP4200_FPGA:
 187                 mips_machtype  = MACH_MSP4200_FPGA;
 188                 break;
 189
 190         case FAMILY_MSP7100:
 191 #if defined(CONFIG_PMC_MSP7120_EVAL)
 192                 mips_machtype = MACH_MSP7120_EVAL;
 193 #elif defined(CONFIG_PMC_MSP7120_GW)
 194                 mips_machtype = MACH_MSP7120_GW;
 195 #else
 196                 mips_machtype = MACH_MSP_OTHER;
 197 #endif
 198                 break;
 199
 200         case FAMILY_MSP7100_FPGA:
 201                 mips_machtype  = MACH_MSP7120_FPGA;
 202                 break;
 203
 204         default:
 205                 /* we don't recognize the machine */
 206                 mips_machtype  = MACH_UNKNOWN;
 207                 panic("***Bogosity factor five***, exiting");
 208                 break;
 209         }
 210
 211         prom_init_cmdline();
 212
 213         prom_meminit();
 214
 215         /*
 216          * Sub-system setup follows.
 217          * Setup functions can  either be called here or using the
 218          * subsys_initcall mechanism (i.e. see msp_pci_setup). The
 219          * order in which they are called can be changed by using the
 220          * link order in arch/mips/pmc-sierra/msp71xx/Makefile.
 221          *
 222          * NOTE: Please keep sub-system specific initialization code
 223          * in separate specific files.
 224          */
 225         msp_serial_setup();
 226
 227         register_vsmp_smp_ops();
 228 }