init. 1AQQW051HEADmaster

1 files changed, 553 insertions, 0 deletions

diff --git a/Core/EM/KbcEmul/VirtualMouse.c b/Core/EM/KbcEmul/VirtualMouse.c
new file mode 100644
index 0000000..00af801
--- /dev/null
+++ b/Core/EM/KbcEmul/VirtualMouse.c
@@ -0,0 +1,553 @@
+//**********************************************************************
+//**********************************************************************
+//**                                                                  **
+//**        (C)Copyright 1985-2011, American Megatrends, Inc.         **
+//**                                                                  **
+//**                       All Rights Reserved.                       **
+//**                                                                  **
+//**         5555 Oakbrook Pkwy, Suite 200, Norcross, GA 30093        **
+//**                                                                  **
+//**                       Phone: (770)-246-8600                      **
+//**                                                                  **
+//**********************************************************************
+//**********************************************************************
+// $Header: /Alaska/SOURCE/Modules/KbcEmulation/ALASKA/KBCEMUL/VirtualMouse.c 6     3/04/14 6:19a Nimishsv $
+//
+// $Revision: 6 $
+//
+// $Date: 3/04/14 6:19a $
+//
+//****************************************************************************
+// Revision History
+// ----------------
+// $Log: /Alaska/SOURCE/Modules/KbcEmulation/ALASKA/KBCEMUL/VirtualMouse.c $
+// 
+// 6     3/04/14 6:19a Nimishsv
+// [TAG]  		EIP156041
+// [Category]  	Improvement
+// [Description]  	Aptio 4.x, KbcEmulation: Send the mouse data to EBDA
+// and only the last data through KBC
+// [Files]  		VirtualMouse.c
+// 
+// 5     2/10/11 1:08a Rameshr
+// [TAG]  		EIP53687
+// [Category]  	Improvement
+// [Description]  	AMI headers update for KbcEmulation Module 
+// 
+// [Files]  		KbcEmul.mak,KbcEmul.dxs,KbcEmul.c,KbcEmul.h,KbcEmulLib.h,Kbc
+// EmulLib.c,Kbc.h,KbcDevEmul.h,Kbccore.c,Legacykbc.c,Legacykbd.c,LegacyMo
+// use.c,VirtualKbc.c,VirtualKbd.c,VirtualMouse.c,Ap4x.h,Ap4x.c,KbcUhci.c,
+// KbcUhci.h,KbcEmulIrq.c, KbcOhci.c, Kbcohci.h
+// 
+// 4     7/08/10 2:02a Rameshr
+// Ohci Emulation support Added.
+// EIP 39712
+// 
+// 3     6/30/09 11:32a Rameshr
+// Coding Standard and File header updated.
+// 
+// 2     10/30/08 10:47a Rameshraju
+// Keyboard & Mouse enable/disable command handled
+// 
+// 1     12/14/07 10:26a Rameshraju
+// Initial Check-in
+//****************************************************************************
+
+//<AMI_FHDR_START>
+//****************************************************************************
+// Name:        VirtualMouse.c
+//
+// Description: Handles the Virtual mouse functions
+//
+//****************************************************************************
+//<AMI_FHDR_END>
+#include "KbcEmul.h"
+#include "KbcDevEmul.h"
+
+#define COUNTOF(x) (sizeof(x)/sizeof(x[0]))
+
+static UINT8 resetResp[] = {0xFA, 0xAA, 0x00 } ;
+static UINT8 statusResp[] = {0xFA, 0x20, 0x02, 0x64  } ;
+static UINT8 dataResp[] = {0xFA, 0x08, 0x00, 0x0  } ;
+static UINT8 ackResp[] = {0xFA};
+static UINT8 idResp[] = {0xFA, 0};
+static UINT8 unknResp[] = {0xFE };
+
+void    mouse_reciev_option(PS2SINK* mouse, UINT8 cmd );
+void    mouse_initParams(VIRTMOUSE* mouse);
+void    vmouse_flushBuffer(VIRTMOUSE* mouse);
+void    vmouse_send_resp(VIRTMOUSE* mouse, UINT8* data, int count );
+void    mouse_echo(PS2SINK* mouse, UINT8 cmd );
+BOOLEAN SendMouseBuffer(VIRTMOUSE* mouse, UINT8* packet, UINTN Count );
+void    vmouse_pumpQueue(PS2SINK* ps2dev);
+extern GenerateIRQ12(VIRTKBC*);
+
+
+//<AMI_PHDR_START>
+//----------------------------------------------------------------------------
+// Procedure:   mouse_idle
+//
+// Description: Handle commands sent from KBC to PS2 Mouse. Mouse idle, waiting for command or key
+//
+// Input:       ps2dev  - pointer to the Mouse structure
+//              Cmd     - Data from the kbc buffer
+//
+// Output:      None
+//
+//----------------------------------------------------------------------------
+//<AMI_PHDR_END>
+void mouse_idle(PS2SINK* ps2dev, UINT8 cmd )
+{
+    VIRTMOUSE* mouse = (VIRTMOUSE*)ps2dev;
+
+    switch(cmd){
+        //
+        //reset
+        //
+        case 0xFF:
+            mouse_initParams(mouse);
+            vmouse_send_resp(mouse, resetResp,COUNTOF(resetResp));
+            break;
+        //
+        //report status
+        //
+        case 0xE9:
+            vmouse_send_resp(mouse, statusResp,COUNTOF(statusResp));
+            break;
+        //
+        //read data
+        //
+        case 0xEB:
+            MemCpy(dataResp+1,&mouse->dataPacket,sizeof(mouse->dataPacket));
+            vmouse_flushBuffer(mouse);
+            vmouse_send_resp(mouse, dataResp,COUNTOF(dataResp));
+            break;
+        //
+        //Enable Mouse
+        //
+        case 0xF4:
+            mouse->Enabled = TRUE;
+            vmouse_send_resp(mouse, ackResp,COUNTOF(ackResp));
+            break;
+        //
+        //Disable Mouse
+        //
+        case 0xF5:
+            mouse->Enabled = FALSE;
+            vmouse_send_resp(mouse, ackResp,COUNTOF(ackResp));
+            break;
+        //
+        //Set Streaming
+        //
+        case 0xEA:
+            mouse->streaming = 1;
+            vmouse_send_resp(mouse, ackResp,COUNTOF(ackResp));
+            break;
+        //
+        //Set Remote
+        //
+        case 0xF0:
+            mouse->streaming = 0;
+            vmouse_send_resp(mouse, ackResp,COUNTOF(ackResp));
+            break;
+        //
+        //Set Standard, Set Scaling and Reset Scaling
+        //
+        case 0xF6:
+        case 0xE6:
+        case 0xE7:
+            vmouse_send_resp(mouse, ackResp,COUNTOF(ackResp));
+            break;
+        //
+        //Identify
+        //
+        case 0xF2:
+            vmouse_send_resp(mouse, idResp,COUNTOF(idResp));
+            break;
+
+        //
+        // set resolution
+        //
+        case 0xE8:
+            mouse->option_ptr = &mouse->resolution_;
+            ps2dev->onCommand = mouse_reciev_option;
+            vmouse_send_resp(mouse, ackResp,COUNTOF(ackResp));
+            break;
+        //
+        // set sampling rate
+        //
+        case 0xF3:
+            mouse->option_ptr = &mouse->samplingRate_;
+            ps2dev->onCommand = mouse_reciev_option;
+            vmouse_send_resp(mouse, ackResp,COUNTOF(ackResp));
+            break;
+        case 0xEE:
+            vmouse_send_resp(mouse, ackResp,COUNTOF(ackResp));
+            ps2dev->onCommand = mouse_echo;
+            break;
+        //
+        //unknown command; send FE
+        //
+        default:
+            vmouse_send_resp(mouse, unknResp,COUNTOF(unknResp));
+            break;
+    }
+}
+
+//<AMI_PHDR_START>
+//----------------------------------------------------------------------------
+// Procedure:   mouse_echo
+//
+// Description: Mouse Echo command
+//
+// Input:       ps2dev  - pointer to the Mouse structure
+//              Cmd     - Data from the kbc buffer
+//
+// Output:      None
+//
+//----------------------------------------------------------------------------
+//<AMI_PHDR_END>
+void mouse_echo(PS2SINK* ps2dev, UINT8 cmd )
+{
+    VIRTMOUSE* mouse = (VIRTMOUSE*)ps2dev;
+    if( cmd == 0xEC ){
+        ps2dev->onCommand = mouse_idle;
+        vmouse_send_resp(mouse, ackResp,COUNTOF(ackResp));
+    } else
+        vmouse_send_resp(mouse, &cmd,1);
+
+}
+//<AMI_PHDR_START>
+//----------------------------------------------------------------------------
+// Procedure:   mouse_reciev_option
+//
+// Description: Mouse reciev command
+//
+// Input:       ps2dev  - pointer to the KBD structure
+//              Cmd     - Data from the kbc buffer
+//
+// Output:      None
+//
+//----------------------------------------------------------------------------
+//<AMI_PHDR_END>
+void mouse_reciev_option(PS2SINK* ps2dev, UINT8 cmd )
+{
+    VIRTMOUSE* mouse = (VIRTMOUSE*)ps2dev;
+    *(mouse->option_ptr)  = cmd;
+    ps2dev->onCommand = mouse_idle;
+    vmouse_send_resp(mouse, ackResp,COUNTOF(ackResp));
+}
+
+
+//<AMI_PHDR_START>
+//----------------------------------------------------------------------------
+// Procedure:   msInput_Send
+//
+// Description: Mouse Input source sends data. Put the data into the buffer, attempt to send the first byte.
+//              The call comes outside of Trapping Leg access. Check that Trapping status will not be overriden
+//
+// Input:       P       - pointer to the Emulation Protocol
+//              Data    - Ps2 mouse Data
+//
+// Output:      None
+//
+//----------------------------------------------------------------------------
+//<AMI_PHDR_END>
+EFI_STATUS EFIAPI msInput_Send(
+  IN EFI_EMUL6064MSINPUT_PROTOCOL           * This,
+  IN PS2MouseData*                   data
+  )
+{
+    VIRTMOUSE* mouse = _CR(This,VIRTMOUSE,msInput_);
+#if USB_MOUSE_UPDATE_EBDA_DATA    
+    UINT16     ebdaSeg = *(UINT16*)0x40E;
+    UINT8      *ebda = (UINT8*)((UINTN)ebdaSeg<<4);
+
+    // Return EFI NOT READY if EBDA has some data.
+    // Let USB resend the data if the EBDA is not empty
+    if ( 0 != ebda[0x26] ) {
+        return EFI_NOT_READY;
+    }
+#endif
+    //
+    //clear all previous flags except overflow
+    //
+    mouse->dataPacket.flags &= (PS2MSFLAGS_XO|PS2MSFLAGS_YO);
+    //
+    //copy overflow and button flags from new packet
+    //
+    mouse->dataPacket.flags |= data->flags & ~(PS2MSFLAGS_XSIGN|PS2MSFLAGS_YSIGN);
+    mouse->dataPacket.flags |= 0x8;
+    if( (mouse->dataPacket.flags & PS2MSFLAGS_XO) == 0){
+        if(data->flags & PS2MSFLAGS_XSIGN){
+            mouse->x += (signed short)((UINT8)data->x | 0xFF00);
+        } else {
+            mouse->x += data->x;
+        }
+        mouse->dataPacket.x = (UINT8)(UINT32)(mouse->x);
+        if( mouse->x < 0 ){
+            mouse->dataPacket.flags |= PS2MSFLAGS_XSIGN;
+            if( mouse->x < -256 )
+                mouse->dataPacket.flags |= PS2MSFLAGS_XO;
+        } else {
+            if( mouse->x > 256 )
+                mouse->dataPacket.flags |= PS2MSFLAGS_XO;
+        }
+    }
+
+    if( (mouse->dataPacket.flags & PS2MSFLAGS_YO) == 0){
+        if(data->flags & PS2MSFLAGS_YSIGN){
+            mouse->y += (signed short)((UINT8)data->y | 0xFF00);
+        } else {
+            mouse->y += data->y;
+        }
+        mouse->dataPacket.y = (UINT8)(UINT32)(mouse->y);
+        if( mouse->y < 0 ){
+            mouse->dataPacket.flags |= PS2MSFLAGS_YSIGN;
+            if( mouse->y < -256 )
+                mouse->dataPacket.flags |= PS2MSFLAGS_YO;
+        } else{
+            if( mouse->y > 256 )
+                mouse->dataPacket.flags |= PS2MSFLAGS_YO;
+        }
+    }
+
+    mouse->fFreshPacket = 1;
+    if( mouse->Enabled && mouse->streaming ){
+        if( SendMouseBuffer(mouse,(UINT8*)&mouse->dataPacket,sizeof(mouse->dataPacket)))
+        {
+            vmouse_flushBuffer(mouse);
+        }
+    }
+    return EFI_SUCCESS;
+}
+
+//<AMI_PHDR_START>
+//----------------------------------------------------------------------------
+// Procedure:   SendMouseBuffer
+//
+// Description: Send the mouse packet to KBC
+//
+// Input:       Mouse   - pointer to the Mouse Structure
+//              Packetr - Mouse Data
+//              Count   - Data Length
+//
+// Output:      None
+//
+//----------------------------------------------------------------------------
+//<AMI_PHDR_END>
+BOOLEAN SendMouseBuffer(VIRTMOUSE* mouse, UINT8* packet, UINTN Count )
+{
+    UINTN   FreeQueue = 0;
+#if USB_MOUSE_UPDATE_EBDA_DATA    
+    UINT16  ebdaSeg = *(UINT16*)0x40E;
+    UINT8   *ebda = (UINT8*)((UINTN)ebdaSeg<<4);
+    UINT8   packageSize = ebda[0x27] & 7;
+    UINT8   index=0;
+#endif
+    //
+    // count of free items in the queue
+    //
+    if( mouse->qtail >= mouse->qhead )
+        FreeQueue = MOUSEQUEUE_SIZE - (mouse->qtail - mouse->qhead);
+    else
+        FreeQueue = mouse->qhead - mouse->qtail;
+
+    if(FreeQueue < Count )
+        return TRUE;
+
+    //
+    //place the Mouse data in mouse buffer
+    //
+    for( ; Count > 0; --Count ){
+        *mouse->qtail++ = *packet++;
+        if(mouse->qtail >= mouse->queue+MOUSEQUEUE_SIZE)
+            mouse->qtail = mouse->queue;
+    }
+
+    //
+    //Place the dummy 4th byte in mouse buffer,
+    //
+//  *mouse->qtail++ = 0;
+//  if(mouse->qtail >= mouse->queue+MOUSEQUEUE_SIZE)
+//      mouse->qtail = mouse->queue;
+
+#if USB_MOUSE_UPDATE_EBDA_DATA    
+    // Write the 1st two bytes of mouse packet to EBDA and last byte to KBC
+    for (; index<=packageSize; index++) {
+        if (index == 0) {
+            ebda[0x28+index] = *mouse->qhead;
+            ebda[0x26]++;
+            if(++mouse->qhead >=  mouse->queue+MOUSEQUEUE_SIZE)
+                mouse->qhead = mouse->queue;
+        }
+        if (index == 1) {
+            ebda[0x28+index] = *mouse->qhead;
+            ebda[0x26]++;
+            if(++mouse->qhead >=  mouse->queue+MOUSEQUEUE_SIZE)
+                mouse->qhead = mouse->queue;
+        }
+        if (index == 2) {
+            vmouse_pumpQueue(&mouse->sink);
+        }
+    }
+#else
+    //Put the first byte in the KBC buffer
+    vmouse_pumpQueue(&mouse->sink);
+#endif
+
+    return TRUE;
+}
+
+//<AMI_PHDR_START>
+//----------------------------------------------------------------------------
+// Procedure:   vmouse_pumpQueue
+//
+// Description: KBC has empty queue; Legacy I/O trapping is being processed.If mouse has data to push into KBC,
+//              now is a good time to do it
+//
+// Input:       ps2dev  - pointer to the Mouse structure
+//
+// Output:      None
+//
+//----------------------------------------------------------------------------
+//<AMI_PHDR_END>
+void vmouse_pumpQueue(PS2SINK* ps2dev)
+{
+    VIRTMOUSE* mouse = (VIRTMOUSE*)ps2dev;
+
+    //
+    //Put the data into KBC
+    //
+    if((mouse->qhead != mouse->qtail) && (ps2dev->kbc->send_outb1(ps2dev->kbc,PS2DEV_MOUSE,FALSE,*mouse->qhead))) {
+        if(++mouse->qhead >=  mouse->queue+MOUSEQUEUE_SIZE)
+            mouse->qhead = mouse->queue;
+    }
+}
+
+//<AMI_PHDR_START>
+//----------------------------------------------------------------------------
+// Procedure:   vmouse_send_resp
+//
+// Description: Place the Response bytes in the keyboard buffer.
+//
+// Input:       Mousev  - pointer to the Mouse structure
+//              Data    -   Pointer to the Data
+//              count   - Length of the data
+//
+// Output:      None
+//
+//----------------------------------------------------------------------------
+//<AMI_PHDR_END>
+void vmouse_send_resp(VIRTMOUSE* mouse, UINT8* data, int  count )
+{
+    if(mouse->sink.present_ ){
+        //
+        // Emulation must provide the response. Override any previos mouse data queued to KBC
+        //
+        mouse->qtail = mouse->qhead = mouse->queue;
+        for( ; count > 0; --count ){
+            *mouse->qtail++ = *data++;
+        }
+
+        ///
+        // push the first byte to the KBC
+        //
+        if( mouse->qhead != mouse->qtail &&
+            mouse->sink.kbc->send_outb1(mouse->sink.kbc,
+            PS2DEV_MOUSE,TRUE,*mouse->qhead))
+        {
+            if(++mouse->qhead >=  mouse->queue+MOUSEQUEUE_SIZE)
+                mouse->qhead = mouse->queue;        }
+    }
+}
+
+//<AMI_PHDR_START>
+//----------------------------------------------------------------------------
+// Procedure:   vmouse_flushBuffer
+//
+// Description: Clear the mouse data buffer that tracks the mouse changes; after the data is cleared any data read
+//              will return zero (x,y) and current buttons state.
+//
+// Input:       ps2dev  - pointer to the KBD structure
+//              Cmd     - Data from the kbc buffer
+//
+// Output:      None
+//
+//----------------------------------------------------------------------------
+//<AMI_PHDR_END>
+void vmouse_flushBuffer(VIRTMOUSE* mouse)
+{
+    mouse->x = mouse->y = 0;
+    mouse->dataPacket.x = mouse->dataPacket.y = 0;
+    mouse->dataPacket.flags &= (PS2MSFLAGS_LBUTTON|PS2MSFLAGS_RBUTTON);
+    mouse->fFreshPacket = 0;
+}
+
+//<AMI_PHDR_START>
+//----------------------------------------------------------------------------
+// Procedure:   mouse_initParams
+//
+// Description: Initialize the mouse data
+//
+// Input:       kbd   - Pointer to the mouse structure
+//
+// Output:      None
+//
+//----------------------------------------------------------------------------
+//<AMI_PHDR_END>
+void mouse_initParams(VIRTMOUSE* mouse)
+{
+    mouse->samplingRate_ = 0x64;
+    mouse->resolution_ = 2;
+    mouse->option_ptr = 0;
+    mouse->Enabled = FALSE;
+    mouse->streaming = 1;
+}
+
+//<AMI_PHDR_START>
+//----------------------------------------------------------------------------
+// Procedure:   InitVirtualMouse
+//
+// Description: Initialize the Mouse data
+//
+// Input:       kbc     - pointer to the KBC Structure
+//              Mouse   - Pointer to the Mouse structure
+//
+// Output:      None
+//
+//----------------------------------------------------------------------------
+//<AMI_PHDR_END>
+void InitVirtualMouse(KBC* kbc, VIRTMOUSE* mouse )
+{
+    EFI_HANDLE hEmulationService = 0;
+
+    mouse->qhead = mouse->qtail = mouse->queue;
+    mouse->sink.kbc = kbc;
+    mouse->sink.onCommand = mouse_idle;
+    mouse->sink.onQueueFree = vmouse_pumpQueue;
+    mouse->msInput_.Send = msInput_Send;
+    mouse->x = mouse->y = 0;
+    mouse->dataPacket.flags = 0x8;
+    mouse->dataPacket.x = 0;
+    mouse->dataPacket.y = 0;
+    mouse->fFreshPacket = 0;
+    mouse_initParams(mouse);
+    VERIFY_EFI_ERROR(
+        gBS->InstallProtocolInterface(&hEmulationService,
+        &gEmul6064MsInputProtocolGuid,EFI_NATIVE_INTERFACE,(void*)&mouse->msInput_));
+}
+
+//**********************************************************************
+//**********************************************************************
+//**                                                                  **
+//**        (C)Copyright 1985-2011, American Megatrends, Inc.         **
+//**                                                                  **
+//**                       All Rights Reserved.                       **
+//**                                                                  **
+//**         5555 Oakbrook Pkwy, Suite 200, Norcross, GA 30093        **
+//**                                                                  **
+//**                       Phone: (770)-246-8600                      **
+//**                                                                  **
+//**********************************************************************
+//**********************************************************************