Linux 3.17-rc2
[linux/fpc-iii.git] / arch / arc / plat-arcfpga / smp.c
blob92bad9122077dc00b22fc82c6e22be8f5219787b
1 /*
2 * ARC700 Simulation-only Extensions for SMP
4 * Copyright (C) 2004, 2007-2010, 2011-2012 Synopsys, Inc. (www.synopsys.com)
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.
10 * Vineet Gupta - 2012 : split off arch common and plat specific SMP
11 * Rajeshwar Ranga - 2007 : Interrupt Distribution Unit API's
14 #include <linux/smp.h>
15 #include <linux/irq.h>
16 #include <plat/irq.h>
17 #include <plat/smp.h>
19 static char smp_cpuinfo_buf[128];
22 *-------------------------------------------------------------------
23 * Platform specific callbacks expected by arch SMP code
24 *-------------------------------------------------------------------
28 * Master kick starting another CPU
30 static void iss_model_smp_wakeup_cpu(int cpu, unsigned long pc)
32 /* setup the start PC */
33 write_aux_reg(ARC_AUX_XTL_REG_PARAM, pc);
35 /* Trigger WRITE_PC cmd for this cpu */
36 write_aux_reg(ARC_AUX_XTL_REG_CMD,
37 (ARC_XTL_CMD_WRITE_PC | (cpu << 8)));
39 /* Take the cpu out of Halt */
40 write_aux_reg(ARC_AUX_XTL_REG_CMD,
41 (ARC_XTL_CMD_CLEAR_HALT | (cpu << 8)));
45 static inline int get_hw_config_num_irq(void)
47 uint32_t val = read_aux_reg(ARC_REG_VECBASE_BCR);
49 switch (val & 0x03) {
50 case 0:
51 return 16;
52 case 1:
53 return 32;
54 case 2:
55 return 8;
56 default:
57 return 0;
60 return 0;
64 * Any SMP specific init any CPU does when it comes up.
65 * Here we setup the CPU to enable Inter-Processor-Interrupts
66 * Called for each CPU
67 * -Master : init_IRQ()
68 * -Other(s) : start_kernel_secondary()
70 void iss_model_init_smp(unsigned int cpu)
72 /* Check if CPU is configured for more than 16 interrupts */
73 if (NR_IRQS <= 16 || get_hw_config_num_irq() <= 16)
74 panic("[arcfpga] IRQ system can't support IDU IPI\n");
76 idu_disable();
78 /****************************************************************
79 * IDU provides a set of Common IRQs, each of which can be dynamically
80 * attached to (1|many|all) CPUs.
81 * The Common IRQs [0-15] are mapped as CPU pvt [16-31]
83 * Here we use a simple 1:1 mapping:
84 * A CPU 'x' is wired to Common IRQ 'x'.
85 * So an IDU ASSERT on IRQ 'x' will trigger Interupt on CPU 'x', which
86 * makes up for our simple IPI plumbing.
88 * TBD: Have a dedicated multicast IRQ for sending IPIs to all CPUs
89 * w/o having to do one-at-a-time
90 ******************************************************************/
93 * Claim an IRQ which would trigger IPI on this CPU.
94 * In IDU parlance it involves setting up a cpu bitmask for the IRQ
95 * The bitmap here contains only 1 CPU (self).
97 idu_irq_set_tgtcpu(cpu, 0x1 << cpu);
99 /* Set the IRQ destination to use the bitmask above */
100 idu_irq_set_mode(cpu, 7, /* XXX: IDU_IRQ_MOD_TCPU_ALLRECP: ISS bug */
101 IDU_IRQ_MODE_PULSE_TRIG);
103 idu_enable();
105 /* Attach the arch-common IPI ISR to our IDU IRQ */
106 smp_ipi_irq_setup(cpu, IDU_INTERRUPT_0 + cpu);
109 static void iss_model_ipi_send(int cpu)
111 idu_irq_assert(cpu);
114 static void iss_model_ipi_clear(int irq)
116 idu_irq_clear(IDU_INTERRUPT_0 + smp_processor_id());
119 void iss_model_init_early_smp(void)
121 #define IS_AVAIL1(var, str) ((var) ? str : "")
123 struct bcr_mp mp;
125 READ_BCR(ARC_REG_MP_BCR, mp);
127 sprintf(smp_cpuinfo_buf, "Extn [ISS-SMP]: v%d, arch(%d) %s %s %s\n",
128 mp.ver, mp.mp_arch, IS_AVAIL1(mp.scu, "SCU"),
129 IS_AVAIL1(mp.idu, "IDU"), IS_AVAIL1(mp.sdu, "SDU"));
131 plat_smp_ops.info = smp_cpuinfo_buf;
133 plat_smp_ops.cpu_kick = iss_model_smp_wakeup_cpu;
134 plat_smp_ops.ipi_send = iss_model_ipi_send;
135 plat_smp_ops.ipi_clear = iss_model_ipi_clear;
139 *-------------------------------------------------------------------
140 * Low level Platform IPI Providers
141 *-------------------------------------------------------------------
144 /* Set the Mode for the Common IRQ */
145 void idu_irq_set_mode(uint8_t irq, uint8_t dest_mode, uint8_t trig_mode)
147 uint32_t par = IDU_IRQ_MODE_PARAM(dest_mode, trig_mode);
149 IDU_SET_PARAM(par);
150 IDU_SET_COMMAND(irq, IDU_IRQ_WMODE);
153 /* Set the target cpu Bitmask for Common IRQ */
154 void idu_irq_set_tgtcpu(uint8_t irq, uint32_t mask)
156 IDU_SET_PARAM(mask);
157 IDU_SET_COMMAND(irq, IDU_IRQ_WBITMASK);
160 /* Get the Interrupt Acknowledged status for IRQ (as CPU Bitmask) */
161 bool idu_irq_get_ack(uint8_t irq)
163 uint32_t val;
165 IDU_SET_COMMAND(irq, IDU_IRQ_ACK);
166 val = IDU_GET_PARAM();
168 return val & (1 << irq);
172 * Get the Interrupt Pending status for IRQ (as CPU Bitmask)
173 * -Pending means CPU has not yet noticed the IRQ (e.g. disabled)
174 * -After Interrupt has been taken, the IPI expcitily needs to be
175 * cleared, to be acknowledged.
177 bool idu_irq_get_pend(uint8_t irq)
179 uint32_t val;
181 IDU_SET_COMMAND(irq, IDU_IRQ_PEND);
182 val = IDU_GET_PARAM();
184 return val & (1 << irq);