/*++

Module Name:

    apcuser.c

Abstract:

    This module implements the machine dependent code necessary to initialize
    a user mode APC.

Author:

    William K. Cheung  26-Oct-1995

    based on MIPS version by David N. Cutler (davec) 23-Apr-1990

Environment:

    Kernel mode only, IRQL APC_LEVEL.

Revision History:

--*/

#include "ki.h"
#include "kxia64.h"

VOID
KiSaveHigherFPVolatile (
    PVOID
    );

VOID
KiInitializeUserApc (
    IN PKEXCEPTION_FRAME ExceptionFrame,
    IN PKTRAP_FRAME TrapFrame,
    IN PKNORMAL_ROUTINE NormalRoutine,
    IN PVOID NormalContext,
    IN PVOID SystemArgument1,
    IN PVOID SystemArgument2
    )

/*++

Routine Description:

    This function is called to initialize the context for a user mode APC.

Arguments:

    ExceptionFrame - Supplies a pointer to an exception frame.

    TrapFrame - Supplies a pointer to a trap frame.

    NormalRoutine - Supplies a pointer to the user mode APC routine.

    NormalContext - Supplies a pointer to the user context for the APC
        routine.

    SystemArgument1 - Supplies the first system supplied value.

    SystemArgument2 - Supplies the second system supplied value.

Return Value:

    None.

--*/

{

    CONTEXT ContextRecord;
    EXCEPTION_RECORD ExceptionRecord;
    LONG Length;
    ULONGLONG UserStack;
    PULONGLONG Arguments;

    //
    // Move the user mode state from the trap and exception frames to the
    // context frame.
    //

    ContextRecord.ContextFlags = CONTEXT_FULL;

    //
    // Push the user RSE state back out to user mode.
    //

    KeFlushUserRseState (TrapFrame);

    KiSaveHigherFPVolatile(GET_HIGH_FLOATING_POINT_REGISTER_SAVEAREA(KeGetCurrentThread()->StackBase));
    TrapFrame->StIPSR &= ~(1i64 << PSR_MFH);

    KeContextFromKframes(TrapFrame, ExceptionFrame, &ContextRecord);

    //
    // Transfer the context information to the user stack, initialize the
    // APC routine parameters, and modify the trap frame so execution will
    // continue in user mode at the user mode APC dispatch routine.
    //
    // We build the following structure on the user stack:
    //
    //             |                               |  
    //             |-------------------------------|
    //             |                               |
    //             |   Interrupted user's          |
    //             |   stack frame                 |
    //             |                               |
    //             |                               |
    //             |-------------------------------|
    //             |   Slack Space due to the      |
    //             |   16-byte stack alignment     |
    //             | - - - - - - - - - - - - - - - |
    //             |     NormalRoutine             |
    //             |     SystemArgument2           |
    //             |     SystemArgument1           |
    //             |     NormalContext             |
    //             | - - - - - - - - - - - - - - - |
    //             |   Context Frame               |
    //             |      Filled in with state     |
    //             |      of interrupted user      |
    //             |      program                  |
    //             | - - - - - - - - - - - - - - - |
    //             |   Stack Scratch Area          |
    //             |-------------------------------|
    //             |                               |

    try {

    USHORT LocalFrameSize;
    PPLABEL_DESCRIPTOR Plabel = (PPLABEL_DESCRIPTOR) KeUserApcDispatcher;

    //
    // Compute total length of 4 arguments, context record, and
    // stack scratch area. 
    //
    // Compute the new 16-byte aligned user stack pointer.
    //

    Length = (4 * sizeof(ULONGLONG) + CONTEXT_LENGTH +
              STACK_SCRATCH_AREA + 15) & (~15);
    UserStack = (ContextRecord.IntSp & (~15)) - Length;
    Arguments = (PULONGLONG)(UserStack + STACK_SCRATCH_AREA + CONTEXT_LENGTH);

    //
    // Probe user stack area for writeability and then transfer the
    // context record to the user stack.
    //

    ProbeForWriteSmallStructure((PCHAR)UserStack, Length, sizeof(QUAD));
    RtlCopyMemory((PVOID)(UserStack+STACK_SCRATCH_AREA), 
                  &ContextRecord, sizeof(CONTEXT));

    //
    // Set the address of the user APC routine, the APC parameters, the
    // interrupt frame set, the new global pointer, and the new stack 
    // pointer in the current trap frame.  The four APC parameters are 
    // passed via the scratch registers t0 thru t3. 
    // Set the continuation address so control will be transfered to 
    // the user APC dispatcher.
    //

    *Arguments++ = (ULONGLONG)NormalContext;     // 1st argument
    *Arguments++ = (ULONGLONG)SystemArgument1;   // 2nd argument
    *Arguments++ = (ULONGLONG)SystemArgument2;   // 3rd argument
    *Arguments++ = (ULONGLONG)NormalRoutine;     // 4th argument
    *(PULONGLONG)UserStack = Plabel->GlobalPointer;  // user apc dispatcher gp

    TrapFrame->IntNats = 0;                      // sanitize integer Nats
    TrapFrame->IntSp = UserStack;                // stack pointer

    TrapFrame->StIIP = Plabel->EntryPoint;       // entry point from plabel
    TrapFrame->StIPSR &= ~(0x3ULL << PSR_RI);    // start at bundle boundary
    TrapFrame->RsPFS &= 0xffffffc000000000i64;   // set the initial frame
    TrapFrame->StIFS &= 0xffffffc000000000i64;   // set the initial frame
                                                 // size of KeUserApcDispatcher
                                                 // to be zero.
    TrapFrame->StFPSR = USER_FPSR_INITIAL;

    //
    // If an exception occurs, then copy the exception information to an
    // exception record and handle the exception.
    //

    } except (KiCopyInformation(&ExceptionRecord,
                                (GetExceptionInformation())->ExceptionRecord)) {

        //
        // Set the address of the exception to the current program address
        // and raise the exception by calling the exception dispatcher.
        //

        ExceptionRecord.ExceptionAddress = (PVOID)(TrapFrame->StIIP);
        KiDispatchException(&ExceptionRecord,
                            ExceptionFrame,
                            TrapFrame,
                            UserMode,
                            TRUE);
    }

    return;
}