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.
711 lines
16 KiB
711 lines
16 KiB
;
|
|
; Generated from source-doc/ufi-drv/./class_ufi.c.asm -- not to be modify directly
|
|
;
|
|
;
|
|
;--------------------------------------------------------
|
|
; File Created by SDCC : free open source ISO C Compiler
|
|
; Version 4.4.0 #14648 (Linux)
|
|
;--------------------------------------------------------
|
|
; Processed by Z88DK
|
|
;--------------------------------------------------------
|
|
|
|
|
|
;--------------------------------------------------------
|
|
; Public variables in this module
|
|
;--------------------------------------------------------
|
|
;--------------------------------------------------------
|
|
; Externals used
|
|
;--------------------------------------------------------
|
|
;--------------------------------------------------------
|
|
; special function registers
|
|
;--------------------------------------------------------
|
|
_CH376_DATA_PORT .EQU 0xff88
|
|
_CH376_COMMAND_PORT .EQU 0xff89
|
|
_USB_MODULE_LEDS .EQU 0xff8a
|
|
;--------------------------------------------------------
|
|
; ram data
|
|
;--------------------------------------------------------
|
|
;--------------------------------------------------------
|
|
; ram data
|
|
;--------------------------------------------------------
|
|
|
|
#IF 0
|
|
|
|
; .area _INITIALIZED removed by z88dk
|
|
|
|
|
|
#ENDIF
|
|
|
|
;--------------------------------------------------------
|
|
; absolute external ram data
|
|
;--------------------------------------------------------
|
|
;--------------------------------------------------------
|
|
; global & static initialisations
|
|
;--------------------------------------------------------
|
|
;--------------------------------------------------------
|
|
; Home
|
|
;--------------------------------------------------------
|
|
;--------------------------------------------------------
|
|
; code
|
|
;--------------------------------------------------------
|
|
;source-doc/ufi-drv/./class_ufi.c:14: uint8_t wait_for_device_ready(device_config *const storage_device, uint8_t timeout_counter) {
|
|
; ---------------------------------
|
|
; Function wait_for_device_ready
|
|
; ---------------------------------
|
|
_wait_for_device_ready:
|
|
push ix
|
|
ld ix,0
|
|
add ix,sp
|
|
ld hl, -18
|
|
add hl, sp
|
|
ld sp, hl
|
|
;source-doc/ufi-drv/./class_ufi.c:18: do {
|
|
ld c,(ix+6)
|
|
l_wait_for_device_ready_00105:
|
|
;source-doc/ufi-drv/./class_ufi.c:19: memset(&sense, 0, sizeof(sense));
|
|
ld hl,0
|
|
add hl, sp
|
|
ld b,0x12
|
|
l_wait_for_device_ready_00132:
|
|
ld (hl),0x00
|
|
inc hl
|
|
djnz l_wait_for_device_ready_00132
|
|
;source-doc/ufi-drv/./class_ufi.c:20: result = ufi_test_unit_ready(storage_device, &sense);
|
|
push bc
|
|
ld hl,2
|
|
add hl, sp
|
|
push hl
|
|
ld l,(ix+4)
|
|
ld h,(ix+5)
|
|
push hl
|
|
call _ufi_test_unit_ready
|
|
pop af
|
|
pop af
|
|
ld a, l
|
|
pop bc
|
|
ld b, a
|
|
;source-doc/ufi-drv/./class_ufi.c:22: if ((result == USB_ERR_OK && sense.sense_key == 0) || timeout_counter-- == 0)
|
|
ld hl,0+1+1
|
|
add hl,sp
|
|
or a
|
|
jr NZ,l_wait_for_device_ready_00104
|
|
ld a, (hl)
|
|
and 0x0f
|
|
jr Z,l_wait_for_device_ready_00107
|
|
l_wait_for_device_ready_00104:
|
|
ld a, c
|
|
dec c
|
|
or a
|
|
jr Z,l_wait_for_device_ready_00107
|
|
;source-doc/ufi-drv/./class_ufi.c:25: delay_medium();
|
|
push bc
|
|
call _delay_medium
|
|
pop bc
|
|
;source-doc/ufi-drv/./class_ufi.c:27: } while (true);
|
|
jr l_wait_for_device_ready_00105
|
|
l_wait_for_device_ready_00107:
|
|
;source-doc/ufi-drv/./class_ufi.c:29: return result | sense.sense_key;
|
|
ld a, (hl)
|
|
and 0x0f
|
|
or b
|
|
ld l, a
|
|
;source-doc/ufi-drv/./class_ufi.c:30: }
|
|
ld sp, ix
|
|
pop ix
|
|
ret
|
|
__ufi_cmd_request_sense:
|
|
DEFB +0x03
|
|
DEFB 0x00
|
|
DEFB +0x00
|
|
DEFB +0x00
|
|
DEFB +0x12
|
|
DEFB +0x00
|
|
DEFB +0x00
|
|
DEFB +0x00
|
|
DEFB +0x00
|
|
DEFB +0x00
|
|
DEFB +0x00
|
|
DEFB +0x00
|
|
__ufi_cmd_read_format_capacitie:
|
|
DEFB +0x23
|
|
DEFB 0x00
|
|
DEFB +0x00
|
|
DEFB +0x00
|
|
DEFB +0x00
|
|
DEFB +0x00
|
|
DEFB +0x00
|
|
DEFB +0x00
|
|
DEFB +0x0c
|
|
DEFB +0x00
|
|
DEFB +0x00
|
|
DEFB +0x00
|
|
__ufi_cmd_inquiry:
|
|
DEFB +0x12
|
|
DEFB 0x00
|
|
DEFB +0x00
|
|
DEFB +0x00
|
|
DEFB +0x24
|
|
DEFB +0x00
|
|
DEFB +0x00
|
|
DEFB +0x00
|
|
DEFB +0x00
|
|
DEFB +0x00
|
|
DEFB +0x00
|
|
DEFB +0x00
|
|
__ufi_cmd_format:
|
|
DEFB +0x04
|
|
DEFB 0x17
|
|
DEFB +0x00
|
|
DEFB +0x00
|
|
DEFB +0x00
|
|
DEFB +0x00
|
|
DEFB +0x00
|
|
DEFB +0x00
|
|
DEFB +0x00
|
|
DEFB +0x00
|
|
DEFB +0x00
|
|
DEFB +0x00
|
|
__ufi_cmd_send_diagnostic:
|
|
DEFB +0x1d
|
|
DEFB 0x04
|
|
DEFB +0x00
|
|
DEFB +0x00
|
|
DEFB +0x00
|
|
DEFB +0x00
|
|
DEFB +0x00
|
|
DEFB +0x00
|
|
DEFB +0x00
|
|
DEFB +0x00
|
|
DEFB +0x00
|
|
DEFB +0x00
|
|
;source-doc/ufi-drv/./class_ufi.c:32: usb_error ufi_test_unit_ready(device_config *const storage_device, ufi_request_sense_response const *response) {
|
|
; ---------------------------------
|
|
; Function ufi_test_unit_ready
|
|
; ---------------------------------
|
|
_ufi_test_unit_ready:
|
|
push ix
|
|
ld ix,0
|
|
add ix,sp
|
|
ld hl, -24
|
|
add hl, sp
|
|
ld sp, hl
|
|
;source-doc/ufi-drv/./class_ufi.c:35: memset(&ufi_cmd_request_test_unit_ready, 0, sizeof(ufi_test_unit_ready_command));
|
|
ld hl,0
|
|
add hl, sp
|
|
ex de, hl
|
|
ld l, e
|
|
ld h, d
|
|
ld b,0x0c
|
|
l_ufi_test_unit_ready_00104:
|
|
ld (hl),0x00
|
|
inc hl
|
|
djnz l_ufi_test_unit_ready_00104
|
|
;source-doc/ufi-drv/./class_ufi.c:37: usb_execute_cbi(storage_device, (uint8_t *)&ufi_cmd_request_test_unit_ready, false, 0, NULL, NULL);
|
|
ld hl,0x0000
|
|
push hl
|
|
push hl
|
|
push hl
|
|
xor a
|
|
push af
|
|
inc sp
|
|
push de
|
|
ld l,(ix+4)
|
|
ld h,(ix+5)
|
|
push hl
|
|
call _usb_execute_cbi
|
|
ld hl,11
|
|
add hl, sp
|
|
ld sp, hl
|
|
;source-doc/ufi-drv/./class_ufi.c:40: ufi_cmd_request_sense = _ufi_cmd_request_sense;
|
|
ld hl,12
|
|
add hl, sp
|
|
ld c, l
|
|
ld b, h
|
|
ld e, c
|
|
ld d, b
|
|
push bc
|
|
ld hl,__ufi_cmd_request_sense
|
|
ld bc,0x000c
|
|
ldir
|
|
pop bc
|
|
;source-doc/ufi-drv/./class_ufi.c:43: (uint8_t *)response, NULL);
|
|
ld e,(ix+6)
|
|
ld d,(ix+7)
|
|
;source-doc/ufi-drv/./class_ufi.c:42: result = usb_execute_cbi(storage_device, (uint8_t *)&ufi_cmd_request_sense, false, sizeof(ufi_request_sense_response),
|
|
ld hl,0x0000
|
|
push hl
|
|
push de
|
|
ld l,0x12
|
|
push hl
|
|
xor a
|
|
push af
|
|
inc sp
|
|
push bc
|
|
ld l,(ix+4)
|
|
ld h,(ix+5)
|
|
push hl
|
|
call _usb_execute_cbi
|
|
;source-doc/ufi-drv/./class_ufi.c:46: return result;
|
|
;source-doc/ufi-drv/./class_ufi.c:47: }
|
|
ld sp,ix
|
|
pop ix
|
|
ret
|
|
;source-doc/ufi-drv/./class_ufi.c:49: usb_error ufi_request_sense(device_config *const storage_device, ufi_request_sense_response const *response) {
|
|
; ---------------------------------
|
|
; Function ufi_request_sense
|
|
; ---------------------------------
|
|
_ufi_request_sense:
|
|
push ix
|
|
ld ix,0
|
|
add ix,sp
|
|
ld hl, -12
|
|
add hl, sp
|
|
ld sp, hl
|
|
;source-doc/ufi-drv/./class_ufi.c:51: ufi_cmd_request_sense = _ufi_cmd_request_sense;
|
|
ld hl,0
|
|
add hl, sp
|
|
ld c, l
|
|
ld b, h
|
|
ld e, c
|
|
ld d, b
|
|
push bc
|
|
ld hl,__ufi_cmd_request_sense
|
|
ld bc,0x000c
|
|
ldir
|
|
pop bc
|
|
;source-doc/ufi-drv/./class_ufi.c:53: usb_error result = usb_execute_cbi(storage_device, (uint8_t *)&ufi_cmd_request_sense, false, sizeof(ufi_request_sense_response),
|
|
ld e,(ix+6)
|
|
ld d,(ix+7)
|
|
ld hl,0x0000
|
|
push hl
|
|
push de
|
|
ld l,0x12
|
|
push hl
|
|
xor a
|
|
push af
|
|
inc sp
|
|
push bc
|
|
ld l,(ix+4)
|
|
ld h,(ix+5)
|
|
push hl
|
|
call _usb_execute_cbi
|
|
;source-doc/ufi-drv/./class_ufi.c:58: return result;
|
|
;source-doc/ufi-drv/./class_ufi.c:59: }
|
|
ld sp,ix
|
|
pop ix
|
|
ret
|
|
;source-doc/ufi-drv/./class_ufi.c:61: usb_error ufi_read_frmt_caps(device_config *const storage_device, ufi_format_capacities_response const *response) {
|
|
; ---------------------------------
|
|
; Function ufi_read_frmt_caps
|
|
; ---------------------------------
|
|
_ufi_read_frmt_caps:
|
|
push ix
|
|
ld ix,0
|
|
add ix,sp
|
|
ld hl, -24
|
|
add hl, sp
|
|
ld sp, hl
|
|
;source-doc/ufi-drv/./class_ufi.c:65: ufi_cmd_read_format_capacities = _ufi_cmd_read_format_capacities;
|
|
ld hl,0
|
|
add hl, sp
|
|
ex de, hl
|
|
ld hl,__ufi_cmd_read_format_capacitie
|
|
ld bc,0x000c
|
|
ldir
|
|
;source-doc/ufi-drv/./class_ufi.c:66: result = usb_execute_cbi(storage_device, (uint8_t *)&ufi_cmd_read_format_capacities, false, 12, (uint8_t *)response, NULL);
|
|
ld c,(ix+6)
|
|
ld b,(ix+7)
|
|
push bc
|
|
ld hl,0x0000
|
|
push hl
|
|
push bc
|
|
ld l,0x0c
|
|
push hl
|
|
xor a
|
|
push af
|
|
inc sp
|
|
ld hl,9
|
|
add hl, sp
|
|
push hl
|
|
ld l,(ix+4)
|
|
ld h,(ix+5)
|
|
push hl
|
|
call _usb_execute_cbi
|
|
pop af
|
|
pop af
|
|
pop af
|
|
pop af
|
|
pop af
|
|
inc sp
|
|
ld e, l
|
|
pop bc
|
|
;source-doc/ufi-drv/./class_ufi.c:69: CHECK(result);
|
|
ld a,e
|
|
ld d,a
|
|
or a
|
|
jr NZ,l_ufi_read_frmt_caps_00103
|
|
;source-doc/ufi-drv/./class_ufi.c:71: const uint8_t available_length = response->capacity_list_length;
|
|
ld e,(ix+6)
|
|
ld d,(ix+7)
|
|
ld hl,3
|
|
add hl, de
|
|
ld e, (hl)
|
|
;source-doc/ufi-drv/./class_ufi.c:73: const uint8_t max_length =
|
|
ld a,0x24
|
|
sub e
|
|
jr NC,l_ufi_read_frmt_caps_00106
|
|
ld e,0x24
|
|
l_ufi_read_frmt_caps_00106:
|
|
;source-doc/ufi-drv/./class_ufi.c:77: memcpy(&cmd, &ufi_cmd_read_format_capacities, sizeof(cmd));
|
|
push de
|
|
push bc
|
|
ex de, hl
|
|
ld hl,16
|
|
add hl, sp
|
|
ex de, hl
|
|
ld hl,4
|
|
add hl, sp
|
|
ld bc,0x000c
|
|
ldir
|
|
pop bc
|
|
pop de
|
|
;source-doc/ufi-drv/./class_ufi.c:78: cmd.allocation_length[1] = max_length;
|
|
ld (ix-4),e
|
|
;source-doc/ufi-drv/./class_ufi.c:80: result = usb_execute_cbi(storage_device, (uint8_t *)&cmd, false, max_length, (uint8_t *)response, NULL);
|
|
ld d,0x00
|
|
ld hl,0x0000
|
|
push hl
|
|
push bc
|
|
push de
|
|
xor a
|
|
push af
|
|
inc sp
|
|
ld hl,19
|
|
add hl, sp
|
|
push hl
|
|
ld l,(ix+4)
|
|
ld h,(ix+5)
|
|
push hl
|
|
call _usb_execute_cbi
|
|
pop af
|
|
pop af
|
|
pop af
|
|
pop af
|
|
pop af
|
|
inc sp
|
|
ld d, l
|
|
;source-doc/ufi-drv/./class_ufi.c:84: done:
|
|
l_ufi_read_frmt_caps_00103:
|
|
;source-doc/ufi-drv/./class_ufi.c:85: return result;
|
|
ld l, d
|
|
;source-doc/ufi-drv/./class_ufi.c:86: }
|
|
ld sp, ix
|
|
pop ix
|
|
ret
|
|
;source-doc/ufi-drv/./class_ufi.c:88: usb_error ufi_inquiry(device_config *const storage_device, ufi_inquiry_response const *response) {
|
|
; ---------------------------------
|
|
; Function ufi_inquiry
|
|
; ---------------------------------
|
|
_ufi_inquiry:
|
|
push ix
|
|
ld ix,0
|
|
add ix,sp
|
|
ld hl, -12
|
|
add hl, sp
|
|
ld sp, hl
|
|
;source-doc/ufi-drv/./class_ufi.c:90: ufi_cmd_inquiry = _ufi_cmd_inquiry;
|
|
ld hl,0
|
|
add hl, sp
|
|
ld c, l
|
|
ld b, h
|
|
ld e, c
|
|
ld d, b
|
|
push bc
|
|
ld hl,__ufi_cmd_inquiry
|
|
ld bc,0x000c
|
|
ldir
|
|
pop bc
|
|
;source-doc/ufi-drv/./class_ufi.c:92: usb_error result =
|
|
ld e,(ix+6)
|
|
ld d,(ix+7)
|
|
ld hl,0x0000
|
|
push hl
|
|
push de
|
|
ld l,0x24
|
|
push hl
|
|
xor a
|
|
push af
|
|
inc sp
|
|
push bc
|
|
ld l,(ix+4)
|
|
ld h,(ix+5)
|
|
push hl
|
|
call _usb_execute_cbi
|
|
;source-doc/ufi-drv/./class_ufi.c:97: return result;
|
|
;source-doc/ufi-drv/./class_ufi.c:98: }
|
|
ld sp,ix
|
|
pop ix
|
|
ret
|
|
;source-doc/ufi-drv/./class_ufi.c:100: usb_error ufi_read_write_sector(device_config *const storage_device,
|
|
; ---------------------------------
|
|
; Function ufi_read_write_sector
|
|
; ---------------------------------
|
|
_ufi_read_write_sector:
|
|
push ix
|
|
ld ix,0
|
|
add ix,sp
|
|
ld hl, -12
|
|
add hl, sp
|
|
ld sp, hl
|
|
;source-doc/ufi-drv/./class_ufi.c:107: memset(&cmd, 0, sizeof(cmd));
|
|
ld hl,0
|
|
add hl, sp
|
|
ld b,0x0c
|
|
l_ufi_read_write_sector_00113:
|
|
ld (hl),0x00
|
|
inc hl
|
|
djnz l_ufi_read_write_sector_00113
|
|
;source-doc/ufi-drv/./class_ufi.c:108: cmd.operation_code = send ? 0x2A : 0x28;
|
|
bit 0,(ix+6)
|
|
jr Z,l_ufi_read_write_sector_00104
|
|
ld a,0x2a
|
|
jr l_ufi_read_write_sector_00105
|
|
l_ufi_read_write_sector_00104:
|
|
ld a,0x28
|
|
l_ufi_read_write_sector_00105:
|
|
ld (ix-12),a
|
|
;source-doc/ufi-drv/./class_ufi.c:109: cmd.lba[2] = sector_number >> 8;
|
|
ld a,(ix+8)
|
|
ld (ix-8),a
|
|
;source-doc/ufi-drv/./class_ufi.c:110: cmd.lba[3] = sector_number & 0xFF;
|
|
ld a,(ix+7)
|
|
ld (ix-7),a
|
|
;source-doc/ufi-drv/./class_ufi.c:111: cmd.transfer_length[1] = sector_count;
|
|
ld a,(ix+9)
|
|
ld (ix-4),a
|
|
;source-doc/ufi-drv/./class_ufi.c:113: usb_error result = usb_execute_cbi(storage_device, (uint8_t *)&cmd, send, 512 * sector_count, (uint8_t *)buffer, sense_codes);
|
|
ld a,(ix+9)
|
|
add a, a
|
|
ld c,0x00
|
|
ld l,(ix+12)
|
|
ld h,(ix+13)
|
|
push hl
|
|
ld l,(ix+10)
|
|
ld h,(ix+11)
|
|
push hl
|
|
ld b, a
|
|
push bc
|
|
ld a,(ix+6)
|
|
push af
|
|
inc sp
|
|
ld hl,7
|
|
add hl, sp
|
|
push hl
|
|
ld l,(ix+4)
|
|
ld h,(ix+5)
|
|
push hl
|
|
call _usb_execute_cbi
|
|
;source-doc/ufi-drv/./class_ufi.c:117: return result;
|
|
;source-doc/ufi-drv/./class_ufi.c:118: }
|
|
ld sp,ix
|
|
pop ix
|
|
ret
|
|
;source-doc/ufi-drv/./class_ufi.c:127: usb_error ufi_format(device_config *const storage_device,
|
|
; ---------------------------------
|
|
; Function ufi_format
|
|
; ---------------------------------
|
|
_ufi_format:
|
|
push ix
|
|
ld ix,0
|
|
add ix,sp
|
|
ld hl, -26
|
|
add hl, sp
|
|
ld sp, hl
|
|
;source-doc/ufi-drv/./class_ufi.c:134: memset(¶meter_list, 0, sizeof(parameter_list));
|
|
ld hl,2
|
|
add hl, sp
|
|
push hl
|
|
ld b,0x0c
|
|
l_ufi_format_00104:
|
|
ld (hl),0x00
|
|
inc hl
|
|
djnz l_ufi_format_00104
|
|
pop bc
|
|
;source-doc/ufi-drv/./class_ufi.c:137: cmd = _ufi_cmd_format;
|
|
ld hl,14
|
|
add hl, sp
|
|
ex de, hl
|
|
push bc
|
|
ld hl,__ufi_cmd_format
|
|
ld bc,0x000c
|
|
ldir
|
|
pop bc
|
|
;source-doc/ufi-drv/./class_ufi.c:140: cmd.track_number = track_number;
|
|
ld a,(ix+7)
|
|
ld (ix-10),a
|
|
;source-doc/ufi-drv/./class_ufi.c:141: cmd.interleave[1] = 0;
|
|
ld (ix-8),0x00
|
|
;source-doc/ufi-drv/./class_ufi.c:142: cmd.parameter_list_length[1] = sizeof(parameter_list);
|
|
ld (ix-4),0x0c
|
|
;source-doc/ufi-drv/./class_ufi.c:144: parameter_list.defect_list_header.side = side;
|
|
ld e, c
|
|
ld d, b
|
|
inc de
|
|
ld a,(ix+6)
|
|
and 0x01
|
|
ld l, a
|
|
ld a, (de)
|
|
and 0xfe
|
|
or l
|
|
ld (de), a
|
|
;source-doc/ufi-drv/./class_ufi.c:145: parameter_list.defect_list_header.immediate = 0;
|
|
ld l, e
|
|
ld h, d
|
|
res 1, (hl)
|
|
;source-doc/ufi-drv/./class_ufi.c:146: parameter_list.defect_list_header.reserved2 = 0;
|
|
ld l, e
|
|
ld h, d
|
|
ld a, (hl)
|
|
and 0xf3
|
|
ld (hl), a
|
|
;source-doc/ufi-drv/./class_ufi.c:147: parameter_list.defect_list_header.single_track = 1;
|
|
ld l, e
|
|
ld h, d
|
|
set 4, (hl)
|
|
;source-doc/ufi-drv/./class_ufi.c:148: parameter_list.defect_list_header.dcrt = 1;
|
|
ld l, e
|
|
ld h, d
|
|
set 5, (hl)
|
|
;source-doc/ufi-drv/./class_ufi.c:149: parameter_list.defect_list_header.extend = 0;
|
|
ld l, e
|
|
ld h, d
|
|
res 6, (hl)
|
|
;source-doc/ufi-drv/./class_ufi.c:150: parameter_list.defect_list_header.fov = 1;
|
|
ex de, hl
|
|
set 7, (hl)
|
|
;source-doc/ufi-drv/./class_ufi.c:151: parameter_list.defect_list_header.defect_list_length_msb = 0;
|
|
ld (ix-22),0x00
|
|
;source-doc/ufi-drv/./class_ufi.c:152: parameter_list.defect_list_header.defect_list_length_lsb = 8;
|
|
ld (ix-21),0x08
|
|
;source-doc/ufi-drv/./class_ufi.c:153: memcpy(¶meter_list.format_descriptor, (void *)format, sizeof(ufi_format_capacity_descriptor));
|
|
ld e,(ix+8)
|
|
ld d,(ix+9)
|
|
push bc
|
|
ld l, e
|
|
ld h, d
|
|
ex de, hl
|
|
ld hl,8
|
|
add hl, sp
|
|
ex de, hl
|
|
ld bc,0x0008
|
|
ldir
|
|
pop bc
|
|
;source-doc/ufi-drv/./class_ufi.c:155: usb_error result = usb_execute_cbi(storage_device, (uint8_t *)&cmd, true, sizeof(parameter_list), (uint8_t *)¶meter_list,
|
|
ld hl,0
|
|
add hl, sp
|
|
push hl
|
|
push bc
|
|
ld hl,0x000c
|
|
push hl
|
|
ld a,0x01
|
|
push af
|
|
inc sp
|
|
ld hl,21
|
|
add hl, sp
|
|
push hl
|
|
ld l,(ix+4)
|
|
ld h,(ix+5)
|
|
push hl
|
|
call _usb_execute_cbi
|
|
;source-doc/ufi-drv/./class_ufi.c:162: return result;
|
|
;source-doc/ufi-drv/./class_ufi.c:163: }
|
|
ld sp,ix
|
|
pop ix
|
|
ret
|
|
;source-doc/ufi-drv/./class_ufi.c:165: usb_error ufi_send_diagnostics(device_config *const storage_device) {
|
|
; ---------------------------------
|
|
; Function ufi_send_diagnostics
|
|
; ---------------------------------
|
|
_ufi_send_diagnostics:
|
|
push ix
|
|
ld ix,0
|
|
add ix,sp
|
|
ld hl, -12
|
|
add hl, sp
|
|
ld sp, hl
|
|
;source-doc/ufi-drv/./class_ufi.c:168: ufi_cmd_send_diagnostic = _ufi_cmd_send_diagnostic;
|
|
ld hl,0
|
|
add hl, sp
|
|
ld c, l
|
|
ld b, h
|
|
ld e, c
|
|
ld d, b
|
|
push bc
|
|
ld hl,__ufi_cmd_send_diagnostic
|
|
ld bc,0x000c
|
|
ldir
|
|
pop bc
|
|
;source-doc/ufi-drv/./class_ufi.c:170: return usb_execute_cbi(storage_device, (uint8_t *)&ufi_cmd_send_diagnostic, true, 0, NULL, NULL);
|
|
ld hl,0x0000
|
|
push hl
|
|
push hl
|
|
push hl
|
|
ld a,0x01
|
|
push af
|
|
inc sp
|
|
push bc
|
|
ld l,(ix+4)
|
|
ld h,(ix+5)
|
|
push hl
|
|
call _usb_execute_cbi
|
|
;source-doc/ufi-drv/./class_ufi.c:171: }
|
|
ld sp,ix
|
|
pop ix
|
|
ret
|
|
;source-doc/ufi-drv/./class_ufi.c:173: uint32_t convert_from_msb_first(const uint8_t *const buffer) {
|
|
; ---------------------------------
|
|
; Function convert_from_msb_first
|
|
; ---------------------------------
|
|
_convert_from_msb_first:
|
|
push ix
|
|
ld ix,0
|
|
add ix,sp
|
|
push af
|
|
push af
|
|
;source-doc/ufi-drv/./class_ufi.c:175: uint8_t *p_output = ((uint8_t *)&result);
|
|
ld hl,0
|
|
add hl, sp
|
|
ex de, hl
|
|
;source-doc/ufi-drv/./class_ufi.c:176: const uint8_t *p_input = buffer + 3;
|
|
ld c,(ix+4)
|
|
ld b,(ix+5)
|
|
inc bc
|
|
inc bc
|
|
inc bc
|
|
;source-doc/ufi-drv/./class_ufi.c:178: *p_output++ = *p_input--;
|
|
ld a, (bc)
|
|
dec bc
|
|
ld (de), a
|
|
inc de
|
|
;source-doc/ufi-drv/./class_ufi.c:179: *p_output++ = *p_input--;
|
|
ld a, (bc)
|
|
dec bc
|
|
ld (de), a
|
|
inc de
|
|
;source-doc/ufi-drv/./class_ufi.c:180: *p_output++ = *p_input--;
|
|
ld a, (bc)
|
|
ld (de), a
|
|
inc de
|
|
;source-doc/ufi-drv/./class_ufi.c:181: *p_output = *p_input--;
|
|
dec bc
|
|
ld a, (bc)
|
|
ld (de), a
|
|
;source-doc/ufi-drv/./class_ufi.c:183: return result;
|
|
pop hl
|
|
push hl
|
|
ld e,(ix-2)
|
|
ld d,(ix-1)
|
|
;source-doc/ufi-drv/./class_ufi.c:184: }
|
|
ld sp, ix
|
|
pop ix
|
|
ret
|
|
|