git-svn-id: https://spexeah.com:8443/svn/Asuro@527 6dbc8c32-bb84-406f-8558-d1cf31a0ab0c
This commit is contained in:
kieron
@ -15,9 +15,9 @@ uses
|
||||
tracer,
|
||||
console,
|
||||
util,
|
||||
PS2_MOUSE_ISR,
|
||||
lmemorymanager,
|
||||
strings,
|
||||
isrmanager,
|
||||
drivermanagement;
|
||||
|
||||
type
|
||||
@ -34,85 +34,177 @@ type
|
||||
LMB_Down : Boolean;
|
||||
end;
|
||||
|
||||
TMousePos = record
|
||||
x : sint32;
|
||||
y : sint32;
|
||||
end;
|
||||
|
||||
procedure init();
|
||||
|
||||
implementation
|
||||
|
||||
procedure callback(raw : void);
|
||||
var
|
||||
packet : PMousePacket;
|
||||
Current, Last : TMousePos;
|
||||
FirstDraw : boolean = true;
|
||||
BackPixels : Array[0..1] of Array[0..1] of uint16;
|
||||
Cycle : uint32 = 0;
|
||||
Mouse_Byte : Array[0..2] of uint8;
|
||||
Packet : uint32;
|
||||
Registered : Boolean = false;
|
||||
|
||||
procedure DrawCursor;
|
||||
var
|
||||
x, y : uint32;
|
||||
|
||||
begin
|
||||
if not FirstDraw then begin
|
||||
for y:=0 to 1 do begin
|
||||
for x:=0 to 1 do begin
|
||||
DrawPixel(Last.x + x, Last.y + y, BackPixels[x][y]);
|
||||
end;
|
||||
end;
|
||||
end;
|
||||
Last.x:= Current.x;
|
||||
Last.y:= Current.y;
|
||||
for y:=0 to 1 do begin
|
||||
for x:=0 to 1 do begin
|
||||
BackPixels[x][y]:= GetPixel(Current.x + x, Current.y + y);
|
||||
DrawPixel(Current.x + x, Current.y + y, $FFFF);
|
||||
end;
|
||||
end;
|
||||
FirstDraw:= false;
|
||||
end;
|
||||
|
||||
procedure mouse_wait(w_type : uint8);
|
||||
var
|
||||
timeout : uint32;
|
||||
|
||||
begin
|
||||
timeout:= 100000;
|
||||
if (w_type = 0) then begin
|
||||
while (timeout > 0) do begin
|
||||
if ((inb($64) AND $01) = $01) then break;
|
||||
timeout:= timeout-1;
|
||||
end;
|
||||
end else begin
|
||||
while (timeout > 0) do begin
|
||||
if ((inb($64) AND 2) = 0) then break;
|
||||
timeout := timeout - 1;
|
||||
end;
|
||||
end;
|
||||
end;
|
||||
|
||||
procedure mouse_write(value : uint8);
|
||||
begin
|
||||
mouse_wait(1);
|
||||
outb($64, $D4);
|
||||
mouse_wait(1);
|
||||
outb($60, value);
|
||||
end;
|
||||
|
||||
function mouse_read : uint8;
|
||||
begin
|
||||
mouse_wait(0);
|
||||
mouse_read:= inb($60);
|
||||
end;
|
||||
|
||||
procedure main();
|
||||
var
|
||||
i : integer;
|
||||
b : byte;
|
||||
packet : TMousePacket;
|
||||
x, y, f : byte;
|
||||
x32, y32 : sint32;
|
||||
r : pchar;
|
||||
|
||||
begin
|
||||
push_trace('mouse.callback');
|
||||
packet:= PMousePacket(kalloc(sizeof(TMousePacket)));
|
||||
f:= (uint32(raw) AND $FF000000) SHR 24;
|
||||
x:= (uint32(raw) AND $00FF0000) SHR 16;
|
||||
y:= (uint32(raw) AND $0000FF00) SHR 8;
|
||||
packet^.x_movement:= x;
|
||||
packet^.y_movement:= y;
|
||||
packet^.y_overflow:= (f AND $80) = $80;
|
||||
packet^.x_overflow:= (f AND $40) = $40;
|
||||
packet^.y_sign:= (f AND $20) = $20;
|
||||
packet^.x_sign:= (f AND $10) = $10;
|
||||
packet^.MMB_Down:= (f AND $4) = $4;
|
||||
packet^.RMB_Down:= (f AND $2) = $2;
|
||||
packet^.LMB_Down:= (f AND $1) = $1;
|
||||
//Do Hook here
|
||||
// console.writestring('X Movement: ');
|
||||
// console.writeintln(packet^.x_movement);
|
||||
push_trace('mouse.main');
|
||||
b:= mouse_read;
|
||||
if Cycle = 0 then begin
|
||||
if (b AND $08) = $08 then begin
|
||||
Mouse_Byte[Cycle]:= b;
|
||||
Inc(Cycle);
|
||||
end;
|
||||
end else begin
|
||||
If Cycle = 1 then begin
|
||||
Mouse_Byte[Cycle]:= b;
|
||||
Inc(Cycle);
|
||||
end else begin
|
||||
Mouse_Byte[Cycle]:= b;
|
||||
Inc(Cycle);
|
||||
end;
|
||||
end;
|
||||
if Cycle = 3 then begin
|
||||
//Process
|
||||
f:= Mouse_Byte[0];
|
||||
Packet.x_movement:= Mouse_Byte[1];
|
||||
Packet.y_movement:= Mouse_Byte[2];
|
||||
Packet.x_sign:= (f AND $10) = $10;
|
||||
Packet.y_sign:= (f AND $20) = $20;
|
||||
Packet.x_overflow:= (f AND $40) = $40;
|
||||
Packet.y_overflow:= (f AND $80) = $80;
|
||||
if not(Packet.x_overflow) and not(Packet.y_overflow) then begin
|
||||
//if Packet.x_sign then Current.x:= Current.x - Packet.x_movement else Current.x:= Current.x + Packet.x_movement;
|
||||
//if Packet.y_sign then Current.y:= Current.y - Packet.y_movement else Current.y:= Current.y + Packet.y_movement;
|
||||
x32:= Packet.x_movement;
|
||||
if Packet.x_sign then x32:= x32 OR $FFFFFF00;
|
||||
y32:= Packet.y_movement;
|
||||
if Packet.y_sign then y32:= y32 OR $FFFFFF00;
|
||||
if x32 <> 0 then begin
|
||||
if x32 > 0 then begin
|
||||
inc(Current.x);
|
||||
end else begin
|
||||
Dec(Current.x);
|
||||
end;
|
||||
end;
|
||||
if y32 <> 0 then begin
|
||||
if y32 > 0 then begin
|
||||
inc(Current.y);
|
||||
end else begin
|
||||
dec(Current.y)
|
||||
end;
|
||||
end;
|
||||
if Current.x < 0 then Current.x:= 0;
|
||||
if Current.y < 0 then Current.y:= 0;
|
||||
if Current.x > 1279 then Current.x:= 1279;
|
||||
if Current.y > 1023 then Current.y:= 1023;
|
||||
end;
|
||||
{console.writestring('Packet[0]: ');
|
||||
console.writeintln(Mouse_Byte[0]);
|
||||
console.writestring('Packet[1]: ');
|
||||
console.writeintln(Mouse_Byte[1]);
|
||||
console.writestring('Packet[2]: ');
|
||||
console.writeintln(Mouse_Byte[2]);}
|
||||
Cycle:= 0;
|
||||
|
||||
// console.writestring('Y Movement: ');
|
||||
// console.writeintln(packet^.y_movement);
|
||||
|
||||
// console.writestring('Y Overflow: ');
|
||||
// r:= boolToString(packet^.y_overflow, true);
|
||||
// console.writestringln(r);
|
||||
// kfree(void(r));
|
||||
|
||||
// console.writestring('X Overflow: ');
|
||||
// r:= boolToString(packet^.x_overflow, true);
|
||||
// console.writestringln(r);
|
||||
// kfree(void(r));
|
||||
|
||||
// console.writestring('Y Sign: ');
|
||||
// r:= boolToString(packet^.y_sign, true);
|
||||
// console.writestringln(r);
|
||||
// kfree(void(r));
|
||||
|
||||
// console.writestring('X Sign: ');
|
||||
// r:= boolToString(packet^.x_sign, true);
|
||||
// console.writestringln(r);
|
||||
// kfree(void(r));
|
||||
|
||||
// console.writestring('Middle Button Down: ');
|
||||
// r:= boolToString(packet^.MMB_Down, true);
|
||||
// console.writestringln(r);
|
||||
// kfree(void(r));
|
||||
|
||||
// console.writestring('Right Button Down: ');
|
||||
// r:= boolToString(packet^.RMB_Down, true);
|
||||
// console.writestringln(r);
|
||||
// kfree(void(r));
|
||||
|
||||
// console.writestring('Left Button Down: ');
|
||||
// r:= boolToString(packet^.LMB_Down, true);
|
||||
// console.writestringln(r);
|
||||
// kfree(void(r));
|
||||
|
||||
kfree(void(packet));
|
||||
//console.writestring('Mouse Packet: ');
|
||||
//console.writehexln(DWORD(raw));
|
||||
DrawCursor;
|
||||
end;
|
||||
pop_trace;
|
||||
end;
|
||||
|
||||
function load(ptr : void) : boolean;
|
||||
var
|
||||
status : uint8;
|
||||
begin
|
||||
push_trace('mouse.load');
|
||||
PS2_MOUSE_ISR.register();
|
||||
PS2_MOUSE_ISR.hook(uint32(@callback));
|
||||
console.outputln('PS/2 MOUSE', 'LOADED.');
|
||||
mouse_wait(1);
|
||||
outb($64, $A8);
|
||||
mouse_wait(1);
|
||||
outb($64, $20);
|
||||
mouse_wait(0);
|
||||
status:= inb($60) OR $02;
|
||||
mouse_wait(1);
|
||||
outb($64, $60);
|
||||
mouse_wait(1);
|
||||
outb($60, status);
|
||||
mouse_write($F6);
|
||||
mouse_read();
|
||||
mouse_write($F4);
|
||||
mouse_read();
|
||||
isrmanager.registerISR(44, @Main);
|
||||
console.outputln('PS/2 MOUSE', 'LOADED.');
|
||||
console.output('PS/2 MOUSE', 'Memory: ');
|
||||
console.writehexln(uint32(@current));
|
||||
load:= true;
|
||||
pop_trace;
|
||||
end;
|
||||
@ -131,6 +223,10 @@ begin
|
||||
devid.id3:= 0;
|
||||
devid.id4:= 0;
|
||||
devid.ex:= nil;
|
||||
Current.x:= 0;
|
||||
Current.y:= 0;
|
||||
Last.x:= 0;
|
||||
Last.y:= 0;
|
||||
drivermanagement.register_driver_ex('PS/2 Mouse', @devid, @load, true);
|
||||
console.outputln('PS/2 MOUSE', 'INIT END.');
|
||||
pop_trace;
|
||||
|
||||
@ -101,6 +101,8 @@ begin
|
||||
outb($71, prev OR $40);
|
||||
STI;
|
||||
outb($70, $00);
|
||||
inb($71);
|
||||
|
||||
isrmanager.registerISR(32 + 8, @update);
|
||||
//TMR_0_ISR.hook(uint32(@update));
|
||||
end;
|
||||
|
||||
Reference in New Issue
Block a user