kernel/arch/mips/lantiq/falcon/prom.c

   1 /*
   2  * This program is free software; you can redistribute it and/or modify it
   3  * under the terms of the GNU General Public License version 2 as published
   4  * by the Free Software Foundation.
   5  *
   6  * Copyright (C) 2012 Thomas Langer <thomas.langer@lantiq.com>
   7  * Copyright (C) 2012 John Crispin <blogic@openwrt.org>
   8  */
   9
  10 #include <linux/kernel.h>
  11 #include <asm/cacheflush.h>
  12 #include <asm/traps.h>
  13 #include <asm/io.h>
  14
  15 #include <lantiq_soc.h>
  16
  17 #include "../prom.h"
  18
  19 #define SOC_FALCON      "Falcon"
  20 #define SOC_FALCON_D    "Falcon-D"
  21 #define SOC_FALCON_V    "Falcon-V"
  22 #define SOC_FALCON_M    "Falcon-M"
  23
  24 #define COMP_FALCON     "lantiq,falcon"
  25
  26 #define PART_SHIFT      12
  27 #define PART_MASK       0x0FFFF000
  28 #define REV_SHIFT       28
  29 #define REV_MASK        0xF0000000
  30 #define SREV_SHIFT      22
  31 #define SREV_MASK       0x03C00000
  32 #define TYPE_SHIFT      26
  33 #define TYPE_MASK       0x3C000000
  34
  35 /* reset, nmi and ejtag exception vectors */
  36 #define BOOT_REG_BASE   (KSEG1 | 0x1F200000)
  37 #define BOOT_RVEC       (BOOT_REG_BASE | 0x00)
  38 #define BOOT_NVEC       (BOOT_REG_BASE | 0x04)
  39 #define BOOT_EVEC       (BOOT_REG_BASE | 0x08)
  40
  41 void __init ltq_soc_nmi_setup(void)
  42 {
  43         extern void (*nmi_handler)(void);
  44
  45         ltq_w32((unsigned long)&nmi_handler, (void *)BOOT_NVEC);
  46 }
  47
  48 void __init ltq_soc_ejtag_setup(void)
  49 {
  50         extern void (*ejtag_debug_handler)(void);
  51
  52         ltq_w32((unsigned long)&ejtag_debug_handler, (void *)BOOT_EVEC);
  53 }
  54
  55 void __init ltq_soc_detect(struct ltq_soc_info *i)
  56 {
  57         u32 type;
  58         i->partnum = (ltq_r32(FALCON_CHIPID) & PART_MASK) >> PART_SHIFT;
  59         i->rev = (ltq_r32(FALCON_CHIPID) & REV_MASK) >> REV_SHIFT;
  60         i->srev = ((ltq_r32(FALCON_CHIPCONF) & SREV_MASK) >> SREV_SHIFT);
  61         i->compatible = COMP_FALCON;
  62         i->type = SOC_TYPE_FALCON;
  63         sprintf(i->rev_type, "%c%d%d", (i->srev & 0x4) ? ('B') : ('A'),
  64                 i->rev & 0x7, (i->srev & 0x3) + 1);
  65
  66         switch (i->partnum) {
  67         case SOC_ID_FALCON:
  68                 type = (ltq_r32(FALCON_CHIPTYPE) & TYPE_MASK) >> TYPE_SHIFT;
  69                 switch (type) {
  70                 case 0:
  71                         i->name = SOC_FALCON_D;
  72                         break;
  73                 case 1:
  74                         i->name = SOC_FALCON_V;
  75                         break;
  76                 case 2:
  77                         i->name = SOC_FALCON_M;
  78                         break;
  79                 default:
  80                         i->name = SOC_FALCON;
  81                         break;
  82                 }
  83                 break;
  84
  85         default:
  86                 unreachable();
  87                 break;
  88         }
  89
  90         board_nmi_handler_setup = ltq_soc_nmi_setup;
  91         board_ejtag_handler_setup = ltq_soc_ejtag_setup;
  92 }