arch/x86/xen/xen-asm_32.S - fp2-dev/kernel/msm - Gitiles

 /*
 	Asm versions of Xen pv-ops, suitable for either direct use or inlining.
 	The inline versions are the same as the direct-use versions, with the
 	pre- and post-amble chopped off.

 	This code is encoded for size rather than absolute efficiency,
 	with a view to being able to inline as much as possible.

 	We only bother with direct forms (ie, vcpu in pda) of the operations
 	here; the indirect forms are better handled in C, since they're
 	generally too large to inline anyway.
  */

 #include <linux/linkage.h>

 #include <asm/asm-offsets.h>
 #include <asm/thread_info.h>
 #include <asm/percpu.h>
 #include <asm/processor-flags.h>
 #include <asm/segment.h>

 #include <xen/interface/xen.h>

 #define RELOC(x, v)	.globl x##_reloc; x##_reloc=v
 #define ENDPATCH(x)	.globl x##_end; x##_end=.

 /* Pseudo-flag used for virtual NMI, which we don't implement yet */
 #define XEN_EFLAGS_NMI	0x80000000

 /*
 	Enable events.  This clears the event mask and tests the pending
 	event status with one and operation.  If there are pending
 	events, then enter the hypervisor to get them handled.
  */
 ENTRY(xen_irq_enable_direct)
 	/* Unmask events */
 	movb $0, PER_CPU_VAR(xen_vcpu_info)+XEN_vcpu_info_mask

 	/* Preempt here doesn't matter because that will deal with
 	   any pending interrupts.  The pending check may end up being
 	   run on the wrong CPU, but that doesn't hurt. */

 	/* Test for pending */
 	testb $0xff, PER_CPU_VAR(xen_vcpu_info)+XEN_vcpu_info_pending
 	jz 1f

 2:	call check_events
 1:
 ENDPATCH(xen_irq_enable_direct)
 	ret
 	ENDPROC(xen_irq_enable_direct)
 	RELOC(xen_irq_enable_direct, 2b+1)


 /*
 	Disabling events is simply a matter of making the event mask
 	non-zero.
  */
 ENTRY(xen_irq_disable_direct)
 	movb $1, PER_CPU_VAR(xen_vcpu_info)+XEN_vcpu_info_mask
 ENDPATCH(xen_irq_disable_direct)
 	ret
 	ENDPROC(xen_irq_disable_direct)
 	RELOC(xen_irq_disable_direct, 0)

 /*
 	(xen_)save_fl is used to get the current interrupt enable status.
 	Callers expect the status to be in X86_EFLAGS_IF, and other bits
 	may be set in the return value.  We take advantage of this by
 	making sure that X86_EFLAGS_IF has the right value (and other bits
 	in that byte are 0), but other bits in the return value are
 	undefined.  We need to toggle the state of the bit, because
 	Xen and x86 use opposite senses (mask vs enable).
  */
 ENTRY(xen_save_fl_direct)
 	testb $0xff, PER_CPU_VAR(xen_vcpu_info)+XEN_vcpu_info_mask
 	setz %ah
 	addb %ah,%ah
 ENDPATCH(xen_save_fl_direct)
 	ret
 	ENDPROC(xen_save_fl_direct)
 	RELOC(xen_save_fl_direct, 0)


 /*
 	In principle the caller should be passing us a value return
 	from xen_save_fl_direct, but for robustness sake we test only
 	the X86_EFLAGS_IF flag rather than the whole byte. After
 	setting the interrupt mask state, it checks for unmasked
 	pending events and enters the hypervisor to get them delivered
 	if so.
  */
 ENTRY(xen_restore_fl_direct)
 	testb $X86_EFLAGS_IF>>8, %ah
 	setz PER_CPU_VAR(xen_vcpu_info)+XEN_vcpu_info_mask
 	/* Preempt here doesn't matter because that will deal with
 	   any pending interrupts.  The pending check may end up being
 	   run on the wrong CPU, but that doesn't hurt. */

 	/* check for unmasked and pending */
 	cmpw $0x0001, PER_CPU_VAR(xen_vcpu_info)+XEN_vcpu_info_pending
 	jz 1f
 2:	call check_events
 1:
 ENDPATCH(xen_restore_fl_direct)
 	ret
 	ENDPROC(xen_restore_fl_direct)
 	RELOC(xen_restore_fl_direct, 2b+1)

 /*
 	We can't use sysexit directly, because we're not running in ring0.
 	But we can easily fake it up using iret.  Assuming xen_sysexit
 	is jumped to with a standard stack frame, we can just strip it
 	back to a standard iret frame and use iret.
  */
 ENTRY(xen_sysexit)
 	movl PT_EAX(%esp), %eax			/* Shouldn't be necessary? */
 	orl $X86_EFLAGS_IF, PT_EFLAGS(%esp)
 	lea PT_EIP(%esp), %esp

 	jmp xen_iret
 ENDPROC(xen_sysexit)

 /*
 	This is run where a normal iret would be run, with the same stack setup:
 	      8: eflags
 	      4: cs
 	esp-> 0: eip

 	This attempts to make sure that any pending events are dealt
 	with on return to usermode, but there is a small window in
 	which an event can happen just before entering usermode.  If
 	the nested interrupt ends up setting one of the TIF_WORK_MASK
 	pending work flags, they will not be tested again before
 	returning to usermode. This means that a process can end up
 	with pending work, which will be unprocessed until the process
 	enters and leaves the kernel again, which could be an
 	unbounded amount of time.  This means that a pending signal or
 	reschedule event could be indefinitely delayed.

 	The fix is to notice a nested interrupt in the critical
 	window, and if one occurs, then fold the nested interrupt into
 	the current interrupt stack frame, and re-process it
 	iteratively rather than recursively.  This means that it will
 	exit via the normal path, and all pending work will be dealt
 	with appropriately.

 	Because the nested interrupt handler needs to deal with the
 	current stack state in whatever form its in, we keep things
 	simple by only using a single register which is pushed/popped
 	on the stack.
  */
 ENTRY(xen_iret)
 	/* test eflags for special cases */
 	testl $(X86_EFLAGS_VM | XEN_EFLAGS_NMI), 8(%esp)
 	jnz hyper_iret

 	push %eax
 	ESP_OFFSET=4	# bytes pushed onto stack

 	/* Store vcpu_info pointer for easy access.  Do it this
 	   way to avoid having to reload %fs */
 #ifdef CONFIG_SMP
 	GET_THREAD_INFO(%eax)
 	movl TI_cpu(%eax),%eax
 	movl __per_cpu_offset(,%eax,4),%eax
 	mov per_cpu__xen_vcpu(%eax),%eax
 #else
 	movl per_cpu__xen_vcpu, %eax
 #endif

 	/* check IF state we're restoring */
 	testb $X86_EFLAGS_IF>>8, 8+1+ESP_OFFSET(%esp)

 	/* Maybe enable events.  Once this happens we could get a
 	   recursive event, so the critical region starts immediately
 	   afterwards.  However, if that happens we don't end up
 	   resuming the code, so we don't have to be worried about
 	   being preempted to another CPU. */
 	setz XEN_vcpu_info_mask(%eax)
 xen_iret_start_crit:

 	/* check for unmasked and pending */
 	cmpw $0x0001, XEN_vcpu_info_pending(%eax)

 	/* If there's something pending, mask events again so we
 	   can jump back into xen_hypervisor_callback */
 	sete XEN_vcpu_info_mask(%eax)

 	popl %eax

 	/* From this point on the registers are restored and the stack
 	   updated, so we don't need to worry about it if we're preempted */
 iret_restore_end:

 	/* Jump to hypervisor_callback after fixing up the stack.
 	   Events are masked, so jumping out of the critical
 	   region is OK. */
 	je xen_hypervisor_callback

 1:	iret
 xen_iret_end_crit:
 .section __ex_table,"a"
 	.align 4
 	.long 1b,iret_exc
 .previous

 hyper_iret:
 	/* put this out of line since its very rarely used */
 	jmp hypercall_page + __HYPERVISOR_iret * 32

 	.globl xen_iret_start_crit, xen_iret_end_crit

 /*
    This is called by xen_hypervisor_callback in entry.S when it sees
    that the EIP at the time of interrupt was between xen_iret_start_crit
    and xen_iret_end_crit.  We're passed the EIP in %eax so we can do
    a more refined determination of what to do.

    The stack format at this point is:
 	----------------
 	 ss		: (ss/esp may be present if we came from usermode)
 	 esp		:
 	 eflags		}  outer exception info
 	 cs		}
 	 eip		}
 	---------------- <- edi (copy dest)
 	 eax		:  outer eax if it hasn't been restored
 	----------------
 	 eflags		}  nested exception info
 	 cs		}   (no ss/esp because we're nested
 	 eip		}    from the same ring)
 	 orig_eax	}<- esi (copy src)
 	 - - - - - - - -
 	 fs		}
 	 es		}
 	 ds		}  SAVE_ALL state
 	 eax		}
 	  :		:
 	 ebx		}<- esp
 	----------------

    In order to deliver the nested exception properly, we need to shift
    everything from the return addr up to the error code so it
    sits just under the outer exception info.  This means that when we
    handle the exception, we do it in the context of the outer exception
    rather than starting a new one.

    The only caveat is that if the outer eax hasn't been
    restored yet (ie, it's still on stack), we need to insert
    its value into the SAVE_ALL state before going on, since
    it's usermode state which we eventually need to restore.
  */
 ENTRY(xen_iret_crit_fixup)
 	/*
 	   Paranoia: Make sure we're really coming from kernel space.
 	   One could imagine a case where userspace jumps into the
 	   critical range address, but just before the CPU delivers a GP,
 	   it decides to deliver an interrupt instead.  Unlikely?
 	   Definitely.  Easy to avoid?  Yes.  The Intel documents
 	   explicitly say that the reported EIP for a bad jump is the
 	   jump instruction itself, not the destination, but some virtual
 	   environments get this wrong.
 	 */
 	movl PT_CS(%esp), %ecx
 	andl $SEGMENT_RPL_MASK, %ecx
 	cmpl $USER_RPL, %ecx
 	je 2f

 	lea PT_ORIG_EAX(%esp), %esi
 	lea PT_EFLAGS(%esp), %edi

 	/* If eip is before iret_restore_end then stack
 	   hasn't been restored yet. */
 	cmp $iret_restore_end, %eax
 	jae 1f

 	movl 0+4(%edi),%eax		/* copy EAX (just above top of frame) */
 	movl %eax, PT_EAX(%esp)

 	lea ESP_OFFSET(%edi),%edi	/* move dest up over saved regs */

 	/* set up the copy */
 1:	std
 	mov $PT_EIP / 4, %ecx		/* saved regs up to orig_eax */
 	rep movsl
 	cld

 	lea 4(%edi),%esp		/* point esp to new frame */
 2:	jmp xen_do_upcall


 /*
 	Force an event check by making a hypercall,
 	but preserve regs before making the call.
  */
 check_events:
 	push %eax
 	push %ecx
 	push %edx
 	call xen_force_evtchn_callback
 	pop %edx
 	pop %ecx
 	pop %eax
 	ret
	/*
	Asm versions of Xen pv-ops, suitable for either direct use or inlining.
	The inline versions are the same as the direct-use versions, with the
	pre- and post-amble chopped off.

	This code is encoded for size rather than absolute efficiency,
	with a view to being able to inline as much as possible.

	We only bother with direct forms (ie, vcpu in pda) of the operations
	here; the indirect forms are better handled in C, since they're
	generally too large to inline anyway.
	*/

	#include <linux/linkage.h>

	#include <asm/asm-offsets.h>
	#include <asm/thread_info.h>
	#include <asm/percpu.h>
	#include <asm/processor-flags.h>
	#include <asm/segment.h>

	#include <xen/interface/xen.h>

	#define RELOC(x, v) .globl x##_reloc; x##_reloc=v
	#define ENDPATCH(x) .globl x##_end; x##_end=.

	/* Pseudo-flag used for virtual NMI, which we don't implement yet */
	#define XEN_EFLAGS_NMI 0x80000000

	/*
	Enable events. This clears the event mask and tests the pending
	event status with one and operation. If there are pending
	events, then enter the hypervisor to get them handled.
	*/
	ENTRY(xen_irq_enable_direct)
	/* Unmask events */
	movb $0, PER_CPU_VAR(xen_vcpu_info)+XEN_vcpu_info_mask

	/* Preempt here doesn't matter because that will deal with
	any pending interrupts. The pending check may end up being
	run on the wrong CPU, but that doesn't hurt. */

	/* Test for pending */
	testb $0xff, PER_CPU_VAR(xen_vcpu_info)+XEN_vcpu_info_pending
	jz 1f

	2: call check_events
	1:
	ENDPATCH(xen_irq_enable_direct)
	ret
	ENDPROC(xen_irq_enable_direct)
	RELOC(xen_irq_enable_direct, 2b+1)


	/*
	Disabling events is simply a matter of making the event mask
	non-zero.
	*/
	ENTRY(xen_irq_disable_direct)
	movb $1, PER_CPU_VAR(xen_vcpu_info)+XEN_vcpu_info_mask
	ENDPATCH(xen_irq_disable_direct)
	ret
	ENDPROC(xen_irq_disable_direct)
	RELOC(xen_irq_disable_direct, 0)

	/*
	(xen_)save_fl is used to get the current interrupt enable status.
	Callers expect the status to be in X86_EFLAGS_IF, and other bits
	may be set in the return value. We take advantage of this by
	making sure that X86_EFLAGS_IF has the right value (and other bits
	in that byte are 0), but other bits in the return value are
	undefined. We need to toggle the state of the bit, because
	Xen and x86 use opposite senses (mask vs enable).
	*/
	ENTRY(xen_save_fl_direct)
	testb $0xff, PER_CPU_VAR(xen_vcpu_info)+XEN_vcpu_info_mask
	setz %ah
	addb %ah,%ah
	ENDPATCH(xen_save_fl_direct)
	ret
	ENDPROC(xen_save_fl_direct)
	RELOC(xen_save_fl_direct, 0)


	/*
	In principle the caller should be passing us a value return
	from xen_save_fl_direct, but for robustness sake we test only
	the X86_EFLAGS_IF flag rather than the whole byte. After
	setting the interrupt mask state, it checks for unmasked
	pending events and enters the hypervisor to get them delivered
	if so.
	*/
	ENTRY(xen_restore_fl_direct)
	testb $X86_EFLAGS_IF>>8, %ah
	setz PER_CPU_VAR(xen_vcpu_info)+XEN_vcpu_info_mask
	/* Preempt here doesn't matter because that will deal with
	any pending interrupts. The pending check may end up being
	run on the wrong CPU, but that doesn't hurt. */

	/* check for unmasked and pending */
	cmpw $0x0001, PER_CPU_VAR(xen_vcpu_info)+XEN_vcpu_info_pending
	jz 1f
	2: call check_events
	1:
	ENDPATCH(xen_restore_fl_direct)
	ret
	ENDPROC(xen_restore_fl_direct)
	RELOC(xen_restore_fl_direct, 2b+1)

	/*
	We can't use sysexit directly, because we're not running in ring0.
	But we can easily fake it up using iret. Assuming xen_sysexit
	is jumped to with a standard stack frame, we can just strip it
	back to a standard iret frame and use iret.
	*/
	ENTRY(xen_sysexit)
	movl PT_EAX(%esp), %eax /* Shouldn't be necessary? */
	orl $X86_EFLAGS_IF, PT_EFLAGS(%esp)
	lea PT_EIP(%esp), %esp

	jmp xen_iret
	ENDPROC(xen_sysexit)

	/*
	This is run where a normal iret would be run, with the same stack setup:
	8: eflags
	4: cs
	esp-> 0: eip

	This attempts to make sure that any pending events are dealt
	with on return to usermode, but there is a small window in
	which an event can happen just before entering usermode. If
	the nested interrupt ends up setting one of the TIF_WORK_MASK
	pending work flags, they will not be tested again before
	returning to usermode. This means that a process can end up
	with pending work, which will be unprocessed until the process
	enters and leaves the kernel again, which could be an
	unbounded amount of time. This means that a pending signal or
	reschedule event could be indefinitely delayed.

	The fix is to notice a nested interrupt in the critical
	window, and if one occurs, then fold the nested interrupt into
	the current interrupt stack frame, and re-process it
	iteratively rather than recursively. This means that it will
	exit via the normal path, and all pending work will be dealt
	with appropriately.

	Because the nested interrupt handler needs to deal with the
	current stack state in whatever form its in, we keep things
	simple by only using a single register which is pushed/popped
	on the stack.
	*/
	ENTRY(xen_iret)
	/* test eflags for special cases */
	testl $(X86_EFLAGS_VM \| XEN_EFLAGS_NMI), 8(%esp)
	jnz hyper_iret

	push %eax
	ESP_OFFSET=4 # bytes pushed onto stack

	/* Store vcpu_info pointer for easy access. Do it this
	way to avoid having to reload %fs */
	#ifdef CONFIG_SMP
	GET_THREAD_INFO(%eax)
	movl TI_cpu(%eax),%eax
	movl __per_cpu_offset(,%eax,4),%eax
	mov per_cpu__xen_vcpu(%eax),%eax
	#else
	movl per_cpu__xen_vcpu, %eax
	#endif

	/* check IF state we're restoring */
	testb $X86_EFLAGS_IF>>8, 8+1+ESP_OFFSET(%esp)

	/* Maybe enable events. Once this happens we could get a
	recursive event, so the critical region starts immediately
	afterwards. However, if that happens we don't end up
	resuming the code, so we don't have to be worried about
	being preempted to another CPU. */
	setz XEN_vcpu_info_mask(%eax)
	xen_iret_start_crit:

	/* check for unmasked and pending */
	cmpw $0x0001, XEN_vcpu_info_pending(%eax)

	/* If there's something pending, mask events again so we
	can jump back into xen_hypervisor_callback */
	sete XEN_vcpu_info_mask(%eax)

	popl %eax

	/* From this point on the registers are restored and the stack
	updated, so we don't need to worry about it if we're preempted */
	iret_restore_end:

	/* Jump to hypervisor_callback after fixing up the stack.
	Events are masked, so jumping out of the critical
	region is OK. */
	je xen_hypervisor_callback

	1: iret
	xen_iret_end_crit:
	.section __ex_table,"a"
	.align 4
	.long 1b,iret_exc
	.previous

	hyper_iret:
	/* put this out of line since its very rarely used */
	jmp hypercall_page + __HYPERVISOR_iret * 32

	.globl xen_iret_start_crit, xen_iret_end_crit

	/*
	This is called by xen_hypervisor_callback in entry.S when it sees
	that the EIP at the time of interrupt was between xen_iret_start_crit
	and xen_iret_end_crit. We're passed the EIP in %eax so we can do
	a more refined determination of what to do.

	The stack format at this point is:
	----------------
	ss : (ss/esp may be present if we came from usermode)
	esp :
	eflags } outer exception info
	cs }
	eip }
	---------------- <- edi (copy dest)
	eax : outer eax if it hasn't been restored
	----------------
	eflags } nested exception info
	cs } (no ss/esp because we're nested
	eip } from the same ring)
	orig_eax }<- esi (copy src)
	- - - - - - - -
	fs }
	es }
	ds } SAVE_ALL state
	eax }
	: :
	ebx }<- esp
	----------------

	In order to deliver the nested exception properly, we need to shift
	everything from the return addr up to the error code so it
	sits just under the outer exception info. This means that when we
	handle the exception, we do it in the context of the outer exception
	rather than starting a new one.

	The only caveat is that if the outer eax hasn't been
	restored yet (ie, it's still on stack), we need to insert
	its value into the SAVE_ALL state before going on, since
	it's usermode state which we eventually need to restore.
	*/
	ENTRY(xen_iret_crit_fixup)
	/*
	Paranoia: Make sure we're really coming from kernel space.
	One could imagine a case where userspace jumps into the
	critical range address, but just before the CPU delivers a GP,
	it decides to deliver an interrupt instead. Unlikely?
	Definitely. Easy to avoid? Yes. The Intel documents
	explicitly say that the reported EIP for a bad jump is the
	jump instruction itself, not the destination, but some virtual
	environments get this wrong.
	*/
	movl PT_CS(%esp), %ecx
	andl $SEGMENT_RPL_MASK, %ecx
	cmpl $USER_RPL, %ecx
	je 2f

	lea PT_ORIG_EAX(%esp), %esi
	lea PT_EFLAGS(%esp), %edi

	/* If eip is before iret_restore_end then stack
	hasn't been restored yet. */
	cmp $iret_restore_end, %eax
	jae 1f

	movl 0+4(%edi),%eax /* copy EAX (just above top of frame) */
	movl %eax, PT_EAX(%esp)

	lea ESP_OFFSET(%edi),%edi /* move dest up over saved regs */

	/* set up the copy */
	1: std
	mov $PT_EIP / 4, %ecx /* saved regs up to orig_eax */
	rep movsl
	cld

	lea 4(%edi),%esp /* point esp to new frame */
	2: jmp xen_do_upcall


	/*
	Force an event check by making a hypercall,
	but preserve regs before making the call.
	*/
	check_events:
	push %eax
	push %ecx
	push %edx
	call xen_force_evtchn_callback
	pop %edx
	pop %ecx
	pop %eax
	ret