?? asm.c
字號:
/*****************************************************************
*
* Reversed By yykingking (yykingking@126.com)
* 僅供學習交流使用
*****************************************************************/
#include "header.h"
extern BOOL g_IsMulProcesser;
extern DWORD g_KBIntEntry,g_KBIntEntry1,g_KBIntEntry2;//雙核CPU鍵盤中斷入口處...保存用來恢復..
extern PSTRUCT_17H g_Buffer17H;
extern PSTRUCT_12H g_Buffer12H;
extern DWORD g_DUnKnown1;
extern DWORD g_IntVector;
extern KIRQL g_Kirql;
extern bool g_IsNT4;
extern KDPC g_Kdpc;
bool g_bAsm1,g_bAsm2,g_bAsm3,g_bAsm4;
BYTE g_r60LastRead,g_r60Last2Read,g_byteAsm3;
DWORD g_DR7;
DWORD g_DAsm1;
// **** Copy From SoBeIt ****//
// 在HAL里雖然HalBeginSystemInterrupt仍然是IRQL機制的發動引擎，但是因為有APIC的支持，
// 它和其它共同實現IRQL的函數要比PIC HAL里對應的函數功能簡單得多。
// HalBeginSystemInterrupt通過用IRQL做索引在HalpIRQLtoTPR數組中獲取該IRQL對應
// 的任務優先級，用該優先級設置任務優先級寄存器TPR，并把TPR中原先的任務優先級/16做
// 為索引在HalpVectorToIRQL數組中獲取對應的原先的IRQL然后返回。
// 若IRQL是從低于DISPATCH_LEVEL提升到高于DISPATCH_LEVEL，
// 還需要設置KPCR+0x95(0xffdff095)為DISPATCH_LEVEL(0x2)，
// 表示是從DISPATCH_LEVEL以下的級別提升IRQL。
// HalEndSystemInterrupt向本地APIC的EOI寄存發送0，表示中斷結束，
// 可以接收新中斷。并還要判斷要降到的IRQL是否小于DISPATCH_LEVEL，
// 若小于則進一步判斷KPCR+0x96(0xffdff096)是否置位，若置位則表示
// 有DPC中斷在等待(在IRQL高于DISPATCH_LEVEL被引發，然后等待直到IRQL降到
// 低于DISPATCH_LEVEL)，則將KPCR+0x95和KPCR+0x96清0后調用KiDispatchInterrupt響
// 應DPC軟中斷。否則做的工作就是和HalBeginSystemInterrupt一樣的過程：把要降到
// 的IRQL轉換成任務優先級設置TRP，并把久的任務優先級轉成IRQL返回。
// KfRaiseIrql、KfLowerIrql之類的函數也是這么一回事，把當前IRQL轉成任務優先
// 級修改TPR，并把原先TPR的值轉成原先的IRQL并返回。而現在軟中斷的產生也有
// 了APIC支持，APIC通過產生一個發向自己的處理器間中斷，就可以產生一個軟中斷，
// 因為可以指定該中斷的向量，所以軟中斷就可以區分優先級別，如APC_LEVEL、
// DISPATCH_LEVEL。產生軟中斷的函數一樣還是HalRequestSoftwareInterrupt，
// 該函數會先判斷KPCR+0x95是否和要產生的軟中斷IRQL一樣，若是的話則
// 置位KPCR+0x96并返回，表示現在IRQL大于DISPATCH_LEVEL所以不處理DPC中斷。
// 否則以要產生的軟中斷的IRQL為索引從HalpIRQLtoTPRHAL取出對應任務優先級，
// 并或上0x4000，表示是發向自身的固定處理間中斷，并用該值設置中斷命令
// 寄存器ICW的低32位，然后讀取中斷命令寄存器ICW的低32位是否為0x1000，確定
// 中斷消息已經發送后就返回，這時候軟中斷已經產生。值得注意的是APIC HAL里
// 沒有HalEndSoftwareInterrupt這個函數。
__declspec(dllimport) HalBeginSystemInterrupt( DWORD, KIRQL, PKIRQL);
__declspec(dllimport) HalEndSystemInterrupt( KIRQL, DWORD);
#define RET_BEGIN_END_INT if ( g_IntVector != 0x31) \
{ HalBeginSystemInterrupt( 9, g_Kirql, &NewIrql); \
HalEndSystemInterrupt( NewIrql, 0); \
return 0; \
}
__declspec (naked) Write64Port( BYTE code)
{
__asm
{
mov al,code
out 0x64,al
retn
}
}
__declspec (naked) Write60Port( BYTE code)
{
__asm
{
mov al,code
out 0x60,al
retn
}
}
BYTE Read64Port()
{
BYTE code;
__asm
{
in al,0x64
mov code,al
}
return code;
}
BYTE Read60Port()
{
BYTE code;
__asm
{
in al,0x60
mov code,al
}
return code;
}
void TestKBCIdl() //測試KBC輸入寄存器已空,無限延時.如果不空就循環等待..
{
int i=0;
__asm
{
LoopIfBusy:
xor al, al
in al, 0x64
add i, 1
and al, 2
jnz LoopIfBusy
}
}
void TestKBCOut() //測試KBC輸出寄存器非空
{
BYTE result;
int delay1=0x2710;
int delay2=0;
__asm
{
LoopNotNuLL:
xor al, al
in al, 0x64 //; AT Keyboard controller 8042.
add delay2, 1
sub delay1, 1
cmp delay1, 0
jz Over
test al, 1
loope LoopNotNuLL
Over:
mov result, al
}
}
void TestKBCIdlWithNumber() ////測試KBC輸入寄存器已空,在一定次數內測試...如果空就退出..
{
BYTE result;
int delay1=0xea60;
int delay2=0;
__asm
{
LoopIfBusy:
xor al, al
in al, 0x64 //; AT Keyboard controller 8042.
add delay2, 1
sub delay1, 1
cmp delay1, 0
jz Over
test al, 2
loopne LoopIfBusy
Over:
mov result, al
}
}
__declspec (naked) SaveDR7()
{
_asm
{
mov eax,dr7
mov g_DR7,eax
retn
}
}
__declspec (naked) WriteDR7_400H()
{
_asm
{
mov eax, 400h
mov dr7, eax
retn
}
}
__declspec (naked) ReLoadDR7()
{
_asm
{
mov eax, g_DR7
mov dr7, eax
retn
}
}
typedef struct _CODE_STRUCT_
{
char Ascii; //0x0
char r60; //0x1
char Reserved1; //0x2
char Reserved2; //0x3
}STRUCTCODE,*PSTRUCTCODE;
DWORD DispatchNewInt( DWORD param)
{
KIRQL NewIrql;
DWORD Number1,Number2,Number3,Number4,Number5,Number6,Number7,Number8,Number9,Number10;
DWORD Number11,Number12,Number13,Number14,Number15,Number16,Number17,Number18,Number19;
DWORD Dr7Tmp;
DWORD Var_2C,Var_34,Var_24;
STRUCTCODE Var_Code;
bool NotDr7_400H=false;
bool Input;
BYTE r64Port,r60Port;
if( g_IsMulProcesser)
{
// fs偏移51H處為當前運行的CPU??
__asm movzx eax, byte ptr fs:0x51;
__asm mov Number1, eax;
if ( Number1 == 0)
{
g_bAsm1 = true;
if ( g_bAsm2)
return g_KBIntEntry1;
}
else
{
__asm movzx eax, byte ptr fs:0x51;
__asm mov Number2, eax;
if ( Number2 == 1)
if( g_bAsm3)
return g_KBIntEntry2;
}
}
NewIrql = KfRaiseIrql( HIGH_LEVEL);
__asm mov eax, dr7;
__asm mov Dr7Tmp, eax;
if ( Dr7Tmp != 0x400)
NotDr7_400H = true;
if ( g_Buffer17H->Reserved3 == false)
g_Buffer17H->Reserved3 = NotDr7_400H;
if ( g_IsMulProcesser)
{
__asm movzx eax, byte ptr fs:0x51;
__asm mov Number3, eax;
if ( Number2 != 0)
if ( g_bAsm1)
{
KfLowerIrql( NewIrql);
return g_KBIntEntry2;
}
}
if ( g_bAsm1)
g_bAsm1 = false;
SaveDR7();
// 清除調試標記,清除全局斷點
WriteDR7_400H();
if ( !g_Buffer17H->Reserved6 && ! g_Buffer17H->Reserved11)
{
if ( g_Buffer17H->Reserved11)
{
TestKBCIdlWithNumber();
r64Port = Read64Port();
//最后一位為1表示輸出寄存器非空,?第5位為0表示數據源為鍵盤?
if ( ( r64Port&1 ) != 1 || ( r64Port&0x20 ) == 0x20)
{
// 輸出寄存器空 或者 數據源不為鍵盤
Var_2C = 0;
r60Port = Read60Port();
r64Port = Read64Port();
ReLoadDR7();
KfLowerIrql( NewIrql);
if( g_IsMulProcesser)
{
__asm movzx eax, byte ptr fs:0x51;
__asm mov Number4, eax;
if( Number4 == 0)
return g_KBIntEntry1;
else
return g_KBIntEntry2;
}
else
return g_KBIntEntry;
}
// else if( ( r64Port&1 ) == 1 && ( r64Port&0x20 ) == 0x20)
// {
// Var_34 = 0;
// r60Port = Read60Port();
// r64Port = Read64Port();
// ReLoadDR7();
// if( g_IsMulProcesser)
// {
// __asm movzx eax, byte ptr fs:0x51;
// __asm mov Number10, eax;
// }
// RET_BEGIN_END_INT;
// }
// 輸出寄存器非空 并且 數據源為鍵盤
r60Port = Read60Port();
if ( ( r60Port==0 ) || ( r60Port==0xfe ) )
{
// 為不處理的數據
ReLoadDR7();
KfLowerIrql( NewIrql);
if( g_IsMulProcesser)
{
__asm movzx eax, byte ptr fs:0x51;
__asm mov Number5, eax;
if( Number5 == 0)
return g_KBIntEntry1;
else
return g_KBIntEntry2;
}
else
return g_KBIntEntry;
}
// 到了這里直接跳出整個if語句,到達 g_IsNt4的比較
}
else
{
if ( g_DUnKnown1 == 0)
{
ReLoadDR7();
KfLowerIrql( NewIrql);
if( g_IsMulProcesser)
{
__asm movzx eax, byte ptr fs:0x51;
__asm mov Number6, eax;
if( Number6 == 0)
return g_KBIntEntry1;
else
return g_KBIntEntry2;
}
else
return g_KBIntEntry;
}
if ( g_Buffer12H->Reserved6 || g_Buffer12H->Reserved7)
{
ReLoadDR7();
KfLowerIrql( NewIrql);
if( g_IsMulProcesser)
{
__asm movzx eax, byte ptr fs:0x51;
__asm mov Number7, eax;
if( Number7 == 0)
return g_KBIntEntry1;
else
return g_KBIntEntry2;
}
else
return g_KBIntEntry;
}
if ( g_Buffer12H->bDoletter && g_Buffer12H->Reserved10 )
{
ReLoadDR7();
KfLowerIrql( NewIrql);
if( g_IsMulProcesser)
{
__asm movzx eax, byte ptr fs:0x51;
__asm mov Number8, eax;
if( Number8 == 0)
return g_KBIntEntry1;
else
return g_KBIntEntry2;
}
else
return g_KBIntEntry;
}
if ( g_Buffer12H->Reserved11)
{
ReLoadDR7();
KfLowerIrql( NewIrql);
if( g_IsMulProcesser)
{
__asm movzx eax, byte ptr fs:0x51;
__asm mov Number9, eax;
if( Number9 == 0)
return g_KBIntEntry1;
else
return g_KBIntEntry2;
}
else
return g_KBIntEntry;
}
TestKBCIdlWithNumber();
r64Port = Read64Port();
//最后一位為1表示輸出寄存器非空,?第5位為0表示數據源為鍵盤?
if ( ( r64Port&1 ) != 1 || ( r64Port&0x20 ) == 0x20 )
{
// 不空或者不是鍵盤
Var_34 = 0;
r60Port = Read60Port();
r64Port = Read64Port();
ReLoadDR7();
if( g_IsMulProcesser)
?? 快捷鍵說明
復制代碼
Ctrl + C
搜索代碼
Ctrl + F
全屏模式
F11
切換主題
Ctrl + Shift + D
顯示快捷鍵
?
增大字號
Ctrl + =
減小字號
Ctrl + -