Linux Audio

Check our new training course

Loading...
v3.5.6
 1#include <linux/init.h>
 2
 3#include <asm/x86_init.h>
 4#include <asm/apic.h>
 5#include <asm/xen/hypercall.h>
 6
 7#include <xen/xen.h>
 8#include <xen/interface/physdev.h>
 
 
 
 9
10unsigned int xen_io_apic_read(unsigned apic, unsigned reg)
11{
12	struct physdev_apic apic_op;
13	int ret;
14
15	apic_op.apic_physbase = mpc_ioapic_addr(apic);
16	apic_op.reg = reg;
17	ret = HYPERVISOR_physdev_op(PHYSDEVOP_apic_read, &apic_op);
18	if (!ret)
19		return apic_op.value;
20
21	/* fallback to return an emulated IO_APIC values */
22	if (reg == 0x1)
23		return 0x00170020;
24	else if (reg == 0x0)
25		return apic << 24;
26
27	return 0xfd;
28}
29
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
30void __init xen_init_apic(void)
31{
32	x86_io_apic_ops.read = xen_io_apic_read;
 
 
 
 
 
 
33}
v4.6
  1#include <linux/init.h>
  2
  3#include <asm/x86_init.h>
  4#include <asm/apic.h>
  5#include <asm/xen/hypercall.h>
  6
  7#include <xen/xen.h>
  8#include <xen/interface/physdev.h>
  9#include "xen-ops.h"
 10#include "pmu.h"
 11#include "smp.h"
 12
 13static unsigned int xen_io_apic_read(unsigned apic, unsigned reg)
 14{
 15	struct physdev_apic apic_op;
 16	int ret;
 17
 18	apic_op.apic_physbase = mpc_ioapic_addr(apic);
 19	apic_op.reg = reg;
 20	ret = HYPERVISOR_physdev_op(PHYSDEVOP_apic_read, &apic_op);
 21	if (!ret)
 22		return apic_op.value;
 23
 24	/* fallback to return an emulated IO_APIC values */
 25	if (reg == 0x1)
 26		return 0x00170020;
 27	else if (reg == 0x0)
 28		return apic << 24;
 29
 30	return 0xfd;
 31}
 32
 33static unsigned long xen_set_apic_id(unsigned int x)
 34{
 35	WARN_ON(1);
 36	return x;
 37}
 38
 39static unsigned int xen_get_apic_id(unsigned long x)
 40{
 41	return ((x)>>24) & 0xFFu;
 42}
 43
 44static u32 xen_apic_read(u32 reg)
 45{
 46	struct xen_platform_op op = {
 47		.cmd = XENPF_get_cpuinfo,
 48		.interface_version = XENPF_INTERFACE_VERSION,
 49		.u.pcpu_info.xen_cpuid = 0,
 50	};
 51	int ret = 0;
 52
 53	/* Shouldn't need this as APIC is turned off for PV, and we only
 54	 * get called on the bootup processor. But just in case. */
 55	if (!xen_initial_domain() || smp_processor_id())
 56		return 0;
 57
 58	if (reg == APIC_LVR)
 59		return 0x10;
 60#ifdef CONFIG_X86_32
 61	if (reg == APIC_LDR)
 62		return SET_APIC_LOGICAL_ID(1UL << smp_processor_id());
 63#endif
 64	if (reg != APIC_ID)
 65		return 0;
 66
 67	ret = HYPERVISOR_platform_op(&op);
 68	if (ret)
 69		op.u.pcpu_info.apic_id = BAD_APICID;
 70
 71	return op.u.pcpu_info.apic_id << 24;
 72}
 73
 74static void xen_apic_write(u32 reg, u32 val)
 75{
 76	if (reg == APIC_LVTPC) {
 77		(void)pmu_apic_update(reg);
 78		return;
 79	}
 80
 81	/* Warn to see if there's any stray references */
 82	WARN(1,"register: %x, value: %x\n", reg, val);
 83}
 84
 85static u64 xen_apic_icr_read(void)
 86{
 87	return 0;
 88}
 89
 90static void xen_apic_icr_write(u32 low, u32 id)
 91{
 92	/* Warn to see if there's any stray references */
 93	WARN_ON(1);
 94}
 95
 96static u32 xen_safe_apic_wait_icr_idle(void)
 97{
 98        return 0;
 99}
