/* まうす */

#include "bootpack.h"

struct FIFO32 *mousefifo;
int mousedata0;

void inthandler2c(int *esp)
/* PS/2マウスからの割り込み */
{
	int data;
	io_out8(PIC1_OCW2, 0x64);	/* IRQ-12受付完了をPICに通知 */
	io_out8(PIC0_OCW2, 0x62);	/* IRQ-02受付完了をPICに通知 */
	data = io_in8(PORT_KEYDAT);
	fifo32_put(mousefifo, data + mousedata0);
	return;
}

#define KEYCMD_SENDTO_MOUSE		0xd4
#define MOUSECMD_ENABLE			0xf4

void enable_mouse(struct FIFO32 *fifo, int data0, struct MOUSE_DEC *mdec)
{
	/* 書き込み先のFIFOバッファを記憶 */
	mousefifo = fifo;
	mousedata0 = data0;
	/* マウス有効 */
	wait_KBC_sendready();
	io_out8(PORT_KEYCMD, KEYCMD_SENDTO_MOUSE);
	wait_KBC_sendready();
	io_out8(PORT_KEYDAT, MOUSECMD_ENABLE);
	mdec->phase = 0;
	return; /* うまくいくとACK(0xfa)が送信されてくる */
}

int mouse_decode(struct MOUSE_DEC *mdec, unsigned char dat)
{
	if (mdec->phase == 0) {
		/* ACK(0xfa)待ち */
		if (dat == 0xfa)
			mdec->phase++;
	} else {
		/* マウスの1,2,3バイト目をそれぞれ順番に待っている */
		mdec->buf[mdec->phase - 1] = dat;
		if (mdec->phase == 1) {
			/* マウスの1バイト目の時のみ */
			if ((mdec->buf[0] & 0xc8) != 0x08)
				mdec->phase--;	// hrib05bの（先行）取り消し法バージョン
		}
		if (mdec->phase == 3) {
			/* マウスの3バイト目の時のみ */
			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;
			mdec->y = - mdec->y; /* マウスはy方向の符号が画面と逆 */
			return 1;
		}
		mdec->phase++;
	}
	return 0;
}
