X-Git-Url: http://v3vee.org/palacios/gitweb/gitweb.cgi?p=palacios.git;a=blobdiff_plain;f=palacios%2Fsrc%2Fpalacios%2Fsvm_lowlevel.S;h=45c55756c73532f9c411f47eff9847302e8d1901;hp=9b201b1116f767c5cf6e9f9c663f12d09719cc6f;hb=660d3c512aa3299ede91a0b2e24d8b5cde6306da;hpb=e9e3ee43cb302909917b5919f6043347b73c6995

diff --git a/palacios/src/palacios/svm_lowlevel.S b/palacios/src/palacios/svm_lowlevel.S
index 9b201b1..45c5575 100644
--- a/palacios/src/palacios/svm_lowlevel.S
+++ b/palacios/src/palacios/svm_lowlevel.S
@@ -1,6 +1,5 @@
 #;  -*- fundamental -*-
 
-
 .text
 .align 4
 
@@ -18,8 +17,13 @@
 #define clgi   .byte 0x0F,0x01,0xDD
 
 
+#define SVM_VM_HSAVE_PA_MSR .dword 0xc0010117
+
+
 #ifdef __V3_32BIT__
 
+// Note that RAX is saved in the VMCB, so we don't touch it here
+
 #define Save_SVM_Registers(location) 	\
 	pushl	%eax; 			\
 	movl	location, %eax;		\
@@ -30,10 +34,6 @@
 	movl 	%ebx, 32(%eax);		\
 	movl 	%edx, 40(%eax);		\
 	movl 	%ecx, 48(%eax);		\
-	pushl	%ebx;			\
-	movl	4(%esp), %ebx;		\
-	movl	%ebx, 56(%eax);		\
-	popl	%ebx;			\
 	popl 	%eax;			
 	
 
@@ -49,29 +49,17 @@
 	popl	%eax;
 
 
+// 32 bit GCC passes arguments via stack
 
-#elif __V3_64BIT__
-
-#endif
-
-
-v3_stgi:
-	stgi;
-	ret;
-
-v3_clgi:
-	clgi;
-	ret;
-	
-	
 v3_svm_launch:
 	push	%ebp;
 	movl	%esp, %ebp;
 	pushf;
-	push	%fs;
-	push	%gs;
 	pusha;
 
+	movl 	16(%ebp), %eax;
+	vmsave;
+
 	pushl	12(%ebp);
 	pushl 	8(%ebp);
 
@@ -87,8 +75,140 @@ v3_svm_launch:
 	addl	$4, %esp;
 
 	popa;
-	pop	%gs;
-	pop	%fs;
 	popf;
+
+	movl 	16(%ebp), %eax;
+	vmload;
+
+	// We don't detect failures here, so just return 0
+	xorl	%eax, %eax 
+
 	pop	%ebp;
 	ret
+
+
+
+#elif __V3_64BIT__
+
+// Note that RAX is saved in the VMCB, so we don't touch it here
+
+#define Save_SVM_Registers(location) 	\
+	pushq	%rax; 			\
+	movq	location, %rax;		\
+	movq	%rdi, (%rax);		\
+	movq	%rsi, 8(%rax);		\
+	movq	%rbp, 16(%rax);		\
+	movq	$0, 24(%rax);		\
+	movq 	%rbx, 32(%rax);		\
+	movq 	%rdx, 40(%rax);		\
+	movq 	%rcx, 48(%rax);		\
+					\
+	movq	%r8, 64(%rax);		\
+	movq	%r9, 72(%rax);		\
+	movq	%r10, 80(%rax);		\
+	movq	%r11, 88(%rax);		\
+	movq	%r12, 96(%rax);		\
+	movq	%r13, 104(%rax);	\
+	movq	%r14, 112(%rax);	\
+	movq	%r15, 120(%rax);	\
+	popq 	%rax;			
+	
+
+#define Restore_SVM_Registers(location) \
+	push	%rax;			\
+	mov	location, %rax;		\
+	mov	(%rax), %rdi;		\
+	mov	8(%rax), %rsi;		\
+	mov	16(%rax), %rbp;		\
+	mov	32(%rax), %rbx;		\
+	mov	40(%rax), %rdx;		\
+	mov 	48(%rax), %rcx;		\
+					\
+	mov	64(%rax), %r8;		\
+	mov	72(%rax), %r9;		\
+	mov	80(%rax), %r10;		\
+	mov	88(%rax), %r11;		\
+	mov	96(%rax), %r12;		\
+	mov	104(%rax), %r13;	\
+	mov	112(%rax), %r14;	\
+	mov	120(%rax), %r15;	\
+	pop	%rax;
+
+
+
+
+#define PUSHA				\
+	pushq %rbp;			\
+	pushq %rbx;			\
+	pushq %r8;			\
+	pushq %r9;			\
+	pushq %r10;			\
+	pushq %r11;			\
+	pushq %r12;			\
+	pushq %r13;			\
+	pushq %r14;			\
+	pushq %r15;			
+
+
+#define POPA				\
+	popq %r15;			\
+	popq %r14;			\
+	popq %r13;			\
+	popq %r12;			\
+	popq %r11;			\
+	popq %r10;			\
+	popq %r9;			\
+	popq %r8;			\
+	popq %rbx;			\
+	popq %rbp;			
+
+
+// Note that this is only for 64 bit GCC, 32 bit GCC passes via stack
+// VMCB => RDI
+// vm_regs => RSI
+// HOST VMCB => RDX
+
+v3_svm_launch:
+	pushf;
+	PUSHA
+	
+	pushq	%rdx;
+	movq	%rdx, %rax;
+	vmsave;
+
+	pushq	%rsi
+
+	movq	%rdi, %rax
+	Restore_SVM_Registers(%rsi);
+
+
+	vmload;
+	vmrun;
+	vmsave;
+
+
+	Save_SVM_Registers(8(%rsp));
+
+	addq $8, %rsp
+
+
+	popq %rax;
+	vmload;
+
+	POPA
+	popf;
+	ret
+
+
+#endif
+
+
+v3_stgi:
+	stgi;
+	ret;
+
+v3_clgi:
+	clgi;
+	ret;
+	
+