mirror of https://github.com/wwarthen/RomWBW.git
You can not select more than 25 topics
Topics must start with a letter or number, can include dashes ('-') and can be up to 35 characters long.
1085 lines
25 KiB
1085 lines
25 KiB
;
|
|
; Generated from source-doc/base-drv/enumerate.c.asm -- not to be modify directly
|
|
;
|
|
;
|
|
;--------------------------------------------------------
|
|
; File Created by SDCC : free open source ISO C Compiler
|
|
; Version 4.5.0 #15248 (Linux)
|
|
;--------------------------------------------------------
|
|
; Processed by Z88DK
|
|
;--------------------------------------------------------
|
|
|
|
|
|
;--------------------------------------------------------
|
|
; Public variables in this module
|
|
;--------------------------------------------------------
|
|
;--------------------------------------------------------
|
|
; Externals used
|
|
;--------------------------------------------------------
|
|
;--------------------------------------------------------
|
|
; special function registers
|
|
;--------------------------------------------------------
|
|
;--------------------------------------------------------
|
|
; ram data
|
|
;--------------------------------------------------------
|
|
;--------------------------------------------------------
|
|
; ram data
|
|
;--------------------------------------------------------
|
|
|
|
#IF 0
|
|
|
|
; .area _INITIALIZED removed by z88dk
|
|
|
|
|
|
#ENDIF
|
|
|
|
;--------------------------------------------------------
|
|
; absolute external ram data
|
|
;--------------------------------------------------------
|
|
;--------------------------------------------------------
|
|
; global & static initialisations
|
|
;--------------------------------------------------------
|
|
;--------------------------------------------------------
|
|
; Home
|
|
;--------------------------------------------------------
|
|
;--------------------------------------------------------
|
|
; code
|
|
;--------------------------------------------------------
|
|
;source-doc/base-drv/enumerate.c:13: static usb_error adv_to_next_desc(_working *const working, const uint8_t descriptor_type) __sdcccall(1) {
|
|
; ---------------------------------
|
|
; Function adv_to_next_desc
|
|
; ---------------------------------
|
|
_adv_to_next_desc:
|
|
push ix
|
|
ld ix,0
|
|
add ix,sp
|
|
push af
|
|
push af
|
|
ex de, hl
|
|
;source-doc/base-drv/enumerate.c:15: const uint8_t *buffer_end = working->config.buffer + MAX_CONFIG_SIZE;
|
|
ld hl,$00ab
|
|
add hl, de
|
|
ex (sp), hl
|
|
;source-doc/base-drv/enumerate.c:17: if (working->ptr >= buffer_end)
|
|
ld hl,$001b
|
|
add hl, de
|
|
ld (ix-2),l
|
|
ld (ix-1),h
|
|
pop de
|
|
pop hl
|
|
ld a,(hl)
|
|
push hl
|
|
push de
|
|
inc hl
|
|
ld b,(hl)
|
|
ld c,a
|
|
sub (ix-4)
|
|
ld a, b
|
|
sbc a,(ix-3)
|
|
jr C,l_adv_to_next_desc_00102
|
|
;source-doc/base-drv/enumerate.c:18: return USB_ERR_BUFF_TO_LARGE;
|
|
ld a,$84
|
|
jr l_adv_to_next_desc_00110
|
|
l_adv_to_next_desc_00102:
|
|
;source-doc/base-drv/enumerate.c:20: d = (usb_descriptor_t *)working->ptr;
|
|
ld e, c
|
|
ld d, b
|
|
;source-doc/base-drv/enumerate.c:22: do {
|
|
l_adv_to_next_desc_00105:
|
|
;source-doc/base-drv/enumerate.c:23: working->ptr += d->bLength;
|
|
ld a, (de)
|
|
add a, c
|
|
ld c, a
|
|
ld a,$00
|
|
adc a, b
|
|
ld b, a
|
|
ld l,(ix-2)
|
|
ld h,(ix-1)
|
|
ld (hl), c
|
|
inc hl
|
|
ld (hl), b
|
|
;source-doc/base-drv/enumerate.c:25: if (working->ptr >= buffer_end)
|
|
ld a, c
|
|
sub (ix-4)
|
|
ld a, b
|
|
sbc a,(ix-3)
|
|
jr C,l_adv_to_next_desc_00104
|
|
;source-doc/base-drv/enumerate.c:26: return USB_ERR_BUFF_TO_LARGE;
|
|
ld a,$84
|
|
jr l_adv_to_next_desc_00110
|
|
l_adv_to_next_desc_00104:
|
|
;source-doc/base-drv/enumerate.c:17: if (working->ptr >= buffer_end)
|
|
pop de
|
|
pop hl
|
|
ld c,(hl)
|
|
push hl
|
|
push de
|
|
inc hl
|
|
ld b, (hl)
|
|
;source-doc/base-drv/enumerate.c:28: d = (usb_descriptor_t *)working->ptr;
|
|
ld e, c
|
|
ld d, b
|
|
;source-doc/base-drv/enumerate.c:29: } while (d->bDescriptorType != descriptor_type);
|
|
ld l, e
|
|
ld h, d
|
|
inc hl
|
|
ld a, (hl)
|
|
sub (ix+4)
|
|
jr NZ,l_adv_to_next_desc_00105
|
|
;source-doc/base-drv/enumerate.c:31: if (working->ptr + d->bLength >= buffer_end)
|
|
ld a, (de)
|
|
ld l, a
|
|
ld h,$00
|
|
add hl, bc
|
|
ld a, l
|
|
sub (ix-4)
|
|
ld a, h
|
|
sbc a,(ix-3)
|
|
jr C,l_adv_to_next_desc_00109
|
|
;source-doc/base-drv/enumerate.c:32: return USB_ERR_BUFF_TO_LARGE;
|
|
ld a,$84
|
|
jr l_adv_to_next_desc_00110
|
|
l_adv_to_next_desc_00109:
|
|
;source-doc/base-drv/enumerate.c:34: return USB_ERR_OK;
|
|
xor a
|
|
l_adv_to_next_desc_00110:
|
|
;source-doc/base-drv/enumerate.c:35: }
|
|
ld sp, ix
|
|
pop ix
|
|
pop hl
|
|
inc sp
|
|
jp (hl)
|
|
;source-doc/base-drv/enumerate.c:37: void parse_endpoint_keyboard(device_config_keyboard *const keyboard_config, const endpoint_descriptor const *pEndpoint)
|
|
; ---------------------------------
|
|
; Function parse_endpoint_keyboard
|
|
; ---------------------------------
|
|
_parse_endpoint_keyboard:
|
|
push ix
|
|
ld ix,0
|
|
add ix,sp
|
|
push af
|
|
;source-doc/base-drv/enumerate.c:39: endpoint_param *const ep = &keyboard_config->endpoints[0];
|
|
inc hl
|
|
inc hl
|
|
inc hl
|
|
;source-doc/base-drv/enumerate.c:40: ep->number = pEndpoint->bEndpointAddress;
|
|
ld c,l
|
|
ld b,h
|
|
ex (sp),hl
|
|
ld l, e
|
|
ld h, d
|
|
inc hl
|
|
inc hl
|
|
ld a, (hl)
|
|
pop hl
|
|
push hl
|
|
rlca
|
|
and $0e
|
|
push bc
|
|
ld c, a
|
|
ld a, (hl)
|
|
and $f1
|
|
or c
|
|
ld (hl), a
|
|
;source-doc/base-drv/enumerate.c:41: ep->toggle = 0;
|
|
pop hl
|
|
ld c,l
|
|
ld b,h
|
|
res 0, (hl)
|
|
;source-doc/base-drv/enumerate.c:42: ep->max_packet_sizex = calc_max_packet_sizex(pEndpoint->wMaxPacketSize);
|
|
inc bc
|
|
ld hl,4
|
|
add hl, de
|
|
ld e, (hl)
|
|
inc hl
|
|
ld a, (hl)
|
|
and $03
|
|
ld d, a
|
|
ld a, e
|
|
ld (bc), a
|
|
inc bc
|
|
ld a, d
|
|
and $03
|
|
ld l, a
|
|
ld a, (bc)
|
|
and $fc
|
|
or l
|
|
ld (bc), a
|
|
;source-doc/base-drv/enumerate.c:43: }
|
|
ld sp, ix
|
|
pop ix
|
|
ret
|
|
;source-doc/base-drv/enumerate.c:45: usb_device_type identify_class_driver(_working *const working) {
|
|
; ---------------------------------
|
|
; Function identify_class_driver
|
|
; ---------------------------------
|
|
_identify_class_driver:
|
|
push ix
|
|
ld ix,0
|
|
add ix,sp
|
|
;source-doc/base-drv/enumerate.c:46: const interface_descriptor *const p = (const interface_descriptor *)working->ptr;
|
|
ld c,(ix+4)
|
|
ld b,(ix+5)
|
|
ld hl,27
|
|
add hl, bc
|
|
ld c, (hl)
|
|
inc hl
|
|
ld b, (hl)
|
|
;source-doc/base-drv/enumerate.c:47: if (p->bInterfaceClass == 2)
|
|
ld hl,5
|
|
add hl,bc
|
|
ld a,(hl)
|
|
ld e,a
|
|
sub $02
|
|
jr NZ,l_identify_class_driver_00102
|
|
;source-doc/base-drv/enumerate.c:48: return USB_IS_CDC;
|
|
ld l,$03
|
|
jr l_identify_class_driver_00118
|
|
l_identify_class_driver_00102:
|
|
;source-doc/base-drv/enumerate.c:50: if (p->bInterfaceClass == 8 && (p->bInterfaceSubClass == 6 || p->bInterfaceSubClass == 5) && p->bInterfaceProtocol == 80)
|
|
ld a, e
|
|
sub $08
|
|
jr NZ,l_identify_class_driver_00199
|
|
ld a,$01
|
|
jr l_identify_class_driver_00200
|
|
l_identify_class_driver_00199:
|
|
xor a
|
|
l_identify_class_driver_00200:
|
|
ld d,a
|
|
or a
|
|
jr Z,l_identify_class_driver_00104
|
|
ld hl,$0006
|
|
add hl,bc
|
|
ld a, (hl)
|
|
cp $06
|
|
jr Z,l_identify_class_driver_00107
|
|
sub $05
|
|
jr NZ,l_identify_class_driver_00104
|
|
l_identify_class_driver_00107:
|
|
ld hl,$0007
|
|
add hl,bc
|
|
ld a, (hl)
|
|
sub $50
|
|
jr NZ,l_identify_class_driver_00104
|
|
;source-doc/base-drv/enumerate.c:51: return USB_IS_MASS_STORAGE;
|
|
ld l,$02
|
|
jr l_identify_class_driver_00118
|
|
l_identify_class_driver_00104:
|
|
;source-doc/base-drv/enumerate.c:53: if (p->bInterfaceClass == 8 && p->bInterfaceSubClass == 4 && p->bInterfaceProtocol == 0)
|
|
ld a, d
|
|
or a
|
|
jr Z,l_identify_class_driver_00109
|
|
ld hl,$0006
|
|
add hl,bc
|
|
ld a, (hl)
|
|
sub $04
|
|
jr NZ,l_identify_class_driver_00109
|
|
ld hl,$0007
|
|
add hl,bc
|
|
ld a, (hl)
|
|
or a
|
|
jr NZ,l_identify_class_driver_00109
|
|
;source-doc/base-drv/enumerate.c:54: return USB_IS_FLOPPY;
|
|
ld l,$01
|
|
jr l_identify_class_driver_00118
|
|
l_identify_class_driver_00109:
|
|
;source-doc/base-drv/enumerate.c:56: if (p->bInterfaceClass == 9 && p->bInterfaceSubClass == 0 && p->bInterfaceProtocol == 0)
|
|
ld a, e
|
|
sub $09
|
|
jr NZ,l_identify_class_driver_00113
|
|
ld hl,$0006
|
|
add hl,bc
|
|
ld a, (hl)
|
|
or a
|
|
jr NZ,l_identify_class_driver_00113
|
|
ld hl,7
|
|
add hl, bc
|
|
ld a, (hl)
|
|
or a
|
|
jr NZ,l_identify_class_driver_00113
|
|
;source-doc/base-drv/enumerate.c:57: return USB_IS_HUB;
|
|
ld l,$0f
|
|
jr l_identify_class_driver_00118
|
|
l_identify_class_driver_00113:
|
|
;source-doc/base-drv/enumerate.c:59: if (p->bInterfaceClass == 3)
|
|
ld a, e
|
|
sub $03
|
|
jr NZ,l_identify_class_driver_00117
|
|
;source-doc/base-drv/enumerate.c:60: return USB_IS_KEYBOARD;
|
|
ld l,$04
|
|
jr l_identify_class_driver_00118
|
|
l_identify_class_driver_00117:
|
|
;source-doc/base-drv/enumerate.c:62: return USB_IS_UNKNOWN;
|
|
ld l,$06
|
|
l_identify_class_driver_00118:
|
|
;source-doc/base-drv/enumerate.c:63: }
|
|
pop ix
|
|
ret
|
|
;source-doc/base-drv/enumerate.c:65: usb_error op_interface_next(_working *const working) __z88dk_fastcall {
|
|
; ---------------------------------
|
|
; Function op_interface_next
|
|
; ---------------------------------
|
|
_op_interface_next:
|
|
ex de, hl
|
|
;source-doc/base-drv/enumerate.c:68: if (--working->interface_count == 0)
|
|
ld hl,$0016
|
|
add hl, de
|
|
ld a, (hl)
|
|
dec a
|
|
ld (hl), a
|
|
;source-doc/base-drv/enumerate.c:69: return USB_ERR_OK;
|
|
or a
|
|
jr NZ,l_op_interface_next_00102
|
|
ld l,a
|
|
jr l_op_interface_next_00106
|
|
l_op_interface_next_00102:
|
|
;source-doc/base-drv/enumerate.c:71: CHECK(adv_to_next_desc(working, USB_DESCR_INTERFACE));
|
|
push de
|
|
ld a,$04
|
|
push af
|
|
inc sp
|
|
ex de,hl
|
|
call _adv_to_next_desc
|
|
pop de
|
|
ld l, a
|
|
or a
|
|
ret NZ
|
|
;source-doc/base-drv/enumerate.c:72: return op_id_class_drv(working);
|
|
ex de, hl
|
|
call _op_id_class_drv
|
|
ld l, a
|
|
;source-doc/base-drv/enumerate.c:74: done:
|
|
;source-doc/base-drv/enumerate.c:75: return result;
|
|
l_op_interface_next_00106:
|
|
;source-doc/base-drv/enumerate.c:76: }
|
|
ret
|
|
;source-doc/base-drv/enumerate.c:78: usb_error op_endpoint_next(_working *const working) __sdcccall(1) {
|
|
; ---------------------------------
|
|
; Function op_endpoint_next
|
|
; ---------------------------------
|
|
_op_endpoint_next:
|
|
;source-doc/base-drv/enumerate.c:81: if (working->endpoint_count != 0 && --working->endpoint_count > 0) {
|
|
ld a, l
|
|
add a,$17
|
|
ld c, a
|
|
ld a, h
|
|
adc a,$00
|
|
ld b, a
|
|
ld a, (bc)
|
|
or a
|
|
jr Z,l_op_endpoint_next_00104
|
|
dec a
|
|
ld (bc), a
|
|
or a
|
|
jr Z,l_op_endpoint_next_00104
|
|
;source-doc/base-drv/enumerate.c:82: CHECK(adv_to_next_desc(working, USB_DESCR_ENDPOINT));
|
|
push hl
|
|
ld a,$05
|
|
push af
|
|
inc sp
|
|
call _adv_to_next_desc
|
|
pop hl
|
|
ld c, a
|
|
or a
|
|
jr NZ,l_op_endpoint_next_00106
|
|
;source-doc/base-drv/enumerate.c:83: return op_parse_endpoint(working);
|
|
jp _op_parse_endpoint
|
|
jr l_op_endpoint_next_00107
|
|
l_op_endpoint_next_00104:
|
|
;source-doc/base-drv/enumerate.c:86: return op_interface_next(working);
|
|
call _op_interface_next
|
|
ld a, l
|
|
jr l_op_endpoint_next_00107
|
|
;source-doc/base-drv/enumerate.c:88: done:
|
|
l_op_endpoint_next_00106:
|
|
;source-doc/base-drv/enumerate.c:89: return result;
|
|
ld a, c
|
|
l_op_endpoint_next_00107:
|
|
;source-doc/base-drv/enumerate.c:90: }
|
|
ret
|
|
;source-doc/base-drv/enumerate.c:92: usb_error op_parse_endpoint(_working *const working) __sdcccall(1) {
|
|
; ---------------------------------
|
|
; Function op_parse_endpoint
|
|
; ---------------------------------
|
|
_op_parse_endpoint:
|
|
push ix
|
|
ld ix,0
|
|
add ix,sp
|
|
push af
|
|
;source-doc/base-drv/enumerate.c:93: const endpoint_descriptor *endpoint = (endpoint_descriptor *)working->ptr;
|
|
ld de,$001c
|
|
ld c,l
|
|
ld b,h
|
|
add hl, de
|
|
ld a, (hl)
|
|
dec hl
|
|
ld l, (hl)
|
|
ld (ix-2),l
|
|
ld (ix-1),a
|
|
;source-doc/base-drv/enumerate.c:94: device_config *const device = working->p_current_device;
|
|
ld hl,29
|
|
add hl,bc
|
|
ld e, (hl)
|
|
inc hl
|
|
ld d, (hl)
|
|
;source-doc/base-drv/enumerate.c:96: switch (working->usb_device) {
|
|
ld l, c
|
|
ld h, b
|
|
inc hl
|
|
inc hl
|
|
ld a, (hl)
|
|
cp $01
|
|
jr Z,l_op_parse_endpoint_00102
|
|
cp $02
|
|
jr Z,l_op_parse_endpoint_00102
|
|
sub $04
|
|
jr Z,l_op_parse_endpoint_00103
|
|
jr l_op_parse_endpoint_00104
|
|
;source-doc/base-drv/enumerate.c:98: case USB_IS_MASS_STORAGE: {
|
|
l_op_parse_endpoint_00102:
|
|
;source-doc/base-drv/enumerate.c:99: parse_endpoints((device_config_storage *)device, endpoint);
|
|
push bc
|
|
ld l,(ix-2)
|
|
ld h,(ix-1)
|
|
push hl
|
|
push de
|
|
call _parse_endpoints
|
|
pop af
|
|
pop af
|
|
pop bc
|
|
;source-doc/base-drv/enumerate.c:100: break;
|
|
jr l_op_parse_endpoint_00104
|
|
;source-doc/base-drv/enumerate.c:103: case USB_IS_KEYBOARD: {
|
|
l_op_parse_endpoint_00103:
|
|
;source-doc/base-drv/enumerate.c:104: parse_endpoint_keyboard((device_config_keyboard *)device, endpoint);
|
|
ex de, hl
|
|
push bc
|
|
ld e,(ix-2)
|
|
ld d,(ix-1)
|
|
call _parse_endpoint_keyboard
|
|
pop bc
|
|
;source-doc/base-drv/enumerate.c:107: }
|
|
l_op_parse_endpoint_00104:
|
|
;source-doc/base-drv/enumerate.c:109: return op_endpoint_next(working);
|
|
ld l, c
|
|
ld h, b
|
|
call _op_endpoint_next
|
|
;source-doc/base-drv/enumerate.c:110: }
|
|
ld sp, ix
|
|
pop ix
|
|
ret
|
|
;source-doc/base-drv/enumerate.c:113: configure_device(const _working *const working, const interface_descriptor *const interface, device_config *const dev_cfg) {
|
|
; ---------------------------------
|
|
; Function configure_device
|
|
; ---------------------------------
|
|
_configure_device:
|
|
push ix
|
|
ld ix,0
|
|
add ix,sp
|
|
push af
|
|
push af
|
|
;source-doc/base-drv/enumerate.c:114: dev_cfg->interface_number = interface->bInterfaceNumber;
|
|
ld c,(ix+8)
|
|
ld b,(ix+9)
|
|
ld e, c
|
|
ld d, b
|
|
inc de
|
|
inc de
|
|
ld l,(ix+6)
|
|
ld h,(ix+7)
|
|
inc hl
|
|
inc hl
|
|
ld a, (hl)
|
|
ld (de), a
|
|
;source-doc/base-drv/enumerate.c:115: dev_cfg->max_packet_size = working->desc.bMaxPacketSize0;
|
|
ld hl,$0001
|
|
add hl, bc
|
|
ex (sp), hl
|
|
ld e,(ix+4)
|
|
ld d,(ix+5)
|
|
ld hl,$000a
|
|
add hl,de
|
|
ld a, (hl)
|
|
pop hl
|
|
push hl
|
|
ld (hl), a
|
|
;source-doc/base-drv/enumerate.c:116: dev_cfg->address = working->current_device_address;
|
|
ld (ix-2),c
|
|
ld (ix-1),b
|
|
ld l, e
|
|
ld h, d
|
|
ld a,+(($0018) & $FF)
|
|
add a,l
|
|
ld l,a
|
|
ld a,+(($0018) / 256)
|
|
adc a,h
|
|
ld h,a
|
|
ld a, (hl)
|
|
ld l,(ix-2)
|
|
ld h,(ix-1)
|
|
add a, a
|
|
add a, a
|
|
add a, a
|
|
add a, a
|
|
push bc
|
|
ld c, a
|
|
ld a, (hl)
|
|
and $0f
|
|
or c
|
|
ld (hl), a
|
|
pop bc
|
|
;source-doc/base-drv/enumerate.c:117: dev_cfg->type = working->usb_device;
|
|
ld l, e
|
|
ld h, d
|
|
inc hl
|
|
inc hl
|
|
ld a, (hl)
|
|
and $0f
|
|
ld l, a
|
|
ld a, (bc)
|
|
and $f0
|
|
or l
|
|
ld (bc), a
|
|
;source-doc/base-drv/enumerate.c:119: return usbtrn_set_config(dev_cfg->address, dev_cfg->max_packet_size, working->config.desc.bConfigurationvalue);
|
|
ld hl,36
|
|
add hl, de
|
|
ld b, (hl)
|
|
pop hl
|
|
ld d,(hl)
|
|
push hl
|
|
ld l,(ix-2)
|
|
ld h,(ix-1)
|
|
ld a, (hl)
|
|
rlca
|
|
rlca
|
|
rlca
|
|
rlca
|
|
and $0f
|
|
ld c, d
|
|
push bc
|
|
push af
|
|
inc sp
|
|
call _usbtrn_set_config
|
|
;source-doc/base-drv/enumerate.c:120: }
|
|
ld sp,ix
|
|
pop ix
|
|
ret
|
|
;source-doc/base-drv/enumerate.c:122: usb_error op_cap_hub_drv_intf(_working *const working) __sdcccall(1) {
|
|
; ---------------------------------
|
|
; Function op_cap_hub_drv_intf
|
|
; ---------------------------------
|
|
_op_cap_hub_drv_intf:
|
|
push ix
|
|
ld ix,0
|
|
add ix,sp
|
|
push af
|
|
push af
|
|
dec sp
|
|
ex de, hl
|
|
;source-doc/base-drv/enumerate.c:123: const interface_descriptor *const interface = (interface_descriptor *)working->ptr;
|
|
ld hl,$001c
|
|
add hl,de
|
|
ld a, (hl)
|
|
dec hl
|
|
ld l, (hl)
|
|
ld (ix-2),l
|
|
ld (ix-1),a
|
|
;source-doc/base-drv/enumerate.c:127: working->hub_config = &hub_config;
|
|
ld hl,$0019
|
|
add hl, de
|
|
ld c, l
|
|
ld b, h
|
|
ld hl,0
|
|
add hl, sp
|
|
ld a, l
|
|
ld (bc), a
|
|
inc bc
|
|
ld a, h
|
|
ld (bc), a
|
|
;source-doc/base-drv/enumerate.c:129: hub_config.type = USB_IS_HUB;
|
|
ld hl,0
|
|
add hl, sp
|
|
ld a, (hl)
|
|
or $0f
|
|
ld (hl), a
|
|
;source-doc/base-drv/enumerate.c:130: CHECK(configure_device(working, interface, (device_config *const)&hub_config));
|
|
push de
|
|
ld hl,2
|
|
add hl, sp
|
|
push hl
|
|
ld l,(ix-2)
|
|
ld h,(ix-1)
|
|
push hl
|
|
push de
|
|
call _configure_device
|
|
pop af
|
|
pop af
|
|
pop af
|
|
pop de
|
|
ld a, l
|
|
inc l
|
|
dec l
|
|
jr NZ,l_op_cap_hub_drv_intf_00103
|
|
;source-doc/base-drv/enumerate.c:131: RETURN_CHECK(configure_usb_hub(working));
|
|
ex de, hl
|
|
call _configure_usb_hub
|
|
ld a, l
|
|
;source-doc/base-drv/enumerate.c:132: done:
|
|
l_op_cap_hub_drv_intf_00103:
|
|
;source-doc/base-drv/enumerate.c:133: return result;
|
|
;source-doc/base-drv/enumerate.c:134: }
|
|
ld sp, ix
|
|
pop ix
|
|
ret
|
|
;source-doc/base-drv/enumerate.c:136: usb_error op_cap_drv_intf(_working *const working) __z88dk_fastcall {
|
|
; ---------------------------------
|
|
; Function op_cap_drv_intf
|
|
; ---------------------------------
|
|
_op_cap_drv_intf:
|
|
push ix
|
|
ld ix,0
|
|
add ix,sp
|
|
ld c, l
|
|
ld b, h
|
|
ld hl, -14
|
|
add hl, sp
|
|
ld sp, hl
|
|
;source-doc/base-drv/enumerate.c:139: const interface_descriptor *const interface = (interface_descriptor *)working->ptr;
|
|
ld l,c
|
|
ld h, b
|
|
ld de,$001c
|
|
add hl, de
|
|
ld a, (hl)
|
|
dec hl
|
|
ld l, (hl)
|
|
ld (ix-2),l
|
|
ld (ix-1),a
|
|
;source-doc/base-drv/enumerate.c:141: working->endpoint_count = interface->bNumEndpoints;
|
|
ld hl,$0017
|
|
add hl, bc
|
|
ex de, hl
|
|
ld l,(ix-2)
|
|
ld h,(ix-1)
|
|
inc hl
|
|
inc hl
|
|
inc hl
|
|
inc hl
|
|
ld a, (hl)
|
|
ld (de), a
|
|
;source-doc/base-drv/enumerate.c:142: if (working->endpoint_count > 0)
|
|
or a
|
|
jr Z,l_op_cap_drv_intf_00104
|
|
;source-doc/base-drv/enumerate.c:143: CHECK(adv_to_next_desc(working, USB_DESCR_ENDPOINT));
|
|
push bc
|
|
ld a,$05
|
|
push af
|
|
inc sp
|
|
ld l, c
|
|
ld h, b
|
|
call _adv_to_next_desc
|
|
pop bc
|
|
or a
|
|
jp NZ, l_op_cap_drv_intf_00117
|
|
l_op_cap_drv_intf_00104:
|
|
;source-doc/base-drv/enumerate.c:144: working->p_current_device = NULL;
|
|
ld hl,$001d
|
|
add hl, bc
|
|
ld e,l
|
|
ld d,h
|
|
xor a
|
|
ld (hl), a
|
|
inc hl
|
|
ld (hl), a
|
|
;source-doc/base-drv/enumerate.c:146: switch (working->usb_device) {
|
|
ld l, c
|
|
ld h, b
|
|
inc hl
|
|
inc hl
|
|
ld a, (hl)
|
|
cp $06
|
|
jr Z,l_op_cap_drv_intf_00108
|
|
sub $0f
|
|
jr NZ,l_op_cap_drv_intf_00111
|
|
;source-doc/base-drv/enumerate.c:148: CHECK(op_cap_hub_drv_intf(working))
|
|
ld l,c
|
|
ld h,b
|
|
push hl
|
|
call _op_cap_hub_drv_intf
|
|
pop bc
|
|
or a
|
|
jr Z,l_op_cap_drv_intf_00116
|
|
jr l_op_cap_drv_intf_00117
|
|
;source-doc/base-drv/enumerate.c:152: case USB_IS_UNKNOWN: {
|
|
l_op_cap_drv_intf_00108:
|
|
;source-doc/base-drv/enumerate.c:154: memset(&unkown_dev_cfg, 0, sizeof(device_config));
|
|
push bc
|
|
ld hl,2
|
|
add hl, sp
|
|
ld b,$06
|
|
l_op_cap_drv_intf_00165:
|
|
xor a
|
|
ld (hl), a
|
|
inc hl
|
|
ld (hl), a
|
|
inc hl
|
|
djnz l_op_cap_drv_intf_00165
|
|
pop bc
|
|
;source-doc/base-drv/enumerate.c:155: working->p_current_device = &unkown_dev_cfg;
|
|
ld hl,0
|
|
add hl, sp
|
|
ld a, l
|
|
ld (de), a
|
|
inc de
|
|
ld a, h
|
|
ld (de), a
|
|
;source-doc/base-drv/enumerate.c:156: CHECK(configure_device(working, interface, &unkown_dev_cfg));
|
|
push bc
|
|
push hl
|
|
ld l,(ix-2)
|
|
ld h,(ix-1)
|
|
push hl
|
|
push bc
|
|
call _configure_device
|
|
pop af
|
|
pop af
|
|
pop af
|
|
ld a, l
|
|
pop bc
|
|
or a
|
|
jr Z,l_op_cap_drv_intf_00116
|
|
jr l_op_cap_drv_intf_00117
|
|
;source-doc/base-drv/enumerate.c:160: default: {
|
|
l_op_cap_drv_intf_00111:
|
|
;source-doc/base-drv/enumerate.c:161: device_config *dev_cfg = find_first_free();
|
|
push bc
|
|
push de
|
|
call _find_first_free
|
|
pop de
|
|
pop bc
|
|
;source-doc/base-drv/enumerate.c:162: if (dev_cfg == NULL)
|
|
ld a, h
|
|
or l
|
|
jr NZ,l_op_cap_drv_intf_00113
|
|
;source-doc/base-drv/enumerate.c:163: return USB_ERR_OUT_OF_MEMORY;
|
|
ld l,$83
|
|
jr l_op_cap_drv_intf_00118
|
|
l_op_cap_drv_intf_00113:
|
|
;source-doc/base-drv/enumerate.c:164: working->p_current_device = dev_cfg;
|
|
ld a, l
|
|
ld (de), a
|
|
inc de
|
|
ld a, h
|
|
ld (de), a
|
|
;source-doc/base-drv/enumerate.c:165: CHECK(configure_device(working, interface, dev_cfg));
|
|
push bc
|
|
push hl
|
|
ld l,(ix-2)
|
|
ld h,(ix-1)
|
|
push hl
|
|
push bc
|
|
call _configure_device
|
|
pop af
|
|
pop af
|
|
pop af
|
|
ld a, l
|
|
pop bc
|
|
or a
|
|
jr NZ,l_op_cap_drv_intf_00117
|
|
;source-doc/base-drv/enumerate.c:168: }
|
|
l_op_cap_drv_intf_00116:
|
|
;source-doc/base-drv/enumerate.c:170: return op_parse_endpoint(working);
|
|
ld l, c
|
|
ld h, b
|
|
call _op_parse_endpoint
|
|
ld l, a
|
|
jr l_op_cap_drv_intf_00118
|
|
;source-doc/base-drv/enumerate.c:172: done:
|
|
l_op_cap_drv_intf_00117:
|
|
;source-doc/base-drv/enumerate.c:173: return result;
|
|
ld l, a
|
|
l_op_cap_drv_intf_00118:
|
|
;source-doc/base-drv/enumerate.c:174: }
|
|
ld sp, ix
|
|
pop ix
|
|
ret
|
|
;source-doc/base-drv/enumerate.c:176: usb_error op_id_class_drv(_working *const working) __sdcccall(1) {
|
|
; ---------------------------------
|
|
; Function op_id_class_drv
|
|
; ---------------------------------
|
|
_op_id_class_drv:
|
|
ex de, hl
|
|
;source-doc/base-drv/enumerate.c:177: const interface_descriptor *const ptr = (const interface_descriptor *)working->ptr;
|
|
ld hl,27
|
|
add hl,de
|
|
ld c, (hl)
|
|
inc hl
|
|
ld b, (hl)
|
|
;source-doc/base-drv/enumerate.c:179: if (ptr->bDescriptorType != USB_DESCR_INTERFACE)
|
|
inc bc
|
|
ld a, (bc)
|
|
sub $04
|
|
jr Z,l_op_id_class_drv_00102
|
|
;source-doc/base-drv/enumerate.c:180: return USB_ERR_FAIL;
|
|
ld a,$0e
|
|
jr l_op_id_class_drv_00103
|
|
l_op_id_class_drv_00102:
|
|
;source-doc/base-drv/enumerate.c:182: working->usb_device = identify_class_driver(working);
|
|
ld c, e
|
|
ld b, d
|
|
inc bc
|
|
inc bc
|
|
push bc
|
|
push de
|
|
push de
|
|
call _identify_class_driver
|
|
pop af
|
|
ld a, l
|
|
pop de
|
|
pop bc
|
|
ld (bc), a
|
|
;source-doc/base-drv/enumerate.c:184: return op_cap_drv_intf(working);
|
|
ex de, hl
|
|
call _op_cap_drv_intf
|
|
ld a, l
|
|
l_op_id_class_drv_00103:
|
|
;source-doc/base-drv/enumerate.c:185: }
|
|
ret
|
|
;source-doc/base-drv/enumerate.c:187: usb_error op_get_cfg_desc(_working *const working) __sdcccall(1) {
|
|
; ---------------------------------
|
|
; Function op_get_cfg_desc
|
|
; ---------------------------------
|
|
_op_get_cfg_desc:
|
|
push ix
|
|
ld ix,0
|
|
add ix,sp
|
|
dec sp
|
|
;source-doc/base-drv/enumerate.c:190: const uint8_t max_packet_size = working->desc.bMaxPacketSize0;
|
|
ld d,h
|
|
ld c,l
|
|
ld b,h
|
|
ld hl,10
|
|
add hl,bc
|
|
ld a, (hl)
|
|
ld (ix-1),a
|
|
;source-doc/base-drv/enumerate.c:192: memset(working->config.buffer, 0, MAX_CONFIG_SIZE);
|
|
ld hl,$001f
|
|
add hl, bc
|
|
push bc
|
|
ld b,$46
|
|
l_op_get_cfg_desc_00122:
|
|
xor a
|
|
ld (hl), a
|
|
inc hl
|
|
ld (hl), a
|
|
inc hl
|
|
djnz l_op_get_cfg_desc_00122
|
|
pop bc
|
|
;source-doc/base-drv/enumerate.c:193: working->ptr = working->config.buffer;
|
|
ld hl,$001b
|
|
add hl, bc
|
|
ld a, c
|
|
add a,$1f
|
|
ld e, a
|
|
ld a, b
|
|
adc a,$00
|
|
ld (hl), e
|
|
inc hl
|
|
ld (hl), a
|
|
;source-doc/base-drv/enumerate.c:196: working->config.buffer));
|
|
ld hl,$001f
|
|
add hl, bc
|
|
ex de, hl
|
|
ld hl,$0018
|
|
add hl,bc
|
|
ld a, (hl)
|
|
ld hl,$0015
|
|
add hl,bc
|
|
ld h, (hl)
|
|
push bc
|
|
push de
|
|
ld d,$8c
|
|
push de
|
|
inc sp
|
|
ld d,(ix-1)
|
|
push de
|
|
inc sp
|
|
ld l,h
|
|
ld h,a
|
|
push hl
|
|
call _usbtrn_gfull_cfg_desc
|
|
pop af
|
|
pop af
|
|
pop af
|
|
ld a, l
|
|
pop bc
|
|
or a
|
|
jr NZ,l_op_get_cfg_desc_00105
|
|
;source-doc/base-drv/enumerate.c:198: CHECK(adv_to_next_desc(working, USB_DESCR_INTERFACE));
|
|
push bc
|
|
ld a,$04
|
|
push af
|
|
inc sp
|
|
ld l, c
|
|
ld h, b
|
|
call _adv_to_next_desc
|
|
pop bc
|
|
or a
|
|
jr NZ,l_op_get_cfg_desc_00105
|
|
;source-doc/base-drv/enumerate.c:199: working->interface_count = working->config.desc.bNumInterfaces;
|
|
ld hl,$0016
|
|
add hl, bc
|
|
ex de, hl
|
|
ld hl,$0023
|
|
add hl,bc
|
|
ld a, (hl)
|
|
ld (de), a
|
|
;source-doc/base-drv/enumerate.c:201: return op_id_class_drv(working);
|
|
ld l, c
|
|
ld h, b
|
|
call _op_id_class_drv
|
|
;source-doc/base-drv/enumerate.c:203: done:
|
|
;source-doc/base-drv/enumerate.c:204: return result;
|
|
l_op_get_cfg_desc_00105:
|
|
;source-doc/base-drv/enumerate.c:205: }
|
|
inc sp
|
|
pop ix
|
|
ret
|
|
;source-doc/base-drv/enumerate.c:207: usb_error read_all_configs(enumeration_state *const state) {
|
|
; ---------------------------------
|
|
; Function read_all_configs
|
|
; ---------------------------------
|
|
_read_all_configs:
|
|
push ix
|
|
ld ix,0
|
|
add ix,sp
|
|
ld hl, -171
|
|
add hl, sp
|
|
ld sp, hl
|
|
;source-doc/base-drv/enumerate.c:212: memset(&working, 0, sizeof(_working));
|
|
ld hl,0
|
|
add hl, sp
|
|
ld e,l
|
|
ld d,h
|
|
ld b,$56
|
|
jr l_read_all_configs_00150
|
|
l_read_all_configs_00149:
|
|
ld (hl),$00
|
|
inc hl
|
|
l_read_all_configs_00150:
|
|
ld (hl),$00
|
|
inc hl
|
|
djnz l_read_all_configs_00149
|
|
;source-doc/base-drv/enumerate.c:213: working.state = state;
|
|
ld l, e
|
|
ld h, d
|
|
ld a,(ix+4)
|
|
ld (hl), a
|
|
inc hl
|
|
ld a,(ix+5)
|
|
ld (hl), a
|
|
;source-doc/base-drv/enumerate.c:215: CHECK(usbtrn_get_descriptor(&working.desc));
|
|
push de
|
|
ld hl,5
|
|
add hl, sp
|
|
push hl
|
|
call _usbtrn_get_descriptor
|
|
pop af
|
|
ld a, l
|
|
pop de
|
|
or a
|
|
jr NZ,l_read_all_configs_00108
|
|
;source-doc/base-drv/enumerate.c:217: state->next_device_address++;
|
|
ld b,(ix+5)
|
|
ld a,(ix+4)
|
|
ld l, a
|
|
ld h, b
|
|
ld c, (hl)
|
|
inc c
|
|
ld l, a
|
|
ld h, b
|
|
ld (hl), c
|
|
;source-doc/base-drv/enumerate.c:218: working.current_device_address = state->next_device_address;
|
|
ld hl,$0018
|
|
add hl, de
|
|
ld (hl), c
|
|
;source-doc/base-drv/enumerate.c:219: CHECK(usbtrn_set_address(working.current_device_address));
|
|
push de
|
|
ld l, c
|
|
call _usbtrn_set_address
|
|
ld a, l
|
|
pop de
|
|
;source-doc/base-drv/enumerate.c:221: for (uint8_t config_index = 0; config_index < working.desc.bNumConfigurations; config_index++) {
|
|
or a
|
|
jr NZ,l_read_all_configs_00108
|
|
ld c,a
|
|
l_read_all_configs_00110:
|
|
ld hl,20
|
|
add hl, sp
|
|
ld b, (hl)
|
|
ld a, c
|
|
sub b
|
|
jr NC,l_read_all_configs_00107
|
|
;source-doc/base-drv/enumerate.c:222: working.config_index = config_index;
|
|
ld hl,$0015
|
|
add hl, de
|
|
ld (hl), c
|
|
;source-doc/base-drv/enumerate.c:224: CHECK(op_get_cfg_desc(&working));
|
|
ld l, e
|
|
ld h, d
|
|
push bc
|
|
push de
|
|
call _op_get_cfg_desc
|
|
pop de
|
|
pop bc
|
|
or a
|
|
jr NZ,l_read_all_configs_00108
|
|
;source-doc/base-drv/enumerate.c:221: for (uint8_t config_index = 0; config_index < working.desc.bNumConfigurations; config_index++) {
|
|
inc c
|
|
jr l_read_all_configs_00110
|
|
l_read_all_configs_00107:
|
|
;source-doc/base-drv/enumerate.c:227: return USB_ERR_OK;
|
|
ld l,$00
|
|
jr l_read_all_configs_00112
|
|
;source-doc/base-drv/enumerate.c:228: done:
|
|
l_read_all_configs_00108:
|
|
;source-doc/base-drv/enumerate.c:229: return result;
|
|
ld l, a
|
|
l_read_all_configs_00112:
|
|
;source-doc/base-drv/enumerate.c:230: }
|
|
ld sp, ix
|
|
pop ix
|
|
ret
|
|
;source-doc/base-drv/enumerate.c:232: usb_error enumerate_all_devices(void) {
|
|
; ---------------------------------
|
|
; Function enumerate_all_devices
|
|
; ---------------------------------
|
|
_enumerate_all_devices:
|
|
push ix
|
|
ld ix,0
|
|
add ix,sp
|
|
push af
|
|
;source-doc/base-drv/enumerate.c:233: _usb_state *const work_area = get_usb_work_area();
|
|
;source-doc/base-drv/enumerate.c:235: memset(&state, 0, sizeof(enumeration_state));
|
|
ld hl,0
|
|
add hl, sp
|
|
ld e,l
|
|
ld d,h
|
|
xor a
|
|
ld (hl), a
|
|
inc hl
|
|
ld (hl), a
|
|
;source-doc/base-drv/enumerate.c:237: usb_error result = read_all_configs(&state);
|
|
push de
|
|
push de
|
|
call _read_all_configs
|
|
pop af
|
|
pop de
|
|
;source-doc/base-drv/enumerate.c:239: work_area->count_of_detected_usb_devices = state.next_device_address;
|
|
ld bc,_x + 1
|
|
ld a, (de)
|
|
ld (bc), a
|
|
;source-doc/base-drv/enumerate.c:242: return result;
|
|
;source-doc/base-drv/enumerate.c:243: }
|
|
ld sp, ix
|
|
pop ix
|
|
ret
|
|
|