From: Kevin O'Connor <kevin@koconnor.net>
Date: Fri, 14 Mar 2008 01:33:26 +0000 (-0400)
Subject: Fix bug in apm32protected_entry.
X-Git-Url: http://wien.tomnetworks.com/gitweb/?a=commitdiff_plain;h=68296e8ec0dbf6a06df8cd47c2939ac750fe164d;p=seabios.git

Fix bug in apm32protected_entry.

Order of stack was not correct.
New implementation still needs to be tested.
---

diff --git a/src/romlayout.S b/src/romlayout.S
index 2fd0f83..d11741e 100644
--- a/src/romlayout.S
+++ b/src/romlayout.S
@@ -158,7 +158,7 @@ __call16_from32:
         pushl %eax
 
         // Jump to 16bit mode
-        ljmp $REAL_MODE_CS, $1f
+        ljmpw $REAL_MODE_CS, $1f
 
         .code16gcc
 1:
@@ -261,18 +261,24 @@ apm16protected_entry:
         .code32
         .globl apm32protected_entry
 apm32protected_entry:
-        pushfw          // save flags
-        pushw %cs       // Setup for long jump to 16bitmode
-        incw (%esp)
-        pushw 1f
-        lcallw *(%esp)
+        pushfw
+        pushw %cs       // Setup for long jump to 16bit mode
+        pushw $1f
+        incw 2(%esp)
+        ljmpw *(%esp)
+        .code16gcc
+1:
+        ENTRY_ARG handle_1553
+
+        movw $2f,(%esp) // Setup for long jump back to 32bit mode
+        decw 2(%esp)
+        ljmpw *(%esp)
+        .code32
+2:
         addl $4, %esp   // pop call address
         popfw
         lretl
         .code16gcc
-1:                      // 16bit entry point for apm32 code.
-        ENTRY_ARG handle_1553
-        lretw
 
 
 /****************************************************************