Jeremy Fitzhardinge | 6487673 | 2007-07-17 18:37:07 -0700 | [diff] [blame] | 1 | /* |
| 2 | Asm versions of Xen pv-ops, suitable for either direct use or inlining. |
| 3 | The inline versions are the same as the direct-use versions, with the |
| 4 | pre- and post-amble chopped off. |
| 5 | |
| 6 | This code is encoded for size rather than absolute efficiency, |
| 7 | with a view to being able to inline as much as possible. |
| 8 | |
| 9 | We only bother with direct forms (ie, vcpu in pda) of the operations |
| 10 | here; the indirect forms are better handled in C, since they're |
| 11 | generally too large to inline anyway. |
| 12 | */ |
| 13 | |
| 14 | #include <linux/linkage.h> |
Jeremy Fitzhardinge | 9ec2b80 | 2007-07-17 18:37:07 -0700 | [diff] [blame] | 15 | |
Jeremy Fitzhardinge | 6487673 | 2007-07-17 18:37:07 -0700 | [diff] [blame] | 16 | #include <asm/asm-offsets.h> |
| 17 | #include <asm/thread_info.h> |
| 18 | #include <asm/percpu.h> |
Jeremy Fitzhardinge | 6487673 | 2007-07-17 18:37:07 -0700 | [diff] [blame] | 19 | #include <asm/processor-flags.h> |
Jeremy Fitzhardinge | 9ec2b80 | 2007-07-17 18:37:07 -0700 | [diff] [blame] | 20 | #include <asm/segment.h> |
| 21 | |
| 22 | #include <xen/interface/xen.h> |
Jeremy Fitzhardinge | 6487673 | 2007-07-17 18:37:07 -0700 | [diff] [blame] | 23 | |
| 24 | #define RELOC(x, v) .globl x##_reloc; x##_reloc=v |
| 25 | #define ENDPATCH(x) .globl x##_end; x##_end=. |
| 26 | |
Jeremy Fitzhardinge | 9ec2b80 | 2007-07-17 18:37:07 -0700 | [diff] [blame] | 27 | /* Pseudo-flag used for virtual NMI, which we don't implement yet */ |
| 28 | #define XEN_EFLAGS_NMI 0x80000000 |
| 29 | |
Jeremy Fitzhardinge | 6487673 | 2007-07-17 18:37:07 -0700 | [diff] [blame] | 30 | /* |
| 31 | Enable events. This clears the event mask and tests the pending |
| 32 | event status with one and operation. If there are pending |
| 33 | events, then enter the hypervisor to get them handled. |
| 34 | */ |
| 35 | ENTRY(xen_irq_enable_direct) |
Jeremy Fitzhardinge | 04c44a0 | 2008-03-17 16:36:52 -0700 | [diff] [blame] | 36 | /* Unmask events */ |
| 37 | movb $0, PER_CPU_VAR(xen_vcpu_info)+XEN_vcpu_info_mask |
| 38 | |
Jeremy Fitzhardinge | 6487673 | 2007-07-17 18:37:07 -0700 | [diff] [blame] | 39 | /* Preempt here doesn't matter because that will deal with |
| 40 | any pending interrupts. The pending check may end up being |
| 41 | run on the wrong CPU, but that doesn't hurt. */ |
Jeremy Fitzhardinge | 04c44a0 | 2008-03-17 16:36:52 -0700 | [diff] [blame] | 42 | |
| 43 | /* Test for pending */ |
| 44 | testb $0xff, PER_CPU_VAR(xen_vcpu_info)+XEN_vcpu_info_pending |
Jeremy Fitzhardinge | 6487673 | 2007-07-17 18:37:07 -0700 | [diff] [blame] | 45 | jz 1f |
Jeremy Fitzhardinge | 04c44a0 | 2008-03-17 16:36:52 -0700 | [diff] [blame] | 46 | |
Jeremy Fitzhardinge | 6487673 | 2007-07-17 18:37:07 -0700 | [diff] [blame] | 47 | 2: call check_events |
| 48 | 1: |
| 49 | ENDPATCH(xen_irq_enable_direct) |
| 50 | ret |
| 51 | ENDPROC(xen_irq_enable_direct) |
| 52 | RELOC(xen_irq_enable_direct, 2b+1) |
| 53 | |
| 54 | |
| 55 | /* |
| 56 | Disabling events is simply a matter of making the event mask |
| 57 | non-zero. |
| 58 | */ |
| 59 | ENTRY(xen_irq_disable_direct) |
| 60 | movb $1, PER_CPU_VAR(xen_vcpu_info)+XEN_vcpu_info_mask |
| 61 | ENDPATCH(xen_irq_disable_direct) |
| 62 | ret |
| 63 | ENDPROC(xen_irq_disable_direct) |
| 64 | RELOC(xen_irq_disable_direct, 0) |
| 65 | |
| 66 | /* |
| 67 | (xen_)save_fl is used to get the current interrupt enable status. |
| 68 | Callers expect the status to be in X86_EFLAGS_IF, and other bits |
| 69 | may be set in the return value. We take advantage of this by |
| 70 | making sure that X86_EFLAGS_IF has the right value (and other bits |
| 71 | in that byte are 0), but other bits in the return value are |
| 72 | undefined. We need to toggle the state of the bit, because |
| 73 | Xen and x86 use opposite senses (mask vs enable). |
| 74 | */ |
| 75 | ENTRY(xen_save_fl_direct) |
| 76 | testb $0xff, PER_CPU_VAR(xen_vcpu_info)+XEN_vcpu_info_mask |
| 77 | setz %ah |
| 78 | addb %ah,%ah |
| 79 | ENDPATCH(xen_save_fl_direct) |
| 80 | ret |
| 81 | ENDPROC(xen_save_fl_direct) |
| 82 | RELOC(xen_save_fl_direct, 0) |
| 83 | |
| 84 | |
| 85 | /* |
| 86 | In principle the caller should be passing us a value return |
| 87 | from xen_save_fl_direct, but for robustness sake we test only |
| 88 | the X86_EFLAGS_IF flag rather than the whole byte. After |
| 89 | setting the interrupt mask state, it checks for unmasked |
| 90 | pending events and enters the hypervisor to get them delivered |
| 91 | if so. |
| 92 | */ |
| 93 | ENTRY(xen_restore_fl_direct) |
| 94 | testb $X86_EFLAGS_IF>>8, %ah |
Jeremy Fitzhardinge | 9ec2b80 | 2007-07-17 18:37:07 -0700 | [diff] [blame] | 95 | setz PER_CPU_VAR(xen_vcpu_info)+XEN_vcpu_info_mask |
Jeremy Fitzhardinge | 6487673 | 2007-07-17 18:37:07 -0700 | [diff] [blame] | 96 | /* Preempt here doesn't matter because that will deal with |
| 97 | any pending interrupts. The pending check may end up being |
| 98 | run on the wrong CPU, but that doesn't hurt. */ |
| 99 | |
Jeremy Fitzhardinge | 9ec2b80 | 2007-07-17 18:37:07 -0700 | [diff] [blame] | 100 | /* check for unmasked and pending */ |
Jeremy Fitzhardinge | 6487673 | 2007-07-17 18:37:07 -0700 | [diff] [blame] | 101 | cmpw $0x0001, PER_CPU_VAR(xen_vcpu_info)+XEN_vcpu_info_pending |
| 102 | jz 1f |
| 103 | 2: call check_events |
| 104 | 1: |
| 105 | ENDPATCH(xen_restore_fl_direct) |
| 106 | ret |
| 107 | ENDPROC(xen_restore_fl_direct) |
| 108 | RELOC(xen_restore_fl_direct, 2b+1) |
| 109 | |
Jeremy Fitzhardinge | 9ec2b80 | 2007-07-17 18:37:07 -0700 | [diff] [blame] | 110 | /* |
Jeremy Fitzhardinge | b77797f | 2008-04-02 10:54:11 -0700 | [diff] [blame] | 111 | We can't use sysexit directly, because we're not running in ring0. |
| 112 | But we can easily fake it up using iret. Assuming xen_sysexit |
| 113 | is jumped to with a standard stack frame, we can just strip it |
| 114 | back to a standard iret frame and use iret. |
| 115 | */ |
| 116 | ENTRY(xen_sysexit) |
| 117 | movl PT_EAX(%esp), %eax /* Shouldn't be necessary? */ |
| 118 | orl $X86_EFLAGS_IF, PT_EFLAGS(%esp) |
| 119 | lea PT_EIP(%esp), %esp |
| 120 | |
| 121 | jmp xen_iret |
| 122 | ENDPROC(xen_sysexit) |
| 123 | |
| 124 | /* |
Jeremy Fitzhardinge | 9ec2b80 | 2007-07-17 18:37:07 -0700 | [diff] [blame] | 125 | This is run where a normal iret would be run, with the same stack setup: |
| 126 | 8: eflags |
| 127 | 4: cs |
| 128 | esp-> 0: eip |
| 129 | |
| 130 | This attempts to make sure that any pending events are dealt |
| 131 | with on return to usermode, but there is a small window in |
| 132 | which an event can happen just before entering usermode. If |
| 133 | the nested interrupt ends up setting one of the TIF_WORK_MASK |
| 134 | pending work flags, they will not be tested again before |
| 135 | returning to usermode. This means that a process can end up |
| 136 | with pending work, which will be unprocessed until the process |
| 137 | enters and leaves the kernel again, which could be an |
| 138 | unbounded amount of time. This means that a pending signal or |
| 139 | reschedule event could be indefinitely delayed. |
| 140 | |
| 141 | The fix is to notice a nested interrupt in the critical |
| 142 | window, and if one occurs, then fold the nested interrupt into |
| 143 | the current interrupt stack frame, and re-process it |
| 144 | iteratively rather than recursively. This means that it will |
| 145 | exit via the normal path, and all pending work will be dealt |
| 146 | with appropriately. |
| 147 | |
| 148 | Because the nested interrupt handler needs to deal with the |
| 149 | current stack state in whatever form its in, we keep things |
| 150 | simple by only using a single register which is pushed/popped |
| 151 | on the stack. |
Jeremy Fitzhardinge | 9ec2b80 | 2007-07-17 18:37:07 -0700 | [diff] [blame] | 152 | */ |
Jeremy Fitzhardinge | 81e103f | 2008-04-17 17:40:51 +0200 | [diff] [blame] | 153 | ENTRY(xen_iret) |
Jeremy Fitzhardinge | 9ec2b80 | 2007-07-17 18:37:07 -0700 | [diff] [blame] | 154 | /* test eflags for special cases */ |
| 155 | testl $(X86_EFLAGS_VM | XEN_EFLAGS_NMI), 8(%esp) |
| 156 | jnz hyper_iret |
| 157 | |
| 158 | push %eax |
| 159 | ESP_OFFSET=4 # bytes pushed onto stack |
| 160 | |
| 161 | /* Store vcpu_info pointer for easy access. Do it this |
| 162 | way to avoid having to reload %fs */ |
| 163 | #ifdef CONFIG_SMP |
| 164 | GET_THREAD_INFO(%eax) |
| 165 | movl TI_cpu(%eax),%eax |
| 166 | movl __per_cpu_offset(,%eax,4),%eax |
Jeremy Fitzhardinge | 81e103f | 2008-04-17 17:40:51 +0200 | [diff] [blame] | 167 | mov per_cpu__xen_vcpu(%eax),%eax |
Jeremy Fitzhardinge | 9ec2b80 | 2007-07-17 18:37:07 -0700 | [diff] [blame] | 168 | #else |
Jeremy Fitzhardinge | 81e103f | 2008-04-17 17:40:51 +0200 | [diff] [blame] | 169 | movl per_cpu__xen_vcpu, %eax |
Jeremy Fitzhardinge | 9ec2b80 | 2007-07-17 18:37:07 -0700 | [diff] [blame] | 170 | #endif |
| 171 | |
| 172 | /* check IF state we're restoring */ |
| 173 | testb $X86_EFLAGS_IF>>8, 8+1+ESP_OFFSET(%esp) |
| 174 | |
| 175 | /* Maybe enable events. Once this happens we could get a |
| 176 | recursive event, so the critical region starts immediately |
| 177 | afterwards. However, if that happens we don't end up |
| 178 | resuming the code, so we don't have to be worried about |
| 179 | being preempted to another CPU. */ |
| 180 | setz XEN_vcpu_info_mask(%eax) |
| 181 | xen_iret_start_crit: |
| 182 | |
| 183 | /* check for unmasked and pending */ |
| 184 | cmpw $0x0001, XEN_vcpu_info_pending(%eax) |
| 185 | |
| 186 | /* If there's something pending, mask events again so we |
| 187 | can jump back into xen_hypervisor_callback */ |
| 188 | sete XEN_vcpu_info_mask(%eax) |
| 189 | |
| 190 | popl %eax |
| 191 | |
| 192 | /* From this point on the registers are restored and the stack |
| 193 | updated, so we don't need to worry about it if we're preempted */ |
| 194 | iret_restore_end: |
| 195 | |
| 196 | /* Jump to hypervisor_callback after fixing up the stack. |
| 197 | Events are masked, so jumping out of the critical |
| 198 | region is OK. */ |
| 199 | je xen_hypervisor_callback |
| 200 | |
Jeremy Fitzhardinge | 90e9f53 | 2008-03-17 16:37:12 -0700 | [diff] [blame] | 201 | 1: iret |
Jeremy Fitzhardinge | 9ec2b80 | 2007-07-17 18:37:07 -0700 | [diff] [blame] | 202 | xen_iret_end_crit: |
Jeremy Fitzhardinge | 90e9f53 | 2008-03-17 16:37:12 -0700 | [diff] [blame] | 203 | .section __ex_table,"a" |
| 204 | .align 4 |
| 205 | .long 1b,iret_exc |
| 206 | .previous |
Jeremy Fitzhardinge | 9ec2b80 | 2007-07-17 18:37:07 -0700 | [diff] [blame] | 207 | |
| 208 | hyper_iret: |
| 209 | /* put this out of line since its very rarely used */ |
| 210 | jmp hypercall_page + __HYPERVISOR_iret * 32 |
| 211 | |
| 212 | .globl xen_iret_start_crit, xen_iret_end_crit |
| 213 | |
| 214 | /* |
| 215 | This is called by xen_hypervisor_callback in entry.S when it sees |
| 216 | that the EIP at the time of interrupt was between xen_iret_start_crit |
| 217 | and xen_iret_end_crit. We're passed the EIP in %eax so we can do |
| 218 | a more refined determination of what to do. |
| 219 | |
| 220 | The stack format at this point is: |
| 221 | ---------------- |
| 222 | ss : (ss/esp may be present if we came from usermode) |
| 223 | esp : |
| 224 | eflags } outer exception info |
| 225 | cs } |
| 226 | eip } |
| 227 | ---------------- <- edi (copy dest) |
| 228 | eax : outer eax if it hasn't been restored |
| 229 | ---------------- |
| 230 | eflags } nested exception info |
| 231 | cs } (no ss/esp because we're nested |
| 232 | eip } from the same ring) |
| 233 | orig_eax }<- esi (copy src) |
| 234 | - - - - - - - - |
| 235 | fs } |
| 236 | es } |
| 237 | ds } SAVE_ALL state |
| 238 | eax } |
| 239 | : : |
Jeremy Fitzhardinge | 0f2c876 | 2008-03-17 16:37:22 -0700 | [diff] [blame] | 240 | ebx }<- esp |
Jeremy Fitzhardinge | 9ec2b80 | 2007-07-17 18:37:07 -0700 | [diff] [blame] | 241 | ---------------- |
| 242 | |
| 243 | In order to deliver the nested exception properly, we need to shift |
| 244 | everything from the return addr up to the error code so it |
| 245 | sits just under the outer exception info. This means that when we |
| 246 | handle the exception, we do it in the context of the outer exception |
| 247 | rather than starting a new one. |
| 248 | |
| 249 | The only caveat is that if the outer eax hasn't been |
| 250 | restored yet (ie, it's still on stack), we need to insert |
| 251 | its value into the SAVE_ALL state before going on, since |
| 252 | it's usermode state which we eventually need to restore. |
| 253 | */ |
| 254 | ENTRY(xen_iret_crit_fixup) |
Jeremy Fitzhardinge | 9ec2b80 | 2007-07-17 18:37:07 -0700 | [diff] [blame] | 255 | /* |
Jeremy Fitzhardinge | 0f2c876 | 2008-03-17 16:37:22 -0700 | [diff] [blame] | 256 | Paranoia: Make sure we're really coming from kernel space. |
Jeremy Fitzhardinge | 9ec2b80 | 2007-07-17 18:37:07 -0700 | [diff] [blame] | 257 | One could imagine a case where userspace jumps into the |
| 258 | critical range address, but just before the CPU delivers a GP, |
| 259 | it decides to deliver an interrupt instead. Unlikely? |
| 260 | Definitely. Easy to avoid? Yes. The Intel documents |
| 261 | explicitly say that the reported EIP for a bad jump is the |
| 262 | jump instruction itself, not the destination, but some virtual |
| 263 | environments get this wrong. |
| 264 | */ |
Jeremy Fitzhardinge | 0f2c876 | 2008-03-17 16:37:22 -0700 | [diff] [blame] | 265 | movl PT_CS(%esp), %ecx |
Jeremy Fitzhardinge | 9ec2b80 | 2007-07-17 18:37:07 -0700 | [diff] [blame] | 266 | andl $SEGMENT_RPL_MASK, %ecx |
| 267 | cmpl $USER_RPL, %ecx |
| 268 | je 2f |
| 269 | |
Jeremy Fitzhardinge | 0f2c876 | 2008-03-17 16:37:22 -0700 | [diff] [blame] | 270 | lea PT_ORIG_EAX(%esp), %esi |
| 271 | lea PT_EFLAGS(%esp), %edi |
Jeremy Fitzhardinge | 9ec2b80 | 2007-07-17 18:37:07 -0700 | [diff] [blame] | 272 | |
| 273 | /* If eip is before iret_restore_end then stack |
| 274 | hasn't been restored yet. */ |
| 275 | cmp $iret_restore_end, %eax |
| 276 | jae 1f |
| 277 | |
Jeremy Fitzhardinge | 0f2c876 | 2008-03-17 16:37:22 -0700 | [diff] [blame] | 278 | movl 0+4(%edi),%eax /* copy EAX (just above top of frame) */ |
| 279 | movl %eax, PT_EAX(%esp) |
Jeremy Fitzhardinge | 9ec2b80 | 2007-07-17 18:37:07 -0700 | [diff] [blame] | 280 | |
| 281 | lea ESP_OFFSET(%edi),%edi /* move dest up over saved regs */ |
| 282 | |
| 283 | /* set up the copy */ |
| 284 | 1: std |
Jeremy Fitzhardinge | 0f2c876 | 2008-03-17 16:37:22 -0700 | [diff] [blame] | 285 | mov $PT_EIP / 4, %ecx /* saved regs up to orig_eax */ |
Jeremy Fitzhardinge | 9ec2b80 | 2007-07-17 18:37:07 -0700 | [diff] [blame] | 286 | rep movsl |
| 287 | cld |
| 288 | |
| 289 | lea 4(%edi),%esp /* point esp to new frame */ |
Jeremy Fitzhardinge | 0f2c876 | 2008-03-17 16:37:22 -0700 | [diff] [blame] | 290 | 2: jmp xen_do_upcall |
Jeremy Fitzhardinge | 6487673 | 2007-07-17 18:37:07 -0700 | [diff] [blame] | 291 | |
| 292 | |
Jeremy Fitzhardinge | 6487673 | 2007-07-17 18:37:07 -0700 | [diff] [blame] | 293 | /* |
| 294 | Force an event check by making a hypercall, |
| 295 | but preserve regs before making the call. |
| 296 | */ |
| 297 | check_events: |
| 298 | push %eax |
| 299 | push %ecx |
| 300 | push %edx |
Jeremy Fitzhardinge | 0d1edf4 | 2008-07-28 11:53:57 -0700 | [diff] [blame] | 301 | call xen_force_evtchn_callback |
Jeremy Fitzhardinge | 6487673 | 2007-07-17 18:37:07 -0700 | [diff] [blame] | 302 | pop %edx |
| 303 | pop %ecx |
| 304 | pop %eax |
| 305 | ret |