| Ralf Baechle | c78cbf4 | 2005-09-30 13:59:37 +0100 | [diff] [blame] | 1 | /* | 
 | 2 |  * Copyright (C) 2005 MIPS Technologies, Inc.  All rights reserved. | 
 | 3 |  * | 
 | 4 |  *  This program is free software; you can distribute it and/or modify it | 
 | 5 |  *  under the terms of the GNU General Public License (Version 2) as | 
 | 6 |  *  published by the Free Software Foundation. | 
 | 7 |  * | 
 | 8 |  *  This program is distributed in the hope it will be useful, but WITHOUT | 
 | 9 |  *  ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or | 
 | 10 |  *  FITNESS FOR A PARTICULAR PURPOSE.  See the GNU General Public License | 
 | 11 |  *  for more details. | 
 | 12 |  * | 
 | 13 |  *  You should have received a copy of the GNU General Public License along | 
 | 14 |  *  with this program; if not, write to the Free Software Foundation, Inc., | 
 | 15 |  *  59 Temple Place - Suite 330, Boston MA 02111-1307, USA. | 
 | 16 |  * | 
 | 17 |  */ | 
 | 18 | /* | 
| Ralf Baechle | 87353d8 | 2007-11-19 12:23:51 +0000 | [diff] [blame] | 19 |  * Simulator Platform-specific hooks for SMTC operation | 
| Ralf Baechle | c78cbf4 | 2005-09-30 13:59:37 +0100 | [diff] [blame] | 20 |  */ | 
| Ralf Baechle | c78cbf4 | 2005-09-30 13:59:37 +0100 | [diff] [blame] | 21 | #include <linux/kernel.h> | 
 | 22 | #include <linux/sched.h> | 
 | 23 | #include <linux/cpumask.h> | 
 | 24 | #include <linux/interrupt.h> | 
| Ralf Baechle | f6e2373 | 2007-07-10 17:32:56 +0100 | [diff] [blame] | 25 | #include <linux/smp.h> | 
 | 26 |  | 
| Ralf Baechle | c78cbf4 | 2005-09-30 13:59:37 +0100 | [diff] [blame] | 27 | #include <asm/atomic.h> | 
 | 28 | #include <asm/cpu.h> | 
 | 29 | #include <asm/processor.h> | 
| Ralf Baechle | 1685f3b | 2011-03-25 18:45:13 +0100 | [diff] [blame] | 30 | #include <asm/smtc.h> | 
| Ralf Baechle | c78cbf4 | 2005-09-30 13:59:37 +0100 | [diff] [blame] | 31 | #include <asm/system.h> | 
| Ralf Baechle | c78cbf4 | 2005-09-30 13:59:37 +0100 | [diff] [blame] | 32 | #include <asm/mmu_context.h> | 
| Ralf Baechle | c78cbf4 | 2005-09-30 13:59:37 +0100 | [diff] [blame] | 33 | #include <asm/smtc_ipi.h> | 
| Ralf Baechle | c78cbf4 | 2005-09-30 13:59:37 +0100 | [diff] [blame] | 34 |  | 
 | 35 | /* VPE/SMP Prototype implements platform interfaces directly */ | 
| Ralf Baechle | c78cbf4 | 2005-09-30 13:59:37 +0100 | [diff] [blame] | 36 |  | 
 | 37 | /* | 
 | 38 |  * Cause the specified action to be performed on a targeted "CPU" | 
 | 39 |  */ | 
 | 40 |  | 
| Ralf Baechle | 87353d8 | 2007-11-19 12:23:51 +0000 | [diff] [blame] | 41 | static void ssmtc_send_ipi_single(int cpu, unsigned int action) | 
| Ralf Baechle | c78cbf4 | 2005-09-30 13:59:37 +0100 | [diff] [blame] | 42 | { | 
| Ralf Baechle | c78cbf4 | 2005-09-30 13:59:37 +0100 | [diff] [blame] | 43 | 	smtc_send_ipi(cpu, LINUX_SMP_IPI, action); | 
| Ralf Baechle | 87353d8 | 2007-11-19 12:23:51 +0000 | [diff] [blame] | 44 | 	/* "CPU" may be TC of same VPE, VPE of same CPU, or different CPU */ | 
| Ralf Baechle | c78cbf4 | 2005-09-30 13:59:37 +0100 | [diff] [blame] | 45 | } | 
 | 46 |  | 
| Rusty Russell | 48a048f | 2009-09-24 09:34:44 -0600 | [diff] [blame] | 47 | static inline void ssmtc_send_ipi_mask(const struct cpumask *mask, | 
 | 48 | 				       unsigned int action) | 
| Ralf Baechle | c78cbf4 | 2005-09-30 13:59:37 +0100 | [diff] [blame] | 49 | { | 
| Ralf Baechle | 87353d8 | 2007-11-19 12:23:51 +0000 | [diff] [blame] | 50 | 	unsigned int i; | 
 | 51 |  | 
| Rusty Russell | 48a048f | 2009-09-24 09:34:44 -0600 | [diff] [blame] | 52 | 	for_each_cpu(i, mask) | 
| Ralf Baechle | 87353d8 | 2007-11-19 12:23:51 +0000 | [diff] [blame] | 53 | 		ssmtc_send_ipi_single(i, action); | 
| Ralf Baechle | c78cbf4 | 2005-09-30 13:59:37 +0100 | [diff] [blame] | 54 | } | 
 | 55 |  | 
 | 56 | /* | 
 | 57 |  * Post-config but pre-boot cleanup entry point | 
 | 58 |  */ | 
