Subversion Repositories Kolibri OS

; in: ebx -> usb_device_data, edi -> collection

; in: ebx -> usb_device_data, edi -> collection

; out: eax = device-specific data or NULL on error

; out: eax = device-specific data or NULL on error

proc keyboard_driver_add_device

proc keyboard_driver_add_device

; 1. Allocate memory for keyboard_device_data. If failed, return NULL.

; 1. Allocate memory for keyboard_device_data. If failed, return NULL.

        movi    eax, sizeof.keyboard_device_data

        movi    eax, sizeof.keyboard_device_data

        test    eax, eax

        test    eax, eax

        jz      .nothing

        jz      .nothing

; 2. Initialize keyboard_device_data: store pointer to USB layer data,

; 2. Initialize keyboard_device_data: store pointer to USB layer data,

; zero some fields, initialize bit positions to -1.

; zero some fields, initialize bit positions to -1.

        mov     [eax+keyboard_device_data.usbdev], ebx

        mov     [eax+keyboard_device_data.usbdev], ebx

        pop     esi ebx

        pop     esi ebx

; 4. Register keyboard in the kernel.

; 4. Register keyboard in the kernel.

; store pointer to keyboard_device_data in the stack

; store pointer to keyboard_device_data in the stack

        push    eax

        push    eax

; call kernel API

; call kernel API

; restore pointer to keyboard_device_data from the stack,

; restore pointer to keyboard_device_data from the stack,

; putting keyboard handle from API to the stack

; putting keyboard handle from API to the stack

        xchg    eax, [esp]

        xchg    eax, [esp]

; put keyboard handle from API from the stack to keyboard_device_data field

; put keyboard handle from API from the stack to keyboard_device_data field

        pop     [eax+keyboard_device_data.handle]

        pop     [eax+keyboard_device_data.handle]

        jz      .fail_free

        jz      .fail_free

; 5. Return pointer to keyboard_device_data.

; 5. Return pointer to keyboard_device_data.

.nothing:

.nothing:

        ret

        ret

.fail_free:

.fail_free:

        xor     eax, eax

        xor     eax, eax

        ret

        ret

endp

endp

; in: edi -> keyboard_device_data (pointer returned from keyboard_driver_add_device)

; in: edi -> keyboard_device_data (pointer returned from keyboard_driver_add_device)

proc keyboard_driver_disconnect

proc keyboard_driver_disconnect

; 1. If an autorepeat timer is active, stop it.

; 1. If an autorepeat timer is active, stop it.

        cmp     [edi+keyboard_device_data.timer], 0

        cmp     [edi+keyboard_device_data.timer], 0

        jz      @f

        jz      @f

@@:

@@:

; 2. Unregister keyboard in the kernel.

; 2. Unregister keyboard in the kernel.

; We should free data in CloseKeyboard, not here.

; We should free data in CloseKeyboard, not here.

        ret

        ret

endp

endp

        call    .send_key

        call    .send_key

; 1g. Stop the previous autorepeat timer, if any.

; 1g. Stop the previous autorepeat timer, if any.

        mov     eax, [edi+keyboard_device_data.timer]

        mov     eax, [edi+keyboard_device_data.timer]

        test    eax, eax

        test    eax, eax

        jz      @f

        jz      @f

@@:

@@:

; 1h. Start the new autorepeat timer with 250 ms initial delay

; 1h. Start the new autorepeat timer with 250 ms initial delay

; and 50 ms subsequent delays.

; and 50 ms subsequent delays.

        mov     [edi+keyboard_device_data.timer], eax

        mov     [edi+keyboard_device_data.timer], eax

if ~HID_DUMP_UNCLAIMED

if ~HID_DUMP_UNCLAIMED

.unclaimed:

.unclaimed:

end if

end if

        ret

        ret

        push    ecx

        push    ecx

        mov     [edi+keyboard_device_data.repeatkey], 0

        mov     [edi+keyboard_device_data.repeatkey], 0

        mov     eax, [edi+keyboard_device_data.timer]

        mov     eax, [edi+keyboard_device_data.timer]

        test    eax, eax

        test    eax, eax

        jz      @f

        jz      @f

        mov     [edi+keyboard_device_data.timer], 0

        mov     [edi+keyboard_device_data.timer], 0

@@:

@@:

        pop     ecx

        pop     ecx

.no_stop_timer:

.no_stop_timer:

; 1j. Copy bit 7 to CF and send scancode with bit 7 set.

; 1j. Copy bit 7 to CF and send scancode with bit 7 set.

; If CF is set, precede it with special code 0xE0.

; If CF is set, precede it with special code 0xE0.

.send_key:

.send_key:

        jnc     @f

        jnc     @f

        push    ecx

        push    ecx

        mov     ecx, 0xE0

        mov     ecx, 0xE0

        pop     ecx

        pop     ecx

@@:

@@:

        ret

        ret

endp

endp

; This procedure is called when HID layer ends processing a new input packet

; This procedure is called when HID layer ends processing a new input packet

virtual at esp

virtual at esp

                dd      ?       ; return address

                dd      ?       ; return address

.device_data    dd      ?

.device_data    dd      ?

end virtual

end virtual

        mov     eax, [.device_data]

        mov     eax, [.device_data]

        ret     4

        ret     4

endp

endp

; This function is called from the keyboard layer

; This function is called from the keyboard layer

; Dword-align size for subsequent rep stosd and bts.

; Dword-align size for subsequent rep stosd and bts.

; If failed, exit from the function.

; If failed, exit from the function.

        add     eax, 8 + 3

        add     eax, 8 + 3

        and     eax, not 3

        and     eax, not 3

        push    eax

        push    eax

        pop     ecx

        pop     ecx

        test    eax, eax

        test    eax, eax

        jz      .nothing

        jz      .nothing

; 4. Zero-initialize output report.

; 4. Zero-initialize output report.

        push    eax

        push    eax

        mov     edx, [size]

        mov     edx, [size]

        shl     edx, 16         ; move Size to last word

        shl     edx, 16         ; move Size to last word

        or      edx, [ebx+usb_device_data.interface_number]

        or      edx, [ebx+usb_device_data.interface_number]

        mov     [eax+4], edx

        mov     [eax+4], edx

; 8. Submit output control request.

; 8. Submit output control request.

                eax, edi, [size], after_set_keyboard_lights, ebx, 0

                eax, edi, [size], after_set_keyboard_lights, ebx, 0

; If failed, free the buffer now.

; If failed, free the buffer now.

; If succeeded, the callback will free the buffer.

; If succeeded, the callback will free the buffer.

        test    eax, eax

        test    eax, eax

        jnz     .nothing

        jnz     .nothing

        lea     eax, [edi-8]

        lea     eax, [edi-8]

.nothing:

.nothing:

        ret

        ret

endp

endp

.calldata       dd      ?

.calldata       dd      ?

end virtual

end virtual

; Ignore status, just free the buffer allocated by SetKeyboardLights.

; Ignore status, just free the buffer allocated by SetKeyboardLights.

        mov     eax, [.buffer]

        mov     eax, [.buffer]

        sub     eax, 8

        sub     eax, 8

        ret     20

        ret     20

endp

endp