MirrorRepos
/
RomWBW
mirror of https://github.com/wwarthen/RomWBW.git
1
0
Fork 1
Code Issues Projects Releases Wiki Activity
Browse Source

ch376-native: refactored usb init/enumerating

pull/592/head
Dean Netherton 9 months ago
parent
7e8560f9a9
commit
802c1b41ff
2 changed files with 379 additions and 219 deletions
Whitespace
Show all changes Ignore whitespace when comparing lines Ignore changes in amount of whitespace Ignore changes in whitespace at EOL
Unified View
Diff Options
Show Stats Download Patch File Download Diff File
  1. 458
      Source/HBIOS/ch376-native/base-drv/usb-init.c.s
  2. 140
      Source/HBIOS/ch376-native/source-doc/base-drv/usb-init.c

458
Source/HBIOS/ch376-native/base-drv/usb-init.c.s
View File

@ -83,243 +83,365 @@ _usb_host_bus_reset:
ld l,0x00 ld l,0x00
;source-doc/base-drv/usb-init.c:21: } ;source-doc/base-drv/usb-init.c:21: }
ret ret
;source-doc/base-drv/usb-init.c:25: void _chnative_init(bool forced) {
;source-doc/base-drv/usb-init.c:25: uint16_t ch376_init(uint8_t state) {
; --------------------------------- ; ---------------------------------
; Function _chnative_init
; Function ch376_init
; --------------------------------- ; ---------------------------------
__chnative_init:
_ch376_init:
push ix push ix
ld ix,0 ld ix,0
add ix,sp add ix,sp
dec sp
;source-doc/base-drv/usb-init.c:26: memset(get_usb_work_area(), 0, sizeof(_usb_state));
ld hl,_x
ld (hl),0x00
ld e, l
ld d, h
inc de
ld bc,0x0068
ldir
;source-doc/base-drv/usb-init.c:28: USB_MODULE_LEDS = 0x03; ;source-doc/base-drv/usb-init.c:28: USB_MODULE_LEDS = 0x03;
ld a,0x03 ld a,0x03
ld bc,_USB_MODULE_LEDS ld bc,_USB_MODULE_LEDS
out (c), a out (c), a
;source-doc/base-drv/usb-init.c:30: ch_cmd_reset_all();
;source-doc/base-drv/usb-init.c:30: if (state == 0) {
ld a,(ix+4)
or a
jr NZ,l_ch376_init_00104
;source-doc/base-drv/usb-init.c:31: ch_cmd_reset_all();
call _ch_cmd_reset_all call _ch_cmd_reset_all
;source-doc/base-drv/usb-init.c:32: delay_medium(); ;source-doc/base-drv/usb-init.c:32: delay_medium();
call _delay_medium call _delay_medium
;source-doc/base-drv/usb-init.c:34: if (forced) {
bit 0,(ix+4)
jr Z,l__chnative_init_00110
;source-doc/base-drv/usb-init.c:35: bool indicator = true;
ld (ix-1),0x01
;source-doc/base-drv/usb-init.c:36: print_string("\r\nCH376: *$");
ld hl,usb_init_str_0
call _print_string
;source-doc/base-drv/usb-init.c:37: while (!ch_probe()) {
l__chnative_init_00104:
;source-doc/base-drv/usb-init.c:34: if (!ch_probe()) {
call _ch_probe call _ch_probe
ld a, l ld a, l
;source-doc/base-drv/usb-init.c:35: USB_MODULE_LEDS = 0x00;
or a or a
jr NZ,l__chnative_init_00106
;source-doc/base-drv/usb-init.c:38: if (indicator) {
bit 0,(ix-1)
jr Z,l__chnative_init_00102
;source-doc/base-drv/usb-init.c:39: USB_MODULE_LEDS = 0x00;
jr NZ,l_ch376_init_00102
ld bc,_USB_MODULE_LEDS
out (c), a
;source-doc/base-drv/usb-init.c:36: return 0xFF00;
ld hl,0xff00
jp l_ch376_init_00113
l_ch376_init_00102:
;source-doc/base-drv/usb-init.c:38: USB_MODULE_LEDS = 0x00;
ld a,0x00 ld a,0x00
ld bc,_USB_MODULE_LEDS ld bc,_USB_MODULE_LEDS
out (c), a out (c), a
;source-doc/base-drv/usb-init.c:40: print_string("\b $");
ld hl,usb_init_str_1
call _print_string
jr l__chnative_init_00103
l__chnative_init_00102:
;source-doc/base-drv/usb-init.c:42: USB_MODULE_LEDS = 0x03;
ld a,0x03
;source-doc/base-drv/usb-init.c:39: return 1;
ld hl,0x0001
jr l_ch376_init_00113
l_ch376_init_00104:
;source-doc/base-drv/usb-init.c:42: if (state == 1) {
ld a,(ix+4)
dec a
jr NZ,l_ch376_init_00106
;source-doc/base-drv/usb-init.c:43: r = ch_cmd_get_ic_version();
call _ch_cmd_get_ic_version
;source-doc/base-drv/usb-init.c:45: USB_MODULE_LEDS = 0x00;
ld a,0x00
ld bc,_USB_MODULE_LEDS ld bc,_USB_MODULE_LEDS
out (c), a out (c), a
;source-doc/base-drv/usb-init.c:43: print_string("\b*$");
;source-doc/base-drv/usb-init.c:46: return (uint16_t)r << 8 | 2;
xor a
ld h, l
ld l,0x02
jr l_ch376_init_00113
l_ch376_init_00106:
;source-doc/base-drv/usb-init.c:49: if (state == 2) {
ld a,(ix+4)
sub 0x02
jr NZ,l_ch376_init_00159
ld a,0x01
jr l_ch376_init_00160
l_ch376_init_00159:
xor a
l_ch376_init_00160:
ld c,a
or a
jr Z,l_ch376_init_00110
;source-doc/base-drv/usb-init.c:50: usb_host_bus_reset();
call _usb_host_bus_reset
;source-doc/base-drv/usb-init.c:52: r = ch_very_short_wait_int_and_get_();
call _ch_very_short_wait_int_and_get
ld a, l
;source-doc/base-drv/usb-init.c:54: if (r != USB_INT_CONNECT) {
sub 0x81
jr Z,l_ch376_init_00108
;source-doc/base-drv/usb-init.c:55: USB_MODULE_LEDS = 0x00;
ld a,0x00
ld bc,_USB_MODULE_LEDS
out (c), a
;source-doc/base-drv/usb-init.c:56: return 2;
ld hl,0x0002
jr l_ch376_init_00113
l_ch376_init_00108:
;source-doc/base-drv/usb-init.c:59: return 3;
ld hl,0x0003
jr l_ch376_init_00113
l_ch376_init_00110:
;source-doc/base-drv/usb-init.c:62: memset(get_usb_work_area(), 0, sizeof(_usb_state));
ld b,0x35
ld hl,_x
jr l_ch376_init_00163
l_ch376_init_00162:
ld (hl),0x00
inc hl
l_ch376_init_00163:
ld (hl),0x00
inc hl
djnz l_ch376_init_00162
;source-doc/base-drv/usb-init.c:63: if (state != 2) {
bit 0, c
jr NZ,l_ch376_init_00112
;source-doc/base-drv/usb-init.c:64: usb_host_bus_reset();
call _usb_host_bus_reset
;source-doc/base-drv/usb-init.c:65: delay_medium();
call _delay_medium
l_ch376_init_00112:
;source-doc/base-drv/usb-init.c:67: enumerate_all_devices();
call _enumerate_all_devices
;source-doc/base-drv/usb-init.c:68: USB_MODULE_LEDS = 0x00;
ld a,0x00
ld bc,_USB_MODULE_LEDS
out (c), a
;source-doc/base-drv/usb-init.c:69: return (uint16_t)count_of_devices() << 8 | state + 1;
call _count_of_devices
ld c,(ix+4)
ld b,0x00
inc bc
or b
ld h, a
ld l, c
l_ch376_init_00113:
;source-doc/base-drv/usb-init.c:70: }
pop ix
ret
;source-doc/base-drv/usb-init.c:72: static uint16_t wait_for_state(const uint8_t loop_counter, uint8_t state, const uint8_t desired_state) __sdcccall(1) {
; ---------------------------------
; Function wait_for_state
; ---------------------------------
_wait_for_state:
push ix
ld ix,0
add ix,sp
dec sp
ld (ix-1),a
ld b, l
;source-doc/base-drv/usb-init.c:73: uint16_t r = state;
ld e, b
;source-doc/base-drv/usb-init.c:75: for (uint8_t i = 0; i < loop_counter; i++) {
ld d,0x00
ld c,d
l_wait_for_state_00108:
ld a, c
sub (ix-1)
jr NC,l_wait_for_state_00106
;source-doc/base-drv/usb-init.c:76: if (state == desired_state)
ld a,(ix+4)
sub b
jr Z,l_wait_for_state_00106
;source-doc/base-drv/usb-init.c:79: if (i & 1)
bit 0, c
jr Z,l_wait_for_state_00104
;source-doc/base-drv/usb-init.c:80: print_string("\b $");
push bc
ld hl,usb_init_str_0
call _print_string
pop bc
jr l_wait_for_state_00105
l_wait_for_state_00104:
;source-doc/base-drv/usb-init.c:82: print_string("\b*$");
push bc
ld hl,usb_init_str_1
call _print_string
pop bc
l_wait_for_state_00105:
;source-doc/base-drv/usb-init.c:84: r = ch376_init(state);
push bc
push bc
inc sp
call _ch376_init
inc sp
ex de, hl
pop bc
;source-doc/base-drv/usb-init.c:85: state = r & 255;
ld b, e
;source-doc/base-drv/usb-init.c:75: for (uint8_t i = 0; i < loop_counter; i++) {
inc c
jr l_wait_for_state_00108
l_wait_for_state_00106:
;source-doc/base-drv/usb-init.c:88: return r;
;source-doc/base-drv/usb-init.c:89: }
inc sp
pop ix
pop hl
inc sp
jp (hl)
usb_init_str_0:
DEFB 0x08
DEFM " $"
DEFB 0x00
usb_init_str_1:
DEFB 0x08
DEFM "*$"
DEFB 0x00
;source-doc/base-drv/usb-init.c:91: void _chnative_init(bool forced) {
; ---------------------------------
; Function _chnative_init
; ---------------------------------
__chnative_init:
push ix
ld ix,0
add ix,sp
dec sp
;source-doc/base-drv/usb-init.c:94: const uint8_t loop_counter = forced ? 40 : 5;
bit 0,(ix+4)
jr Z,l__chnative_init_00113
ld a,0x28
jr l__chnative_init_00114
l__chnative_init_00113:
ld a,0x05
l__chnative_init_00114:
ld (ix-1),a
;source-doc/base-drv/usb-init.c:96: print_string("\r\nCH376: *$");
ld hl,usb_init_str_2 ld hl,usb_init_str_2
call _print_string call _print_string
l__chnative_init_00103:
;source-doc/base-drv/usb-init.c:46: delay_medium();
call _delay_medium
;source-doc/base-drv/usb-init.c:47: indicator = !indicator;
;source-doc/base-drv/usb-init.c:98: r = wait_for_state(loop_counter, state, 1);
ld a,0x01
push af
inc sp
ld l,0x00
ld a,(ix-1) ld a,(ix-1)
xor 0x01
ld (ix-1),a
jr l__chnative_init_00104
l__chnative_init_00106:
;source-doc/base-drv/usb-init.c:50: print_string("\bPRESENT (VER $");
call _wait_for_state
ld b, e
;source-doc/base-drv/usb-init.c:99: state = r & 255;
;source-doc/base-drv/usb-init.c:101: print_string("\bPRESENT (VER $");
push bc
ld hl,usb_init_str_3 ld hl,usb_init_str_3
call _print_string call _print_string
jr l__chnative_init_00111
l__chnative_init_00110:
;source-doc/base-drv/usb-init.c:52: if (!ch_probe()) {
call _ch_probe
ld a, l
or a
jr NZ,l__chnative_init_00108
;source-doc/base-drv/usb-init.c:53: USB_MODULE_LEDS = 0x03;
ld a,0x03
ld bc,_USB_MODULE_LEDS
out (c), a
;source-doc/base-drv/usb-init.c:54: print_string("\r\nCH376: NOT PRESENT$");
;source-doc/base-drv/usb-init.c:103: r = ch376_init(state);
inc sp
call _ch376_init
inc sp
ex de, hl
;source-doc/base-drv/usb-init.c:104: state = r & 255;
ld c, e
;source-doc/base-drv/usb-init.c:105: if (state != 2) {
ld a, c
sub 0x02
jr Z,l__chnative_init_00102
;source-doc/base-drv/usb-init.c:106: print_string("\rCH376: $");
ld hl,usb_init_str_4 ld hl,usb_init_str_4
call _print_string call _print_string
;source-doc/base-drv/usb-init.c:55: return;
jp l__chnative_init_00127
l__chnative_init_00108:
;source-doc/base-drv/usb-init.c:58: print_string("\r\nCH376: PRESENT (VER $");
;source-doc/base-drv/usb-init.c:107: print_string("VERSION FAILURE\r\n$");
ld hl,usb_init_str_5 ld hl,usb_init_str_5
call _print_string call _print_string
l__chnative_init_00111:
;source-doc/base-drv/usb-init.c:61: USB_MODULE_LEDS = 0x00;
ld a,0x00
ld bc,_USB_MODULE_LEDS
out (c), a
;source-doc/base-drv/usb-init.c:63: print_hex(ch_cmd_get_ic_version());
call _ch_cmd_get_ic_version
;source-doc/base-drv/usb-init.c:108: return;
jr l__chnative_init_00111
l__chnative_init_00102:
;source-doc/base-drv/usb-init.c:111: print_hex(r >> 8);
push bc
ld l, d
call _print_hex call _print_hex
;source-doc/base-drv/usb-init.c:64: print_string("); $");
;source-doc/base-drv/usb-init.c:112: print_string("); $");
ld hl,usb_init_str_6 ld hl,usb_init_str_6
call _print_string call _print_string
;source-doc/base-drv/usb-init.c:66: usb_host_bus_reset();
call _usb_host_bus_reset
;source-doc/base-drv/usb-init.c:68: for (uint8_t i = 0; i < (forced ? 80 : 5); i++) {
ld c,0x00
l__chnative_init_00125:
bit 0,(ix+4)
jr Z,l__chnative_init_00129
ld b,0x50
jr l__chnative_init_00130
l__chnative_init_00129:
ld b,0x05
l__chnative_init_00130:
ld a, c
sub b
jr NC,l__chnative_init_00121
;source-doc/base-drv/usb-init.c:69: const uint8_t r = ch_very_short_wait_int_and_get_();
push bc
call _ch_very_short_wait_int_and_get
ld a, l
pop bc
;source-doc/base-drv/usb-init.c:71: if (r == USB_INT_CONNECT) {
sub 0x81
jr NZ,l__chnative_init_00126
;source-doc/base-drv/usb-init.c:72: print_string("USB: CONNECTED$");
;source-doc/base-drv/usb-init.c:114: print_string("USB: *$");
ld hl,usb_init_str_7 ld hl,usb_init_str_7
call _print_string call _print_string
;source-doc/base-drv/usb-init.c:74: enumerate_all_devices();
call _enumerate_all_devices
;source-doc/base-drv/usb-init.c:76: if (forced && count_of_devices() == 0) {
bit 0,(ix+4)
jr Z,l__chnative_init_00118
call _count_of_devices
or a
jr NZ,l__chnative_init_00118
;source-doc/base-drv/usb-init.c:77: print_string("\r\nUSB: SCANNING $");
pop bc
;source-doc/base-drv/usb-init.c:116: r = wait_for_state(loop_counter, state, 3);
ld a,0x03
push af
inc sp
ld l, c
ld a,(ix-1)
call _wait_for_state
ld b, e
;source-doc/base-drv/usb-init.c:117: state = r & 255;
;source-doc/base-drv/usb-init.c:119: if (state == 2) {
ld a, b
sub 0x02
jr NZ,l__chnative_init_00104
;source-doc/base-drv/usb-init.c:120: print_string("\bDISCONNECTED$");
ld hl,usb_init_str_8 ld hl,usb_init_str_8
call _print_string call _print_string
;source-doc/base-drv/usb-init.c:79: for (i = 0; i < 10; i++) {
ld (ix-1),0x00
l__chnative_init_00122:
;source-doc/base-drv/usb-init.c:80: print_string(".$");
;source-doc/base-drv/usb-init.c:121: return;
jr l__chnative_init_00111
l__chnative_init_00104:
;source-doc/base-drv/usb-init.c:124: print_string("\bCONNECTED$");
push bc
ld hl,usb_init_str_9 ld hl,usb_init_str_9
call _print_string call _print_string
;source-doc/base-drv/usb-init.c:81: memset(get_usb_work_area(), 0, sizeof(_usb_state));
ld hl,_x
ld (hl),0x00
ld e, l
ld d, h
inc de
ld bc,0x0068
ldir
;source-doc/base-drv/usb-init.c:82: usb_host_bus_reset();
call _usb_host_bus_reset
;source-doc/base-drv/usb-init.c:84: delay_medium();
call _delay_medium
;source-doc/base-drv/usb-init.c:85: enumerate_all_devices();
call _enumerate_all_devices
;source-doc/base-drv/usb-init.c:87: if (count_of_devices() > 0)
call _count_of_devices
or a
jr NZ,l__chnative_init_00118
;source-doc/base-drv/usb-init.c:79: for (i = 0; i < 10; i++) {
inc (ix-1)
ld a,(ix-1)
sub 0x0a
jr C,l__chnative_init_00122
;source-doc/base-drv/usb-init.c:92: connected:
l__chnative_init_00118:
;source-doc/base-drv/usb-init.c:93: USB_MODULE_LEDS = 0x00;
;source-doc/base-drv/usb-init.c:127: r = ch376_init(state);
inc sp
call _ch376_init
inc sp
ex de, hl
;source-doc/base-drv/usb-init.c:128: state = r & 255;
ld b, e
;source-doc/base-drv/usb-init.c:130: for (uint8_t i = 0; i < loop_counter; i++) {
ld c,0x00
l__chnative_init_00109:
ld a, c
sub (ix-1)
jr NC,l__chnative_init_00111
;source-doc/base-drv/usb-init.c:131: if (r >> 8 != 0)
ld a,0x00 ld a,0x00
ld bc,_USB_MODULE_LEDS
out (c), a
;source-doc/base-drv/usb-init.c:94: return;
jr l__chnative_init_00127
l__chnative_init_00126:
;source-doc/base-drv/usb-init.c:68: for (uint8_t i = 0; i < (forced ? 80 : 5); i++) {
inc c
jr l__chnative_init_00125
l__chnative_init_00121:
;source-doc/base-drv/usb-init.c:98: USB_MODULE_LEDS = 0x03;
ld a,0x03
ld bc,_USB_MODULE_LEDS
out (c), a
;source-doc/base-drv/usb-init.c:99: print_string("USB: DISCONNECTED$");
or d
jr NZ,l__chnative_init_00111
;source-doc/base-drv/usb-init.c:134: print_string(".$");
push bc
ld hl,usb_init_str_10 ld hl,usb_init_str_10
call _print_string call _print_string
l__chnative_init_00127:
;source-doc/base-drv/usb-init.c:100: }
pop bc
;source-doc/base-drv/usb-init.c:135: r = ch376_init(state);
push bc
push bc
inc sp
call _ch376_init
inc sp
ex de, hl
pop bc
;source-doc/base-drv/usb-init.c:136: state = r & 255;
ld b, e
;source-doc/base-drv/usb-init.c:130: for (uint8_t i = 0; i < loop_counter; i++) {
inc c
jr l__chnative_init_00109
l__chnative_init_00111:
;source-doc/base-drv/usb-init.c:138: }
inc sp inc sp
pop ix pop ix
ret ret
usb_init_str_0:
usb_init_str_2:
DEFB 0x0d DEFB 0x0d
DEFB 0x0a DEFB 0x0a
DEFM "CH376: *$" DEFM "CH376: *$"
DEFB 0x00 DEFB 0x00
usb_init_str_1:
DEFB 0x08
DEFM " $"
DEFB 0x00
usb_init_str_2:
DEFB 0x08
DEFM "*$"
DEFB 0x00
usb_init_str_3: usb_init_str_3:
DEFB 0x08 DEFB 0x08
DEFM "PRESENT (VER $" DEFM "PRESENT (VER $"
DEFB 0x00 DEFB 0x00
usb_init_str_4: usb_init_str_4:
DEFB 0x0d DEFB 0x0d
DEFB 0x0a
DEFM "CH376: NOT PRESENT$"
DEFM "CH376: $"
DEFB 0x00 DEFB 0x00
usb_init_str_5: usb_init_str_5:
DEFM "VERSION FAILURE"
DEFB 0x0d DEFB 0x0d
DEFB 0x0a DEFB 0x0a
DEFM "CH376: PRESENT (VER $"
DEFM "$"
DEFB 0x00 DEFB 0x00
usb_init_str_6: usb_init_str_6:
DEFM "); $" DEFM "); $"
DEFB 0x00 DEFB 0x00
usb_init_str_7: usb_init_str_7:
DEFM "USB: CONNECTED$"
DEFM "USB: *$"
DEFB 0x00 DEFB 0x00
usb_init_str_8: usb_init_str_8:
DEFB 0x0d
DEFB 0x0a
DEFM "USB: SCANNING $"
DEFB 0x08
DEFM "DISCONNECTED$"
DEFB 0x00 DEFB 0x00
usb_init_str_9: usb_init_str_9:
DEFM ".$"
DEFB 0x08
DEFM "CONNECTED$"
DEFB 0x00 DEFB 0x00
usb_init_str_10: usb_init_str_10:
DEFM "USB: DISCONNECTED$"
DEFM ".$"
DEFB 0x00 DEFB 0x00
;source-doc/base-drv/usb-init.c:102: void chnative_init_force(void) { _chnative_init(true); }
;source-doc/base-drv/usb-init.c:140: void chnative_init_force(void) { _chnative_init(true); }
; --------------------------------- ; ---------------------------------
; Function chnative_init_force ; Function chnative_init_force
; --------------------------------- ; ---------------------------------
@ -330,7 +452,7 @@ _chnative_init_force:
call __chnative_init call __chnative_init
inc sp inc sp
ret ret
;source-doc/base-drv/usb-init.c:104: void chnative_init(void) { _chnative_init(false); }
;source-doc/base-drv/usb-init.c:142: void chnative_init(void) { _chnative_init(false); }
; --------------------------------- ; ---------------------------------
; Function chnative_init ; Function chnative_init
; --------------------------------- ; ---------------------------------

140
Source/HBIOS/ch376-native/source-doc/base-drv/usb-init.c
View File

@ -22,81 +22,119 @@ static usb_error usb_host_bus_reset(void) {
#define ERASE_LINE "\x1B\x6C\r$" #define ERASE_LINE "\x1B\x6C\r$"
void _chnative_init(bool forced) {
memset(get_usb_work_area(), 0, sizeof(_usb_state));
uint16_t ch376_init(uint8_t state) {
uint8_t r;
USB_MODULE_LEDS = 0x03; USB_MODULE_LEDS = 0x03;
ch_cmd_reset_all();
if (state == 0) {
ch_cmd_reset_all();
delay_medium();
delay_medium();
if (!ch_probe()) {
USB_MODULE_LEDS = 0x00;
return 0xFF00;
}
USB_MODULE_LEDS = 0x00;
return 1;
}
if (forced) {
bool indicator = true;
print_string("\r\nCH376: *$");
while (!ch_probe()) {
if (indicator) {
USB_MODULE_LEDS = 0x00;
print_string("\b $");
} else {
USB_MODULE_LEDS = 0x03;
print_string("\b*$");
}
if (state == 1) {
r = ch_cmd_get_ic_version();
delay_medium();
indicator = !indicator;
}
USB_MODULE_LEDS = 0x00;
return (uint16_t)r << 8 | 2;
}
print_string("\bPRESENT (VER $");
} else {
if (!ch_probe()) {
USB_MODULE_LEDS = 0x03;
print_string("\r\nCH376: NOT PRESENT$");
return;
if (state == 2) {
usb_host_bus_reset();
r = ch_very_short_wait_int_and_get_status();
if (r != USB_INT_CONNECT) {
USB_MODULE_LEDS = 0x00;
return 2;
} }
print_string("\r\nCH376: PRESENT (VER $");
return 3;
} }
memset(get_usb_work_area(), 0, sizeof(_usb_state));
if (state != 2) {
usb_host_bus_reset();
delay_medium();
}
enumerate_all_devices();
USB_MODULE_LEDS = 0x00; USB_MODULE_LEDS = 0x00;
return (uint16_t)count_of_devices() << 8 | state + 1;
}
print_hex(ch_cmd_get_ic_version());
print_string("); $");
static uint16_t wait_for_state(const uint8_t loop_counter, uint8_t state, const uint8_t desired_state) __sdcccall(1) {
uint16_t r = state;
usb_host_bus_reset();
for (uint8_t i = 0; i < loop_counter; i++) {
if (state == desired_state)
break;
for (uint8_t i = 0; i < (forced ? 80 : 5); i++) {
const uint8_t r = ch_very_short_wait_int_and_get_status();
if (i & 1)
print_string("\b $");
else
print_string("\b*$");
if (r == USB_INT_CONNECT) {
print_string("USB: CONNECTED$");
r = ch376_init(state);
state = r & 255;
}
enumerate_all_devices();
return r;
}
if (forced && count_of_devices() == 0) {
print_string("\r\nUSB: SCANNING $");
void _chnative_init(bool forced) {
uint8_t state = 0;
uint16_t r;
const uint8_t loop_counter = forced ? 40 : 5;
for (i = 0; i < 10; i++) {
print_string(".$");
memset(get_usb_work_area(), 0, sizeof(_usb_state));
usb_host_bus_reset();
print_string("\r\nCH376: *$");
delay_medium();
enumerate_all_devices();
r = wait_for_state(loop_counter, state, 1);
state = r & 255;
if (count_of_devices() > 0)
goto connected;
}
}
print_string("\bPRESENT (VER $");
connected:
USB_MODULE_LEDS = 0x00;
return;
}
r = ch376_init(state);
state = r & 255;
if (state != 2) {
print_string("\rCH376: $");
print_string("VERSION FAILURE\r\n$");
return;
} }
USB_MODULE_LEDS = 0x03;
print_string("USB: DISCONNECTED$");
print_hex(r >> 8);
print_string("); $");
print_string("USB: *$");
r = wait_for_state(loop_counter, state, 3);
state = r & 255;
if (state == 2) {
print_string("\bDISCONNECTED$");
return;
}
print_string("\bCONNECTED$");
// enumerate....
r = ch376_init(state);
state = r & 255;
for (uint8_t i = 0; i < loop_counter; i++) {
if (r >> 8 != 0)
break;
print_string(".$");
r = ch376_init(state);
state = r & 255;
}
} }
void chnative_init_force(void) { _chnative_init(true); } void chnative_init_force(void) { _chnative_init(true); }

Write Preview
Loading…
Cancel
Save