100
101static int xen_apic_probe_pv(void)
102{
103	if (xen_pv_domain())
104		return 1;
105
106	return 0;
107}
108
109static int xen_madt_oem_check(char *oem_id, char *oem_table_id)
110{
111	return xen_pv_domain();
112}
113
114static int xen_id_always_valid(int apicid)
115{
116	return 1;
117}
118
119static int xen_id_always_registered(void)
120{
121	return 1;
122}
123
124static int xen_phys_pkg_id(int initial_apic_id, int index_msb)
125{
126	return initial_apic_id >> index_msb;
127}
128
129#ifdef CONFIG_X86_32
130static int xen_x86_32_early_logical_apicid(int cpu)
131{
132	/* Match with APIC_LDR read. Otherwise setup_local_APIC complains. */
133	return 1 << cpu;
134}
135#endif
136
137static void xen_noop(void)
138{
139}
140
141static void xen_silent_inquire(int apicid)
142{
143}
144
145static int xen_cpu_present_to_apicid(int cpu)
146{
147	if (cpu_present(cpu))
148		return xen_get_apic_id(xen_apic_read(APIC_ID));
149	else
150		return BAD_APICID;
151}
152
153static struct apic xen_pv_apic = {
154	.name 				= "Xen PV",
155	.probe 				= xen_apic_probe_pv,
156	.acpi_madt_oem_check		= xen_madt_oem_check,
157	.apic_id_valid 			= xen_id_always_valid,
158	.apic_id_registered 		= xen_id_always_registered,
159
160	/* .irq_delivery_mode - used in native_compose_msi_msg only */
161	/* .irq_dest_mode     - used in native_compose_msi_msg only */
162
163	.target_cpus			= default_target_cpus,
164	.disable_esr			= 0,
165	/* .dest_logical      -  default_send_IPI_ use it but we use our own. */
166	.check_apicid_used		= default_check_apicid_used, /* Used on 32-bit */
167
168	.vector_allocation_domain	= flat_vector_allocation_domain,
169	.init_apic_ldr			= xen_noop, /* setup_local_APIC calls it */
170
171	.ioapic_phys_id_map		= default_ioapic_phys_id_map, /* Used on 32-bit */
172	.setup_apic_routing		= NULL,
173	.cpu_present_to_apicid		= xen_cpu_present_to_apicid,
174	.apicid_to_cpu_present		= physid_set_mask_of_physid, /* Used on 32-bit */
175	.check_phys_apicid_present	= default_check_phys_apicid_present, /* smp_sanity_check needs it */
176	.phys_pkg_id			= xen_phys_pkg_id, /* detect_ht */
177
178	.get_apic_id 			= xen_get_apic_id,
179	.set_apic_id 			= xen_set_apic_id, /* Can be NULL on 32-bit. */
180	.apic_id_mask			= 0xFF << 24, /* Used by verify_local_APIC. Match with what xen_get_apic_id does. */
181
182	.cpu_mask_to_apicid_and		= flat_cpu_mask_to_apicid_and,
183
184#ifdef CONFIG_SMP
185	.send_IPI_mask 			= xen_send_IPI_mask,
186	.send_IPI_mask_allbutself 	= xen_send_IPI_mask_allbutself,
187	.send_IPI_allbutself 		= xen_send_IPI_allbutself,
188	.send_IPI_all 			= xen_send_IPI_all,
189	.send_IPI_self 			= xen_send_IPI_self,
190#endif
191	/* .wait_for_init_deassert- used  by AP bootup - smp_callin which we don't use */
192	.inquire_remote_apic		= xen_silent_inquire,
193
194	.read				= xen_apic_read,
195	.write				= xen_apic_write,
196	.eoi_write			= xen_apic_write,
197
198	.icr_read 			= xen_apic_icr_read,
199	.icr_write 			= xen_apic_icr_write,
200	.wait_icr_idle 			= xen_noop,
201	.safe_wait_icr_idle 		= xen_safe_apic_wait_icr_idle,
202
203#ifdef CONFIG_X86_32
204	/* generic_processor_info and setup_local_APIC. */
205	.x86_32_early_logical_apicid	= xen_x86_32_early_logical_apicid,
206#endif
207};
208
209static void __init xen_apic_check(void)
210{
211	if (apic == &xen_pv_apic)
212		return;
213
214	pr_info("Switched APIC routing from %s to %s.\n", apic->name,
215		xen_pv_apic.name);
216	apic = &xen_pv_apic;
217}
218void __init xen_init_apic(void)
219{
220	x86_io_apic_ops.read = xen_io_apic_read;
221	/* On PV guests the APIC CPUID bit is disabled so none of the
222	 * routines end up executing. */
223	if (!xen_initial_domain())
224		apic = &xen_pv_apic;
225
226	x86_platform.apic_post_init = xen_apic_check;
227}
228apic_driver(xen_pv_apic);