2 * Author: Xianghua Xiao <x.xiao@freescale.com>
3 * Zhang Wei <wei.zhang@freescale.com>
5 * Copyright 2006 Freescale Semiconductor Inc.
7 * This program is free software; you can redistribute it and/or modify it
8 * under the terms of the GNU General Public License as published by the
9 * Free Software Foundation; either version 2 of the License, or (at your
10 * option) any later version.
13 #include <linux/stddef.h>
14 #include <linux/kernel.h>
15 #include <linux/init.h>
16 #include <linux/delay.h>
18 #include <asm/pgtable.h>
20 #include <asm/pci-bridge.h>
21 #include <asm-powerpc/mpic.h>
22 #include <asm/mpc86xx.h>
23 #include <asm/cacheflush.h>
25 #include <sysdev/fsl_soc.h>
29 extern void __secondary_start_mpc86xx(void);
30 extern unsigned long __secondary_hold_acknowledge
;
34 smp_86xx_release_core(int nr
)
37 unsigned long vaddr
, pcr
;
39 if (nr
< 0 || nr
>= NR_CPUS
)
45 mcm_vaddr
= ioremap(get_immrbase() + MPC86xx_MCM_OFFSET
,
47 vaddr
= (unsigned long)mcm_vaddr
+ MCM_PORT_CONFIG_OFFSET
;
48 pcr
= in_be32((volatile unsigned *)vaddr
);
49 pcr
|= 1 << (nr
+ 24);
50 out_be32((volatile unsigned *)vaddr
, pcr
);
55 smp_86xx_kick_cpu(int nr
)
57 unsigned int save_vector
;
58 unsigned long target
, flags
;
60 volatile unsigned int *vector
61 = (volatile unsigned int *)(KERNELBASE
+ 0x100);
63 if (nr
< 0 || nr
>= NR_CPUS
)
66 pr_debug("smp_86xx_kick_cpu: kick CPU #%d\n", nr
);
68 local_irq_save(flags
);
71 /* Save reset vector */
72 save_vector
= *vector
;
74 /* Setup fake reset vector to call __secondary_start_mpc86xx. */
75 target
= (unsigned long) __secondary_start_mpc86xx
;
76 create_branch((unsigned long)vector
, target
, BRANCH_SET_LINK
);
79 smp_86xx_release_core(nr
);
81 /* Wait a bit for the CPU to take the exception. */
82 while ((__secondary_hold_acknowledge
!= nr
) && (n
++, n
< 1000))
85 /* Restore the exception vector */
86 *vector
= save_vector
;
87 flush_icache_range((unsigned long) vector
, (unsigned long) vector
+ 4);
89 local_irq_restore(flags
);
91 pr_debug("wait CPU #%d for %d msecs.\n", nr
, n
);
96 smp_86xx_setup_cpu(int cpu_nr
)
98 mpic_setup_this_cpu();
102 struct smp_ops_t smp_86xx_ops
= {
103 .message_pass
= smp_mpic_message_pass
,
104 .probe
= smp_mpic_probe
,
105 .kick_cpu
= smp_86xx_kick_cpu
,
106 .setup_cpu
= smp_86xx_setup_cpu
,
107 .take_timebase
= smp_generic_take_timebase
,
108 .give_timebase
= smp_generic_give_timebase
,
113 mpc86xx_smp_init(void)
115 smp_ops
= &smp_86xx_ops
;