update usb test

This commit is contained in:
bunnie 2024-06-05 22:54:27 +08:00
parent 65df5b3066
commit 4261e70d3f

View file

@ -644,34 +644,40 @@ pub fn early_init() {
let mut idle_timer = 0; let mut idle_timer = 0;
let mut vbus_on = false; let mut vbus_on = false;
let mut vbus_on_count = 0; let mut vbus_on_count = 0;
let mut in_u0 = true; let mut in_u0 = false;
loop { loop {
if usb.udc_handle_interrupt() == usb_test::CorigineEvent::None { let event = usb.udc_handle_interrupt();
if event == usb_test::CorigineEvent::None {
idle_timer += 1; idle_timer += 1;
} else { } else {
crate::println!("Event at {}", idle_timer); // crate::println!("*Event {:?} at {}", event, idle_timer);
idle_timer = 0; idle_timer = 0;
} }
if !vbus_on && vbus_on_count == 4 { if !vbus_on && vbus_on_count == 4 {
crate::println!("vbus on"); crate::println!("*Vbus on");
usb.reset(); usb.reset();
usb.init(); usb.init();
usb.start(); usb.start();
vbus_on = true; vbus_on = true;
in_u0 = false; in_u0 = false;
} else if usb.pp() && !vbus_on {
vbus_on_count += 1;
crate::println!("*Vbus_on_count: {}", vbus_on_count);
// mdelay(100);
} else if !usb.pp() && vbus_on { } else if !usb.pp() && vbus_on {
crate::println!("vbus off"); crate::println!("*Vbus off");
usb.stop(); usb.stop();
usb.reset(); usb.reset();
vbus_on_count = 0; vbus_on_count = 0;
vbus_on = false; vbus_on = false;
in_u0 = false; in_u0 = false;
} else if in_u0 && vbus_on { } else if in_u0 && vbus_on {
crate::println!("some handler here"); // usb.udc_handle_interrupt();
// TODO // TODO
} else if usb.ccs() && vbus_on { } else if usb.ccs() && vbus_on {
usb.print_status(); usb.print_status(usb.csr.r(crate::platform::usb_test::corigine_usb::PORTSC));
crate::println!("enter U0"); crate::println!("*Enter U0");
in_u0 = true; in_u0 = true;
} }
} }