136 lines
2.6 KiB
C
136 lines
2.6 KiB
C
|
#include "types.h"
|
|||
|
|
#include "asm.h"
|
|||
|
|
#include "mouse.h"
|
|||
|
|
#include "keyboard.h"
|
|||
|
|
#include "vga.h"
|
|||
|
|
#include "video.h"
|
|||
|
|
|
|||
|
|
bool initmouse()
|
|||
|
|
{
|
|||
|
|
u16 i=1024;
|
|||
|
|
|
|||
|
|
outkbd(0x64,0xA8); /* autoris<69> Aux */
|
|||
|
|
|
|||
|
|
outmseack(0xf3); /*sample*/
|
|||
|
|
outmseack(100); /*sample donn<6E>e*/
|
|||
|
|
|
|||
|
|
outmseack(0xe8); /*resolution*/
|
|||
|
|
outmseack(3); /*resolution donn<6E>e*/
|
|||
|
|
|
|||
|
|
outmseack(0xe7); /* echelle 2:1*/
|
|||
|
|
|
|||
|
|
outmseack(0xf4); /* Autorise peripherique */
|
|||
|
|
|
|||
|
|
outmsecmd(0x47); /* Autorise interruption */
|
|||
|
|
|
|||
|
|
while(i-->0) if (inb(0x60)==250) return 1;
|
|||
|
|
return 0;
|
|||
|
|
}
|
|||
|
|
|
|||
|
|
static u8 bytepos=0,mousereplies=0;
|
|||
|
|
static u8 mpacket[3];
|
|||
|
|
static s32 mousex=40, mousey=12;
|
|||
|
|
static u16 oldx=0, oldy=0;
|
|||
|
|
static u8 oldchar=0x00,oldattr=0x07;
|
|||
|
|
static bool mousebut1=0,mousebut2=0,mousebut3=0;
|
|||
|
|
static u8 speed=6;
|
|||
|
|
|
|||
|
|
|
|||
|
|
void outmseack(u8 value)
|
|||
|
|
{
|
|||
|
|
outkbd(0x64,0xD4); /* ecriture vers souris */
|
|||
|
|
outb(0x60,value);
|
|||
|
|
mousereplies++;
|
|||
|
|
}
|
|||
|
|
|
|||
|
|
void outmsecmd(u8 command)
|
|||
|
|
{
|
|||
|
|
outkbd(0x64,0x60); /* ecriture vers mode */
|
|||
|
|
outb(0x60,command);
|
|||
|
|
}
|
|||
|
|
|
|||
|
|
void mouse()
|
|||
|
|
{
|
|||
|
|
u8 mbyte=inb(0x60);
|
|||
|
|
s8 changex,changey;
|
|||
|
|
cli();
|
|||
|
|
|
|||
|
|
if (mousereplies > 0)
|
|||
|
|
{
|
|||
|
|
if (mbyte == 0xFA)
|
|||
|
|
{
|
|||
|
|
mousereplies--;
|
|||
|
|
goto endofint;
|
|||
|
|
}
|
|||
|
|
mousereplies = 0;
|
|||
|
|
}
|
|||
|
|
|
|||
|
|
mpacket[bytepos]=mbyte;
|
|||
|
|
bytepos++;
|
|||
|
|
|
|||
|
|
if(bytepos==3) {
|
|||
|
|
bytepos=0;
|
|||
|
|
if ( mpacket[1] == 0)
|
|||
|
|
{
|
|||
|
|
changex = 0;
|
|||
|
|
}
|
|||
|
|
else
|
|||
|
|
{
|
|||
|
|
changex = (mpacket[0] & 0x10) ?
|
|||
|
|
mpacket[1] - 256 :
|
|||
|
|
mpacket[1];
|
|||
|
|
}
|
|||
|
|
if (mpacket[2] == 0)
|
|||
|
|
{
|
|||
|
|
changey = 0;
|
|||
|
|
}
|
|||
|
|
else
|
|||
|
|
{
|
|||
|
|
changey = -((mpacket[0] & 0x20) ?
|
|||
|
|
mpacket[2] - 256 :
|
|||
|
|
mpacket[2]);
|
|||
|
|
}
|
|||
|
|
|
|||
|
|
mousex+= (changex<<speed);
|
|||
|
|
mousey+= (changey<<speed);
|
|||
|
|
|
|||
|
|
if(mousex<0) { mousex=0; }
|
|||
|
|
if(mousex>=65535) { mousex=65535; }
|
|||
|
|
if(mousey<0) { mousey=0; }
|
|||
|
|
if(mousey>=65535) { mousey=65535; }
|
|||
|
|
|
|||
|
|
u16 newx=(u32)mousex*getxres()/65536;
|
|||
|
|
u16 newy=(u32)mousey*getyres()/65536;
|
|||
|
|
|
|||
|
|
// Retrieve mouse button status from packet
|
|||
|
|
mousebut1=mpacket[0] & 1;
|
|||
|
|
mousebut2=mpacket[0] & 2;
|
|||
|
|
mousebut3=mpacket[0] & 4;
|
|||
|
|
|
|||
|
|
// printf("RX:%d\tRY:%d\tX:%d\tY:%d\tB1:%d\tB2:%d\tB3:%d\t\r\n",changex,changey,mousex,mousey,mousebut1,mousebut2,mousebut3);
|
|||
|
|
|
|||
|
|
if ((newx!=oldx)||(newy!=oldy))
|
|||
|
|
{
|
|||
|
|
showchar(oldx,oldy,oldchar,oldattr);
|
|||
|
|
oldx=newx;
|
|||
|
|
oldy=newy;
|
|||
|
|
oldchar=getchar(oldx,oldy);
|
|||
|
|
oldattr=getattrib(oldx,oldy);
|
|||
|
|
showchar(newx,newy,0xDB,0x0F);
|
|||
|
|
}
|
|||
|
|
}
|
|||
|
|
endofint:
|
|||
|
|
irqendmaster();
|
|||
|
|
irqendslave();
|
|||
|
|
sti();
|
|||
|
|
//asm("movl 0x2C(%esp), %ebx;movl 0x30(%esp), %esi;movl 0x34(%esp), %edi;movl 0x38(%esp), %ebp;addl $0x3C, %esp;iret;");
|
|||
|
|
asm("addl $0x18, %esp;popl %ebx;iret;");
|
|||
|
|
}
|
|||
|
|
|
|||
|
|
|
|||
|
|
|
|||
|
|
|
|||
|
|
|
|||
|
|
|
|||
|
|
|