1 /*
2 * Copyright (C) 2013 Imagination Technologies
3 * Author: Paul Burton <paul.burton@imgtec.com>
4 *
5 * Based on smp-cmp.c:
6 * Copyright (C) 2007 MIPS Technologies, Inc.
7 * Author: Chris Dearman (chris@mips.com)
8 *
9 * This program is free software; you can redistribute it and/or modify it
10 * under the terms of the GNU General Public License as published by the
11 * Free Software Foundation; either version 2 of the License, or (at your
12 * option) any later version.
13 */
14
15 #include <linux/irqchip/mips-gic.h>
16 #include <linux/printk.h>
17
18 #include <asm/mips-cpc.h>
19 #include <asm/smp-ops.h>
20
gic_send_ipi_single(int cpu,unsigned int action)21 void gic_send_ipi_single(int cpu, unsigned int action)
22 {
23 unsigned long flags;
24 unsigned int intr;
25 unsigned int core = cpu_data[cpu].core;
26
27 pr_debug("CPU%d: %s cpu %d action %u status %08x\n",
28 smp_processor_id(), __func__, cpu, action, read_c0_status());
29
30 local_irq_save(flags);
31
32 switch (action) {
33 case SMP_CALL_FUNCTION:
34 intr = plat_ipi_call_int_xlate(cpu);
35 break;
36
37 case SMP_RESCHEDULE_YOURSELF:
38 intr = plat_ipi_resched_int_xlate(cpu);
39 break;
40
41 default:
42 BUG();
43 }
44
45 gic_send_ipi(intr);
46
47 if (mips_cpc_present() && (core != current_cpu_data.core)) {
48 while (!cpumask_test_cpu(cpu, &cpu_coherent_mask)) {
49 mips_cm_lock_other(core, 0);
50 mips_cpc_lock_other(core);
51 write_cpc_co_cmd(CPC_Cx_CMD_PWRUP);
52 mips_cpc_unlock_other();
53 mips_cm_unlock_other();
54 }
55 }
56
57 local_irq_restore(flags);
58 }
59
gic_send_ipi_mask(const struct cpumask * mask,unsigned int action)60 void gic_send_ipi_mask(const struct cpumask *mask, unsigned int action)
61 {
62 unsigned int i;
63
64 for_each_cpu(i, mask)
65 gic_send_ipi_single(i, action);
66 }
67