鼠标解读（2）

08_day/bootpack.c

@@ -4,14 +4,21 @@
 #include <stdio.h>
 
 extern struct FIFO8 keyfifo, mousefifo;
-void enable_mouse(void);
+
+struct MOUSE_DEC {
+	unsigned char buf[3], phase;
+	int x, y, btn;
+};
+
+void enable_mouse(struct MOUSE_DEC *mdec);
+int mouse_decode(struct MOUSE_DEC *mdec, unsigned char dat);
 void init_keyboard(void);
 
 void HariMain(void)
 {
 	struct BOOTINFO *binfo = (struct BOOTINFO *) ADR_BOOTINFO;
+	struct MOUSE_DEC mdec; 
 	char s[40], mcursor[256], keybuf[32], mousebuf[128];
-	unsigned char mouse_dbuf[3], mouse_phase;
 	int mx, my, i;
 
 	init_gdtidt();
@@ -34,8 +41,7 @@ void HariMain(void)
 	sprintf(s, "(%d, %d)", mx, my);
 	putfonts8_asc(binfo->vram, binfo->scrnx, 0, 0, COL8_FFFFFF, s);
 
-	enable_mouse();
-	mouse_phase = 0; /* 进入到等待鼠标的0xfa的状态 */
+	enable_mouse(&mdec);
 
 	for (;;) {
 		io_cli();
@@ -51,39 +57,32 @@ void HariMain(void)
 			} else if (fifo8_status(&mousefifo) != 0) {
 				i = fifo8_get(&mousefifo);
 				io_sti();
-				if (mouse_phase == 0) {                
-					/* 等待鼠标的0xfa的状态 */
-					if (i == 0xfa) {                    
-						mouse_phase = 1;                
-					}            
-				} else if (mouse_phase == 1) {                
-					/* 等待鼠标的第一字节 */                
-					mouse_dbuf[0] = i;                
-					mouse_phase = 2;            
-				} else if (mouse_phase == 2) {                
-					/* 等待鼠标的第二字节 */                
-					mouse_dbuf[1] = i;                
-					mouse_phase = 3;            
-				} else if (mouse_phase == 3) {                
-					/* 等待鼠标的第三字节 */                
-					mouse_dbuf[2] = i;                
-					mouse_phase = 1;                
-					/* 鼠标的3个字节都齐了，显示出来 */                
-					sprintf(s, "%02X %02X %02X", mouse_dbuf[0], mouse_dbuf[1], mouse_dbuf[2]);                
-					boxfill8(binfo->vram, binfo->scrnx, COL8_008484, 32, 16, 32 + 8 * 8 - 1, 31);
+				if (mouse_decode(&mdec, i) != 0) {
+					 /* 3字节都凑齐了，所以把它们显示出来*/
+					sprintf(s, "[lcr %4d %4d]", mdec.x, mdec.y);
+					if ((mdec.btn & 0x01) != 0) {
+						s[1] = 'L';
+					}
+					if ((mdec.btn & 0x02) != 0) {
+						s[3] = 'R';
+					}
+					if ((mdec.btn & 0x04) != 0) {
+						s[2] = 'C';
+					}
+					boxfill8(binfo->vram, binfo->scrnx, COL8_008484, 32, 16, 32 + 15 * 8 - 1, 31);
 					putfonts8_asc(binfo->vram, binfo->scrnx, 32, 16, COL8_FFFFFF, s);
-			 	}        
-			}    
+				}
+			}
 		}
 	}
 }
 
-#define PORT_KEYDAT				0x0060
-#define PORT_KEYSTA				0x0064
-#define PORT_KEYCMD				0x0064
-#define KEYSTA_SEND_NOTREADY	0x02
-#define KEYCMD_WRITE_MODE		0x60
-#define KBC_MODE				0x47
+#define PORT_KEYDAT       0x0060
+#define PORT_KEYSTA       0x0064
+#define PORT_KEYCMD       0x0064
+#define KEYSTA_SEND_NOTREADY  0x02
+#define KEYCMD_WRITE_MODE   0x60
+#define KBC_MODE        0x47
 
 void wait_KBC_sendready(void)
 {
@@ -106,15 +105,57 @@ void init_keyboard(void)
 	return;
 }
 
-#define KEYCMD_SENDTO_MOUSE		0xd4
-#define MOUSECMD_ENABLE			0xf4
+#define KEYCMD_SENDTO_MOUSE   0xd4
+#define MOUSECMD_ENABLE     0xf4
 
-void enable_mouse(void)
-{
-	/* 激活鼠标 */
+void enable_mouse(struct MOUSE_DEC *mdec){
+	/* 鼠标有效 */
 	wait_KBC_sendready();
 	io_out8(PORT_KEYCMD, KEYCMD_SENDTO_MOUSE);
 	wait_KBC_sendready();
 	io_out8(PORT_KEYDAT, MOUSECMD_ENABLE);
-	return; /* 顺利的话，键盘控制器会返回ACK(0xfa) */
-}
+	/* 顺利的话，ACK(0xfa)会被送过来 */
+	mdec->phase = 0; /* 等待0xfa的阶段 */    
+	return;
+}
+
+int mouse_decode(struct MOUSE_DEC *mdec, unsigned char dat){
+	if (mdec->phase == 0) {
+		/* 等待鼠标的0xfa的阶段 */
+		if (dat == 0xfa) {
+			mdec->phase = 1;
+		}        
+		return 0;
+	}
+	if (mdec->phase == 1) {
+		/* 等待鼠标第一字节的阶段 */
+		mdec->buf[0] = dat;
+		mdec->phase = 2;
+		return 0;
+	}
+	if (mdec->phase == 2) {
+		/* 等待鼠标第二字节的阶段 */
+		mdec->buf[1] = dat;
+		mdec->phase = 3;
+		return 0;
+	}
+	if (mdec->phase == 3) {
+		/* 等待鼠标第二字节的阶段 */
+		mdec->buf[2] = dat;
+		mdec->phase = 1;
+		mdec->btn = mdec->buf[0] & 0x07;
+		mdec->x = mdec->buf[1];
+		mdec->y = mdec->buf[2];
+		if ((mdec->buf[0] & 0x10) != 0) {
+			mdec->x |= 0xffffff00;
+		}
+		if ((mdec->buf[0] & 0x20) != 0) {
+			mdec->y |= 0xffffff00;
+		}     
+		/* 鼠标的y方向与画面符号相反 */   
+		mdec->y = - mdec->y; 
+		return 1;
+	}
+	/* 应该不可能到这里来 */
+	return -1; 
+}