Blame view

kernel/linux-imx6_3.14.28/arch/arm/mach-shmobile/smp-r8a7791.c 1.83 KB
6b13f685e   김민수   BSP 최초 추가
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
  /*
   * SMP support for r8a7791
   *
   * Copyright (C) 2013 Renesas Solutions Corp.
   * Copyright (C) 2013 Magnus Damm
   *
   * This program is free software; you can redistribute it and/or modify
   * it under the terms of the GNU General Public License as published by
   * the Free Software Foundation; version 2 of the License.
   *
   * This program is distributed in the hope that it will be useful,
   * but WITHOUT ANY WARRANTY; without even the implied warranty of
   * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
   * GNU General Public License for more details.
   */
  #include <linux/kernel.h>
  #include <linux/init.h>
  #include <linux/smp.h>
  #include <linux/io.h>
  #include <asm/smp_plat.h>
  #include <mach/common.h>
  #include <mach/r8a7791.h>
  
  #define RST		0xe6160000
  #define CA15BAR		0x0020
  #define CA15RESCNT	0x0040
  #define RAM		0xe6300000
  
  static void __init r8a7791_smp_prepare_cpus(unsigned int max_cpus)
  {
  	void __iomem *p;
  	u32 bar;
  
  	/* let APMU code install data related to shmobile_boot_vector */
  	shmobile_smp_apmu_prepare_cpus(max_cpus);
  
  	/* RAM for jump stub, because BAR requires 256KB aligned address */
  	p = ioremap_nocache(RAM, shmobile_boot_size);
  	memcpy_toio(p, shmobile_boot_vector, shmobile_boot_size);
  	iounmap(p);
  
  	/* setup reset vectors */
  	p = ioremap_nocache(RST, 0x63);
  	bar = (RAM >> 8) & 0xfffffc00;
  	writel_relaxed(bar, p + CA15BAR);
  	writel_relaxed(bar | 0x10, p + CA15BAR);
  
  	/* enable clocks to all CPUs */
  	writel_relaxed((readl_relaxed(p + CA15RESCNT) & ~0x0f) | 0xa5a50000,
  		       p + CA15RESCNT);
  	iounmap(p);
  }
  
  struct smp_operations r8a7791_smp_ops __initdata = {
  	.smp_prepare_cpus	= r8a7791_smp_prepare_cpus,
  	.smp_boot_secondary	= shmobile_smp_apmu_boot_secondary,
  #ifdef CONFIG_HOTPLUG_CPU
  	.cpu_disable		= shmobile_smp_cpu_disable,
  	.cpu_die		= shmobile_smp_apmu_cpu_die,
  	.cpu_kill		= shmobile_smp_apmu_cpu_kill,
  #endif
  };