arch/arm/mach-s5pv310/cpu.c

   1 /* linux/arch/arm/mach-s5pv310/cpu.c
   2  *
   3  * Copyright (c) 2010 Samsung Electronics Co., Ltd.
   4  *              http://www.samsung.com/
   5  *
   6  * This program is free software; you can redistribute it and/or modify
   7  * it under the terms of the GNU General Public License version 2 as
   8  * published by the Free Software Foundation.
   9 */
  10
  11 #include <linux/sched.h>
  12 #include <linux/sysdev.h>
  13
  14 #include <asm/mach/map.h>
  15 #include <asm/mach/irq.h>
  16
  17 #include <asm/proc-fns.h>
  18
  19 #include <plat/cpu.h>
  20 #include <plat/clock.h>
  21 #include <plat/s5pv310.h>
  22
  23 #include <mach/regs-irq.h>
  24
  25 void __iomem *gic_cpu_base_addr;
  26
  27 extern int combiner_init(unsigned int combiner_nr, void __iomem *base,
  28                          unsigned int irq_start);
  29 extern void combiner_cascade_irq(unsigned int combiner_nr, unsigned int irq);
  30
  31 /* Initial IO mappings */
  32 static struct map_desc s5pv310_iodesc[] __initdata = {
  33         {
  34                 .virtual        = (unsigned long)S5P_VA_COREPERI_BASE,
  35                 .pfn            = __phys_to_pfn(S5PV310_PA_COREPERI),
  36                 .length         = SZ_8K,
  37                 .type           = MT_DEVICE,
  38         }, {
  39                 .virtual        = (unsigned long)S5P_VA_COMBINER_BASE,
  40                 .pfn            = __phys_to_pfn(S5PV310_PA_COMBINER),
  41                 .length         = SZ_4K,
  42                 .type           = MT_DEVICE,
  43         }, {
  44                 .virtual        = (unsigned long)S5P_VA_L2CC,
  45                 .pfn            = __phys_to_pfn(S5PV310_PA_L2CC),
  46                 .length         = SZ_4K,
  47                 .type           = MT_DEVICE,
  48         },
  49 };
  50
  51 static void s5pv310_idle(void)
  52 {
  53         if (!need_resched())
  54                 cpu_do_idle();
  55
  56         local_irq_enable();
  57 }
  58
  59 /* s5pv310_map_io
  60  *
  61  * register the standard cpu IO areas
  62 */
  63 void __init s5pv310_map_io(void)
  64 {
  65         iotable_init(s5pv310_iodesc, ARRAY_SIZE(s5pv310_iodesc));
  66 }
  67
  68 void __init s5pv310_init_clocks(int xtal)
  69 {
  70         printk(KERN_DEBUG "%s: initializing clocks\n", __func__);
  71
  72         s3c24xx_register_baseclocks(xtal);
  73         s5p_register_clocks(xtal);
  74         s5pv310_register_clocks();
  75         s5pv310_setup_clocks();
  76 }
  77
  78 void __init s5pv310_init_irq(void)
  79 {
  80         int irq;
  81
  82         gic_cpu_base_addr = S5P_VA_GIC_CPU;
  83         gic_dist_init(0, S5P_VA_GIC_DIST, IRQ_LOCALTIMER);
  84         gic_cpu_init(0, S5P_VA_GIC_CPU);
  85
  86         for (irq = 0; irq < MAX_COMBINER_NR; irq++) {
  87                 combiner_init(irq, (void __iomem *)S5P_VA_COMBINER(irq),
  88                                 COMBINER_IRQ(irq, 0));
  89                 combiner_cascade_irq(irq, IRQ_SPI(irq));
  90         }
  91
  92         /* The parameters of s5p_init_irq() are for VIC init.
  93          * Theses parameters should be NULL and 0 because S5PV310
  94          * uses GIC instead of VIC.
  95          */
  96         s5p_init_irq(NULL, 0);
  97 }
  98
  99 struct sysdev_class s5pv310_sysclass = {
 100         .name   = "s5pv310-core",
 101 };
 102
 103 static struct sys_device s5pv310_sysdev = {
 104         .cls    = &s5pv310_sysclass,
 105 };
 106
 107 static int __init s5pv310_core_init(void)
 108 {
 109         return sysdev_class_register(&s5pv310_sysclass);
 110 }
 111
 112 core_initcall(s5pv310_core_init);
 113
 114 int __init s5pv310_init(void)
 115 {
 116         printk(KERN_INFO "S5PV310: Initializing architecture\n");
 117
 118         /* set idle function */
 119         pm_idle = s5pv310_idle;
 120
 121         return sysdev_register(&s5pv310_sysdev);
 122 }