// ------------------------------------------------------------------------------------------------
static void ehci_probe(EHCI_Controller* hc)
{
// Port setup
uint port_count = hc->cap_regs->hcs_params & HCSPARAMS_N_PORTS_MASK;
for (uint port = 0; port < port_count; ++port)
{
// Reset port
uint status = ehci_reset_port(hc, port);
if (status & PORT_ENABLE)
{
uint speed = USB_HIGH_SPEED;
USB_Device* dev = usb_dev_create();
if (dev)
{
dev->parent = 0;
dev->hc = hc;
dev->port = port;
dev->speed = speed;
dev->max_packet_size = 8;
dev->hc_control = ehci_dev_control;
dev->hc_intr = ehci_dev_intr;
if (!usb_dev_init(dev))
{
// TODO - cleanup
}
}
}
}
}
int unplug_procedure(int device) {
int retval = 1;
if (unplug_device != 0) {
if (_ehci_data[device].__usbfd.usb_fd)
if (ehci_reset_port2(_ehci_data[device].__ehci, /*__usbfd.usb_fd->port*/0) >= 0) {
if (_ehci_data[device].__usbfd.buffer != NULL)
USB_Free(_ehci_data[device].__usbfd.buffer);
_ehci_data[device].__usbfd.buffer = NULL;
if (ehci_reset_port(_ehci_data[device].__ehci, 0) >= 0) {
handshake_mode = 1;
if (USBStorage_Try_Device(&_ehci_data[device]) == 0) {
retval = 0;
unplug_device = 0;
}
handshake_mode = 0;
}
}
ehci_msleep(100);
}
return retval;
}
s32 USBStorage_Init(void) {
int i, j, retries = 1;
// debug_printf("usbstorage init %d\n", ums_init_done);
if (!ums_init_done)
{
_ehci_device_count = 0;
init_ehci_device_struct();
}
struct ehci_hcd *ehci = &ehci_hcds[0];
try_status = -1;
for (j = 0; j < EHCI_HCD_COUNT; j++) {
for (i = 0; i < ehci->num_port; i++) {
struct ehci_device *dev = &ehci->devices[i];
retry:
dev->port = i;
if (dev->id != 0 && dev->busy == 0) {
handshake_mode = 1;
if (ehci_reset_port(ehci, i) >= 0) {
//ehci_device_data * device_data = find_ehci_data(ehci);
ehci_device_data * device_data = &_ehci_data[_ehci_device_count];
dev->busy = 1;
device_data->__ehci = ehci;
device_data->__dev = dev;
if (USBStorage_Try_Device(device_data) == 0) {
printf("EHCI bus %d device %d: vendor %04X product %04X : Mass-Storage Device\n", j, dev->id, device_data->__vid, device_data->__pid);
first_access = TRUE;
handshake_mode = 0;
ums_init_done = 1;
unplug_device = 0;
//__bdev=register_bdev(NULL, &usb2mass_ops, "uda");
//register_disc_interface(&usb2mass_ops);
device_data->__ready = 1;
if (mount_usb_device)
mount_usb_device(_ehci_device_count);
_ehci_device_count++;
#ifdef MEM_PRINT
s_printf("USBStorage_Init() Ok\n");
#endif
//return 0;
}
}
} else if (dev->busy == 0) {
u32 status;
handshake_mode = 1;
status = ehci_readl(&ehci->regs->port_status[i]);
#ifdef MEM_PRINT
s_printf("USBStorage_Init() status %x\n", status);
#endif
if (status & 1) {
if (ehci_reset_port2(ehci, i) < 0) {
ehci_msleep(100);
ehci_reset_port(ehci, i);
}
if (retries) {
retries--;
goto retry;
}
}
}
}
ehci++;
}
return try_status;
}