[c049309] | 1 | #
|
---|
| 2 | # Copyright (C) 2001-2004 Jakub Jermar
|
---|
| 3 | # All rights reserved.
|
---|
| 4 | #
|
---|
| 5 | # Redistribution and use in source and binary forms, with or without
|
---|
| 6 | # modification, are permitted provided that the following conditions
|
---|
| 7 | # are met:
|
---|
| 8 | #
|
---|
| 9 | # - Redistributions of source code must retain the above copyright
|
---|
| 10 | # notice, this list of conditions and the following disclaimer.
|
---|
| 11 | # - Redistributions in binary form must reproduce the above copyright
|
---|
| 12 | # notice, this list of conditions and the following disclaimer in the
|
---|
| 13 | # documentation and/or other materials provided with the distribution.
|
---|
| 14 | # - The name of the author may not be used to endorse or promote products
|
---|
| 15 | # derived from this software without specific prior written permission.
|
---|
| 16 | #
|
---|
| 17 | # THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
|
---|
| 18 | # IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
|
---|
| 19 | # OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
|
---|
| 20 | # IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,
|
---|
| 21 | # INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
|
---|
| 22 | # NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
|
---|
| 23 | # DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
|
---|
| 24 | # THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
|
---|
| 25 | # (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF
|
---|
| 26 | # THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
|
---|
| 27 | #
|
---|
| 28 |
|
---|
| 29 | ## very low and hardware-level functions
|
---|
| 30 |
|
---|
| 31 | # Mask for interrupts 0 - 31 (bits 0 - 31) where 0 means that int has no error word
|
---|
| 32 | # and 1 means interrupt with error word
|
---|
| 33 | #define ERROR_WORD_INTERRUPT_LIST 0x00027D00
|
---|
| 34 |
|
---|
| 35 | .text
|
---|
| 36 |
|
---|
[7d3d641] | 37 | .global xen_callback
|
---|
| 38 | .global xen_failsafe_callback
|
---|
[c049309] | 39 | .global enable_l_apic_in_msr
|
---|
| 40 | .global memcpy
|
---|
| 41 | .global memcpy_from_uspace
|
---|
| 42 | .global memcpy_from_uspace_failover_address
|
---|
| 43 | .global memcpy_to_uspace
|
---|
| 44 | .global memcpy_to_uspace_failover_address
|
---|
| 45 |
|
---|
| 46 |
|
---|
[7d3d641] | 47 | xen_callback:
|
---|
| 48 | iret
|
---|
| 49 |
|
---|
| 50 | xen_failsafe_callback:
|
---|
| 51 | iret
|
---|
| 52 |
|
---|
| 53 |
|
---|
[c049309] | 54 | #define MEMCPY_DST 4
|
---|
| 55 | #define MEMCPY_SRC 8
|
---|
| 56 | #define MEMCPY_SIZE 12
|
---|
| 57 |
|
---|
| 58 | /** Copy memory to/from userspace.
|
---|
| 59 | *
|
---|
| 60 | * This is almost conventional memcpy().
|
---|
| 61 | * The difference is that there is a failover part
|
---|
| 62 | * to where control is returned from a page fault
|
---|
| 63 | * if the page fault occurs during copy_from_uspace()
|
---|
| 64 | * or copy_to_uspace().
|
---|
| 65 | *
|
---|
| 66 | * @param MEMCPY_DST(%esp) Destination address.
|
---|
| 67 | * @param MEMCPY_SRC(%esp) Source address.
|
---|
| 68 | * @param MEMCPY_SIZE(%esp) Size.
|
---|
| 69 | *
|
---|
| 70 | * @return MEMCPY_SRC(%esp) on success and 0 on failure.
|
---|
| 71 | */
|
---|
| 72 | memcpy:
|
---|
| 73 | memcpy_from_uspace:
|
---|
| 74 | memcpy_to_uspace:
|
---|
| 75 | movl %edi, %edx /* save %edi */
|
---|
| 76 | movl %esi, %eax /* save %esi */
|
---|
| 77 |
|
---|
| 78 | movl MEMCPY_SIZE(%esp), %ecx
|
---|
| 79 | shrl $2, %ecx /* size / 4 */
|
---|
| 80 |
|
---|
| 81 | movl MEMCPY_DST(%esp), %edi
|
---|
| 82 | movl MEMCPY_SRC(%esp), %esi
|
---|
| 83 |
|
---|
| 84 | rep movsl /* copy as much as possible word by word */
|
---|
| 85 |
|
---|
| 86 | movl MEMCPY_SIZE(%esp), %ecx
|
---|
| 87 | andl $3, %ecx /* size % 4 */
|
---|
| 88 | jz 0f
|
---|
| 89 |
|
---|
| 90 | rep movsb /* copy the rest byte by byte */
|
---|
| 91 |
|
---|
| 92 | 0:
|
---|
| 93 | movl %edx, %edi
|
---|
| 94 | movl %eax, %esi
|
---|
| 95 | movl MEMCPY_SRC(%esp), %eax /* MEMCPY_SRC(%esp), success */
|
---|
| 96 | ret
|
---|
| 97 |
|
---|
| 98 | /*
|
---|
| 99 | * We got here from as_page_fault() after the memory operations
|
---|
| 100 | * above had caused a page fault.
|
---|
| 101 | */
|
---|
| 102 | memcpy_from_uspace_failover_address:
|
---|
| 103 | memcpy_to_uspace_failover_address:
|
---|
| 104 | movl %edx, %edi
|
---|
| 105 | movl %eax, %esi
|
---|
| 106 | xorl %eax, %eax /* return 0, failure */
|
---|
| 107 | ret
|
---|
| 108 |
|
---|
| 109 |
|
---|
| 110 | ## Enable local APIC
|
---|
| 111 | #
|
---|
| 112 | # Enable local APIC in MSR.
|
---|
| 113 | #
|
---|
| 114 | enable_l_apic_in_msr:
|
---|
| 115 | push %eax
|
---|
| 116 |
|
---|
| 117 | movl $0x1b, %ecx
|
---|
| 118 | rdmsr
|
---|
| 119 | orl $(1<<11),%eax
|
---|
| 120 | orl $(0xfee00000),%eax
|
---|
| 121 | wrmsr
|
---|
| 122 |
|
---|
| 123 | pop %eax
|
---|
| 124 | ret
|
---|