[ros-diffs] [ros-arm-bringup] 33969: - Implement the basic stall interrupt to be used to calculate the factors for KeStallExecution (using NT MIPS algorithm, hope this will work) - Also written KeStallExecution. - Now, we are back to where we hang before Phase 1 (so Phase 1 doesn't occur anymore). - This hang is because we used to do a DPC here, which isn't good, since IRQL is already at dispatch. - Instead, the correct course of action is to enter the idle loop, which will schedule the phase 1 thread. - Bu

Author: ros-arm-bringup
Date: Sat Jun 14 17:28:40 2008
New Revision: 33969

URL: http://svn.reactos.org/svn/reactos?rev=33969&view=rev
Log:
- Implement the basic stall interrupt to be used to calculate the factors for
KeStallExecution (using NT MIPS algorithm, hope this will work)
- Also written KeStallExecution.
- Now, we are back to where we hang before Phase 1 (so Phase 1 doesn't occur
anymore).
- This hang is because we used to do a DPC here, which isn't good, since IRQL is
already at dispatch.
- Instead, the correct course of action is to enter the idle loop, which will schedule the
phase 1 thread.
- But, we don't have an idle loop yet ;-)


Modified:
    trunk/reactos/hal/halarm/generic/hal.c

Modified: trunk/reactos/hal/halarm/generic/hal.c
URL:
http://svn.reactos.org/svn/reactos/trunk/reactos/hal/halarm/generic/hal.c?r…
==============================================================================
--- trunk/reactos/hal/halarm/generic/hal.c [iso-8859-1] (original)
+++ trunk/reactos/hal/halarm/generic/hal.c [iso-8859-1] Sat Jun 14 17:28:40 2008
@@ -504,6 +504,8 @@
         asm ("clz\t%0, %1": "=r" (__value): "r" (__arg));
\
         __value; })
 
+ULONG HalpStallStart, HalpStallEnd, HalpStallScaleFactor;
+
 ULONG
 HalGetInterruptSource(VOID)
 {
@@ -517,15 +519,53 @@
 }
 
 VOID
-HalpStallInterrupt(VOID)
-{
-    DPRINT1("STALL INTERRUPT!!!\n");
-    
+HalpClockInterrupt(VOID)
+{   
     //
     // Clear the interrupt
     //
+    DPRINT1("CLOCK INTERRUPT!!!\n");
     WRITE_REGISTER_ULONG(TIMER_INT_CLEAR, 1);    
     while (TRUE);
+}
+
+VOID
+HalpStallInterrupt(VOID)
+{   
+    //
+    // Clear the interrupt
+    //
+    DPRINT1("STALL INTERRUPT!!!: %lx %lx\n", HalpStallStart, HalpStallEnd);
+    WRITE_REGISTER_ULONG(TIMER_INT_CLEAR, 1);
+
+    //
+    // Check if this is our first time here
+    //
+    if (!(HalpStallStart + HalpStallEnd))
+    {
+        //
+        // Remember that we've been hit once
+        //
+        HalpStallEnd = 1;
+    }
+    else if (!(HalpStallStart) && (HalpStallEnd))
+    {
+        //
+        // Okay, this is our second time here!
+        // Load the stall execution count that was setup for us...
+        // And get ready to hit the case below
+        //
+        HalpStallStart = PCR->StallExecutionCount;
+        HalpStallEnd = 0;
+    }
+    else if ((HalpStallStart) && !(HalpStallEnd))
+    {
+        //
+        // This our third time here!
+        // Now we can just save the stall execution count at end time
+        //
+        HalpStallEnd = PCR->StallExecutionCount;
+    }
 }
 
 VOID
@@ -553,7 +593,7 @@
     //  (TIMCLKENXdiv (1) * PRESCALEdiv (1))
     //
     ClockInterval = 0x2710;
-    
+
     //
     // Enable the timer
     //
@@ -766,66 +806,22 @@
 FASTCALL
 HalRequestSoftwareInterrupt(IN KIRQL Request)
 {
-    ULONG Interrupt = 0;
-
-    //
-    // Get the interrupt that maches this IRQL level
-    //
-    switch (Request)
-    {
-        case APC_LEVEL:
-            
-            Interrupt = 1 << 1;
-            break;
-            
-        case DISPATCH_LEVEL:
-            
-            Interrupt = 1 << 2;
-            break;
-            
-        default:
-            
-            ASSERT(FALSE);
-    }
-    
     //
     // Force a software interrupt
     //
-    DPRINT1("About to force interrupt mask: %d\n", Interrupt);
-    WRITE_REGISTER_ULONG(VICSOFTINT, Interrupt);
+    DPRINT1("[SOFTINT]: %d\n", Request);
+    WRITE_REGISTER_ULONG(VICSOFTINT, 1 << Request);
 }
 
 VOID
 FASTCALL
 HalClearSoftwareInterrupt(IN KIRQL Request)
-{
-    ULONG Interrupt = 0;
-    
-    //
-    // Get the interrupt that maches this IRQL level
-    //
-    switch (Request)
-    {
-        case APC_LEVEL:
-            
-            Interrupt = 1 << 1;
-            break;
-            
-        case DISPATCH_LEVEL:
-            
-            Interrupt = 1 << 2;
-            break;
-            
-        default:
-            
-            ASSERT(FALSE);
-    }
-    
+{    
     //
     // Force a software interrupt
     //
-    DPRINT1("About to kill interrupt mask: %d\n", Interrupt);
-    WRITE_REGISTER_ULONG(VICSOFTINTCLEAR, Interrupt);
+    DPRINT1("[SOFTINTC] %d\n", Request);
+    WRITE_REGISTER_ULONG(VICSOFTINTCLEAR, 1 << Request);
 }
 
 VOID
@@ -1091,7 +1087,20 @@
 KeStallExecutionProcessor(
   ULONG Microseconds)
 {
-  UNIMPLEMENTED;
+    ULONG Index;
+ 
+    //
+    // Calculate how many times we should loop
+    //
+    Index = Microseconds * PCR->StallScaleFactor;
+    while (Index)
+    {
+        //
+        // Do one stall cycle
+        //
+        PCR->StallExecutionCount++;
+        Index--;
+    };
 }
 
 VOID