| Ralf Baechle | 87353d8 | 2007-11-19 12:23:51 +0000 | [diff] [blame] | 59 | static void __cpuinit ssmtc_init_secondary(void) | 
| Ralf Baechle | c78cbf4 | 2005-09-30 13:59:37 +0100 | [diff] [blame] | 60 | { | 
| Ralf Baechle | c78cbf4 | 2005-09-30 13:59:37 +0100 | [diff] [blame] | 61 | 	smtc_init_secondary(); | 
| Ralf Baechle | c78cbf4 | 2005-09-30 13:59:37 +0100 | [diff] [blame] | 62 | } | 
 | 63 |  | 
| Ralf Baechle | 87353d8 | 2007-11-19 12:23:51 +0000 | [diff] [blame] | 64 | /* | 
 | 65 |  * SMP initialization finalization entry point | 
 | 66 |  */ | 
 | 67 | static void __cpuinit ssmtc_smp_finish(void) | 
| Ralf Baechle | f6e2373 | 2007-07-10 17:32:56 +0100 | [diff] [blame] | 68 | { | 
| Ralf Baechle | 87353d8 | 2007-11-19 12:23:51 +0000 | [diff] [blame] | 69 | 	smtc_smp_finish(); | 
 | 70 | } | 
 | 71 |  | 
 | 72 | /* | 
 | 73 |  * Hook for after all CPUs are online | 
 | 74 |  */ | 
 | 75 | static void ssmtc_cpus_done(void) | 
 | 76 | { | 
 | 77 | } | 
 | 78 |  | 
 | 79 | /* | 
 | 80 |  * Platform "CPU" startup hook | 
 | 81 |  */ | 
 | 82 | static void __cpuinit ssmtc_boot_secondary(int cpu, struct task_struct *idle) | 
 | 83 | { | 
 | 84 | 	smtc_boot_secondary(cpu, idle); | 
 | 85 | } | 
 | 86 |  | 
 | 87 | static void __init ssmtc_smp_setup(void) | 
 | 88 | { | 
| Ralf Baechle | f6e2373 | 2007-07-10 17:32:56 +0100 | [diff] [blame] | 89 | 	if (read_c0_config3() & (1 << 2)) | 
 | 90 | 		mipsmt_build_cpu_map(0); | 
| Ralf Baechle | f6e2373 | 2007-07-10 17:32:56 +0100 | [diff] [blame] | 91 | } | 
 | 92 |  | 
| Ralf Baechle | c78cbf4 | 2005-09-30 13:59:37 +0100 | [diff] [blame] | 93 | /* | 
 | 94 |  * Platform SMP pre-initialization | 
 | 95 |  */ | 
| Ralf Baechle | 87353d8 | 2007-11-19 12:23:51 +0000 | [diff] [blame] | 96 | static void ssmtc_prepare_cpus(unsigned int max_cpus) | 
| Ralf Baechle | c78cbf4 | 2005-09-30 13:59:37 +0100 | [diff] [blame] | 97 | { | 
| Ralf Baechle | c78cbf4 | 2005-09-30 13:59:37 +0100 | [diff] [blame] | 98 | 	/* | 
| Ralf Baechle | a3dddd5 | 2006-03-11 08:18:41 +0000 | [diff] [blame] | 99 | 	 * As noted above, we can assume a single CPU for now | 
| Ralf Baechle | c78cbf4 | 2005-09-30 13:59:37 +0100 | [diff] [blame] | 100 | 	 * but it may be multithreaded. | 
 | 101 | 	 */ | 
 | 102 |  | 
| Ralf Baechle | f6e2373 | 2007-07-10 17:32:56 +0100 | [diff] [blame] | 103 | 	if (read_c0_config3() & (1 << 2)) { | 
 | 104 | 		mipsmt_prepare_cpus(); | 
| Ralf Baechle | c78cbf4 | 2005-09-30 13:59:37 +0100 | [diff] [blame] | 105 | 	} | 
| Ralf Baechle | c78cbf4 | 2005-09-30 13:59:37 +0100 | [diff] [blame] | 106 | } | 
 | 107 |  | 
| Ralf Baechle | 87353d8 | 2007-11-19 12:23:51 +0000 | [diff] [blame] | 108 | struct plat_smp_ops ssmtc_smp_ops = { | 
 | 109 | 	.send_ipi_single	= ssmtc_send_ipi_single, | 
 | 110 | 	.send_ipi_mask		= ssmtc_send_ipi_mask, | 
 | 111 | 	.init_secondary		= ssmtc_init_secondary, | 
 | 112 | 	.smp_finish		= ssmtc_smp_finish, | 
 | 113 | 	.cpus_done		= ssmtc_cpus_done, | 
 | 114 | 	.boot_secondary		= ssmtc_boot_secondary, | 
 | 115 | 	.smp_setup		= ssmtc_smp_setup, | 
 | 116 | 	.prepare_cpus		= ssmtc_prepare_cpus, | 
 | 117 | }; |