Работа с мышью - исправить код

.386 ;определяем с командами какого процессора работаем
code segment 'code' ; определение кодового сегмента
assume cs:code,ds:code,es:code
оrg 100h ;резервируем 256 байт для PSP
Begin: jmp Start ;прыгаем через данные
BASE equ 3F8h ;базовый адрес порта COM1
Old0Co dw ? ;смещение старого обработчика 0Ch
Old0Cs dw ? ;сегмент старого обработчика 0Ch
Save0 dw ? ;старое значение регистра данных
Save1 db ? ;cтарое значение регистра управления прерываниями
Save3 db ? ;старое значение регистра управления линией
Save4 db ? ;старое значение регистра управления модемом
Maska db ? ;старое значение маски контролера прерываний
X dw 40 ;текущая координата Х
Y dw 12 ;текущая координата Y
Fix db 1 ;флаг фиксации курсора
Fbyte db ? ;первый байт пакета данных
198
OfsX db ? ;смещение по Х
OfsY db ? ;смещение по Y
Count db ? ;счетчик принятых байт в пакете
Buttons db 0 ;количество нажатых клавиш
;Стирает или восстанавливает курсор
XorPut proc
push es
pusha
; Вычисляем адрес байта видеопамяти в котором находится атрибут
; символа с координатами (X,Y) по формуле:
; адрес=0B800h:((Y*80)+X)*2+1
mov ax,0b800h ;в ax:=адрес начала видеопамяти
mov es,ax ;es:=ax
mov ax,Y ;ax:=Y
mov bx,160 ;bx:=80*2 (ширина экрана*2 байта)
mul bx ;ax:=Y*160
mov bx,X ;bx:=X
shl bx,1 ;bx:= bx *2
add ax,bx ;ax:=ax + bx
inc ax ;ax увеличим на 1
mov bx,ax ;bx:=ax
mov dl,byte ptr es:[bx] ;читаем атрибут по вычисл. адресу
xor dl,52 ;накладываем на него XOR-маску
mov byte ptr es:[bx],dl ;измененный атрибут в видеопамять
popa
pop es
ret
XorPut endp
; Обработчик 0Ch
Int_0Ch proc far
sti ;запрещаем аппаратные прерывания
push ds
pushf
pusha
push cs
pop ds ;ds:=cs
mov dx,BASE;в dx адрес базового порта для доступа к данным
in al,dx ;читаем очередной байт из регистра данных
test al,1000000b;если 6-ой бит равен 1,то это 1 байт пакета
jnz FirstByte ;это первый байт !
cmp Count,1 ;первый байт принят ?
je N2 ;да, принимаем второй.
jmp N3 ;иначе третий.
FirstByte: ;обработка первого принятого байта
mov Count,1 ;установим счетчик принятых байт
199
mov FByte,al ;сохраним первый принятый байт пакета
mov ah,al ;ah:=al
and al,00000011b ;устанавливаем старшие биты в OfsX
shl al,6
mov OfsX,al ;OfsX:=al
and ah,00001100b;устанавливаем старшие биты в OfsY
shl ah,4
mov OfsY,ah ;OfsY:=ah
jmp ExInt ;будем принимать остальные байты пакета
N2: ;обработка второго принятого байта
mov ah,OfsX ;ah:=OfsX
or ah,al ;устанавливаем младшие биты OfsX
mov OfsX,ah ;OfsX:=ah
mov Count,2 ;изменяем счетчик принятых байт
jmp ExInt ;будем принимать остальные байты пакета
N3: ;обработка третьего принятого байта
mov ah,OfsY ;ah:=Ofs
or ah,al ;устанавливаем младшие биты OfsY
mov OfsY,ah ;OfsY:=ah
;Наконец-то прочитали весь пакет, теперь его обработаем
call XorPut ;уберем курсор
cmp fix,1 ;курсор зафиксирован ?
je but ;да ! Переходим на анализ нажатых кнопок
mov al,OfsX ;al:=OfsX
cbw ;расширяем al до слова
add X,ax ;X=X+OfsX
mov al,OfsY ;al:=OfsY
cbw ;расширяем al до слова
add Y,ax ;Y=Y+OfsY
; Проверяем X и Y на предельные значения
cmp X,79 ;X ушел за правую границу экрана ?
jle NoR ;нет !
mov X,79 ;да ! Х:=79 (правая граница экрана)
jmp AY ;уходим на проверку Y
NoR: cmp X,0 ;X ушел за левую границу экрана ?
jns AY ;нет !
mov X,0 ;ушел ! X:=0
AY: cmp Y,24 ;Y ушел за нижнюю границу экрана ?
jle NoD ;нет !
mov Y,24 ;да ! Y:=24
jmp But ;идем на обработку кнопок
NoD: cmp Y,0 ;Y ушел за верхнюю границу экрана ?
jns But ;нет ! Идем на обработку кнопок
mov Y,0 ;да ! Y:=0
But: ;начинаем обработку нажатых кнопок
200
mov al,Fbyte ;берем первый байт пакета
mov Buttons,0 ;сбрасываем счетчик количества нажатых
кнопок
LB: test al,0100000b ;левая кнопка нажата ?
jz RB ;нет ! Смотрим правую.
mov fix,0 ;да ! Освобождаем мышь
inc Buttons ;Buttons увеличиваем на 1
RB: test al,0010000b;правая кнопка нажата ?
jz Analiz ;нет ! Идем дальше
mov fix,1 ;если нажата правая кнопка
inc Buttons ;увеличим Buttons на 1
Analiz: cmp Buttons,2 ;были нажаты обе кнопки ?
jne NoPress ;нет !
call XorPut ;стираем указатель
call UnInstall ;выгружаемся
NoPress:
call XorPut ;стираем указатель
ExInt: mov al,20h ;завершение аппаратного прерывания
out 20h,al
popa
popf
pop ds
iret
Int_0Ch endp
; Процедура восстановления старых значений портов и старого
; обработчика
UnInstall PROC
pusha
cli ;запрещаем аппаратные прерывания
mov dx,BASE+4 ;в dx адрес порта для доступа к р-ру
; управления модемом
mov al,Save4 ;в al =сохраненное значение регистра
out dx,al ;восстанавливаем исходное значение регистра
mov al,Maska ;в al - сохраненное значение маски
out 21h,al ;восстанавливаем исходное значение маски
mov dx,BASE+1 ;в dx - адрес порта для доступа к регистру
; управления прерываниями
mov al,Save1 ;в al - сохраненное значение регистра
out dx,al ;восстанавливаем исходное значение регистра
mov dx,BASE+3 ;в dx адрес порта для доступа к регистру
;управления линией
mov al,Save3 ;в al - сохраненное значение регистра
or al,80h ;установим DLAB = 1 для доступа
out dx,al ;к делителю частоты
mov dx,BASE ;в dx - адрес базового порта
201
mov ax,Save0 ;в ax - сохраненный делитель частоты
out dx,ax ;восстанавливаем значение делителя частоты
mov dx,BASE+3 ;в dx адрес порта для доступа к регистру
; управления линией
mov al,Save3 ;в al - сохраненное значение регистра
out dx,al ;восстанавливаем исходное значение регистра
push ds
mov ax,cs:Old0Cs;в ax - сегментный адрес старой ПОП
mov ds,ax ;ds:= ax
mov dx,cs:Old0Co ;в dx - смещение старого обработчика
mov ax,250Ch ;установим старый обработчик прерывания 0Ch
int 21h ;восстанавливаем старый обработчик
pop ds
sti ;разрешаем аппаратные прерывания
popa
ret
UnInstall ENDP
Start: cli ;запрещаем аппаратные прерывания
mov ax,350Ch ;ah=35h для выдачи адреса ПОП 0Ch
int 21h ;получаем адрес вектора прерывания 0Ch
mov Old0Cs,es ;сохраняем сегм. адрес старого обработчика
mov Old0Co,bx ;сохраняем смещение старого обработчика
lea dx,Int_0Ch;в dx адрес нового обработчика
mov ax,250Ch ;ah=25h для установки адреса обработчика
; прерывания 0Ch
int 21h ;установим свой обработчик
; Начинаем инициализацию мышки
mov dx,BASE+3 ;в dx адрес порта для доступа к регистру
; управления линией
in al,dx ;читаем содержимое регистра
mov Save3,al ;сохраняем его
or al,80h ;установим DLAB = 1 для доступа
out dx,al ;к делителю частоты
mov dx,BASE ;в dx - адрес базового порта
in ax,dx ;читаем регистр младшего байта делителя
mov Save0,ax ;частоты и сохраняем его
mov ax,60h ;делитель частоты=115200/1200=60h - 1200 бод
out dx,ax ;устанавливаем делитель частоты
mov dx,BASE+3 ;в dx адрес порта для доступа к регистру
; управления линией
mov al,00000010b ;установим структуру сигнала
out dx,al ;7 информационных бит,1 стоп-бит
mov dx,BASE+1 ;в dx адрес порта для доступа к регистру
; управления прерываниями
in al,dx ;читаем содержимое регистра
202
mov Save1,al ;сохраняем его
mov al,00000001b ;разрешаем генерацию прерывания по
out dx,al ;готовности принимаемых данных
in al,21h ;читаем маску контролера прерываний
mov Maska,al ;сохраняем маску
and al,11101111b ;размаскируем линию IRQ4
out 21h,al ;меняем маску
mov dx,BASE+4 ;в dx адрес порта для доступа к регистру
; управления модемом
in al,dx ;читаем содержимое регистра
mov Save4,al ;сохраняем его
mov al,00000001b ;установим сигнал на линии DTR
out dx,al ;заносим в регистр
mov al,00000011b ;установим сигнал на линиях DTR и RTS
out dx,al ; заносим в регистр
mov al,00001011b ;установим сигнал на линиях DTR, RTS и
OUT2
out dx,al ;заносим в регистр
sti ;разрешаем аппаратные прерывания
int 27h ;остаемся резидентными
code ends
end begin

.386
.model flat, stdcall
option casemap:none
ExitProcess proto:dword
GetStdHandle proto:dword
WriteConsoleA proto:dword, :dword, :dword, :dword, :dword
ExitProcess proto:dword
includelib C:\masm\lib\kernel32.lib
.data
stdout dword ?
msg byte "Не могу молчать!", 13, 10
cWritten dword ?
.code
start:
    invoke GetStdHandle, -11
    mov stdout, eax
    invoke WriteConsoleA, stdout, addr msg, sizeof msg, addr cWritten, 0
    invoke ExitProcess, 0
end start

; РАЗРЕШИТЬ ПЕРЕДАЧУ ДАННЫХ ОТ МЫШИ
        call    Wait8042BufferEmpty
        mov     AL,0D4h ;послать мыши байт данных
        out     64h,AL
        call    Wait8042BufferEmpty
        mov     AL,0F4h ;разрешить передачу данных
        out     60h,AL
; Получить код подтверждения приема команды
        call    WaitMouseData
        jz      @@DataInputError ;данные не поступили
        in      AL,60h
        ; Получено подтверждение приема команды?
        cmp     AL,0FAh          
        jnz     @@DataInputError ;нет подтверждения