Commit 90960744 authored by Mauro Carvalho Chehab's avatar Mauro Carvalho Chehab

V4L/DVB (11132): cx231xx: usb probe cleanups

Simplifies the usb probe logic, cleaning the printed messages during the probing
phase.

Cc: Srinivasa Deevi <srinivasa.deevi@conexant.com>
Signed-off-by: default avatarMauro Carvalho Chehab <mchehab@redhat.com>
parent b905de30
...@@ -558,10 +558,10 @@ static int cx231xx_usb_probe(struct usb_interface *interface, ...@@ -558,10 +558,10 @@ static int cx231xx_usb_probe(struct usb_interface *interface,
udev = usb_get_dev(interface_to_usbdev(interface)); udev = usb_get_dev(interface_to_usbdev(interface));
ifnum = interface->altsetting[0].desc.bInterfaceNumber; ifnum = interface->altsetting[0].desc.bInterfaceNumber;
printk(DRIVER_NAME ": Interface Number %d\n", ifnum); if (!ifnum) {
/*
/* Interface number 0 - IR interface */ * Interface number 0 - IR interface
if (ifnum == 0) { */
/* Check to see next free device and mark as used */ /* Check to see next free device and mark as used */
nr = find_first_zero_bit(&cx231xx_devused, CX231XX_MAXBOARDS); nr = find_first_zero_bit(&cx231xx_devused, CX231XX_MAXBOARDS);
cx231xx_devused |= 1 << nr; cx231xx_devused |= 1 << nr;
...@@ -600,67 +600,12 @@ static int cx231xx_usb_probe(struct usb_interface *interface, ...@@ -600,67 +600,12 @@ static int cx231xx_usb_probe(struct usb_interface *interface,
/* get maximum no.of IAD interfaces */ /* get maximum no.of IAD interfaces */
assoc_desc = udev->actconfig->intf_assoc[0]; assoc_desc = udev->actconfig->intf_assoc[0];
dev->max_iad_interface_count = assoc_desc->bInterfaceCount; dev->max_iad_interface_count = assoc_desc->bInterfaceCount;
cx231xx_info("Found IAD interface count %d\n",
dev->max_iad_interface_count);
/* init CIR module TBD */ /* init CIR module TBD */
/* store the current interface */ /* store the current interface */
lif = interface; lif = interface;
} else if (ifnum == 1) {
/* Get dev structure first */
dev = usb_get_intfdata(udev->actconfig->interface[0]);
if (dev == NULL) {
cx231xx_err(DRIVER_NAME ": out of first interface!\n");
return -ENODEV;
}
/* store the interface 0 back */
lif = udev->actconfig->interface[0];
/* increment interface count */
dev->interface_count++;
/* get device number */
nr = dev->devno;
assoc_desc = udev->actconfig->intf_assoc[0];
if (assoc_desc->bFirstInterface == ifnum) {
cx231xx_info
("Found IAD interface match: AV Desc Start!! \n");
} else {
cx231xx_err(" Not found matching interface\n");
return -ENODEV;
}
} else if (ifnum >= 2) {
/* Get dev structure first */
dev = usb_get_intfdata(udev->actconfig->interface[0]);
if (dev == NULL) {
cx231xx_err(DRIVER_NAME ": out of first interface!\n");
return -ENODEV;
}
/* store the interface 0 back */
lif = udev->actconfig->interface[0];
/* increment interface count */
dev->interface_count++;
/* get device number */
nr = dev->devno;
/* set skip interface */
if ((dev->interface_count - 1) != dev->max_iad_interface_count)
skip_interface = 1; /* set skipping */
else {
cx231xx_info
("Found IAD interface no. match with AV Device no.!\n");
}
}
switch (udev->speed) { switch (udev->speed) {
case USB_SPEED_LOW: case USB_SPEED_LOW:
speed = "1.5"; speed = "1.5";
...@@ -688,24 +633,68 @@ static int cx231xx_usb_probe(struct usb_interface *interface, ...@@ -688,24 +633,68 @@ static int cx231xx_usb_probe(struct usb_interface *interface,
strlcat(descr, " ", sizeof(descr)); strlcat(descr, " ", sizeof(descr));
cx231xx_info("New device %s@ %s Mbps " cx231xx_info("New device %s@ %s Mbps "
"(%04x:%04x, interface %d, class %d)\n", "(%04x:%04x) with %d interfaces\n",
descr, descr,
speed, speed,
le16_to_cpu(udev->descriptor.idVendor), le16_to_cpu(udev->descriptor.idVendor),
le16_to_cpu(udev->descriptor.idProduct), le16_to_cpu(udev->descriptor.idProduct),
ifnum, interface->altsetting->desc.bInterfaceNumber); dev->max_iad_interface_count);
} else {
/* Get dev structure first */
dev = usb_get_intfdata(udev->actconfig->interface[0]);
if (dev == NULL) {
cx231xx_err(DRIVER_NAME ": out of first interface!\n");
return -ENODEV;
}
/* store the interface 0 back */
lif = udev->actconfig->interface[0];
/* increment interface count */
dev->interface_count++;
/* AV device initialization */ /* get device number */
if ((dev->interface_count - 1) == dev->max_iad_interface_count) { nr = dev->devno;
cx231xx_info(" Calling init_dev\n");
/*
* set skip interface, for all interfaces but
* interface 1 and the last one
*/
if ((ifnum != 1) && ((dev->interface_count - 1)
!= dev->max_iad_interface_count))
skip_interface = 1;
if (ifnum == 1) {
assoc_desc = udev->actconfig->intf_assoc[0];
if (assoc_desc->bFirstInterface != ifnum) {
cx231xx_err(DRIVER_NAME ": Not found "
"matching IAD interface\n");
return -ENODEV;
}
}
}
if (skip_interface)
return -ENODEV;
cx231xx_info("registering interface %d\n", ifnum);
/* save our data pointer in this interface device */
usb_set_intfdata(lif, dev);
if ((dev->interface_count - 1) != dev->max_iad_interface_count)
return 0;
/*
* AV device initialization - only done at the last interface
*/
/* Create v4l2 device */ /* Create v4l2 device */
snprintf(dev->v4l2_dev.name, sizeof(dev->v4l2_dev.name), snprintf(dev->v4l2_dev.name, sizeof(dev->v4l2_dev.name),
"%s-%03d", "cx231xx", nr); "%s-%03d", "cx231xx", nr);
retval = v4l2_device_register(&udev->dev, &dev->v4l2_dev); retval = v4l2_device_register(&udev->dev, &dev->v4l2_dev);
if (retval) { if (retval) {
printk(KERN_ERR "%s() v4l2_device_register failed\n", cx231xx_errdev("v4l2_device_register failed\n");
__func__);
cx231xx_devused &= ~(1 << nr); cx231xx_devused &= ~(1 << nr);
kfree(dev); kfree(dev);
return -EIO; return -EIO;
...@@ -721,17 +710,14 @@ static int cx231xx_usb_probe(struct usb_interface *interface, ...@@ -721,17 +710,14 @@ static int cx231xx_usb_probe(struct usb_interface *interface,
} }
/* compute alternate max packet sizes for video */ /* compute alternate max packet sizes for video */
uif = uif = udev->actconfig->interface[dev->current_pcb_config.
udev->actconfig->interface[dev->current_pcb_config. hs_config_info[0].interface_info.video_index + 1];
hs_config_info[0].interface_info.
video_index + 1];
dev->video_mode.end_point_addr = dev->video_mode.end_point_addr = le16_to_cpu(uif->altsetting[0].
le16_to_cpu(uif->altsetting[0].endpoint[isoc_pipe].desc. endpoint[isoc_pipe].desc.bEndpointAddress);
bEndpointAddress);
dev->video_mode.num_alt = uif->num_altsetting; dev->video_mode.num_alt = uif->num_altsetting;
cx231xx_info(": EndPoint Addr 0x%x, Alternate settings: %i\n", cx231xx_info("EndPoint Addr 0x%x, Alternate settings: %i\n",
dev->video_mode.end_point_addr, dev->video_mode.end_point_addr,
dev->video_mode.num_alt); dev->video_mode.num_alt);
dev->video_mode.alt_max_pkt_size = dev->video_mode.alt_max_pkt_size =
...@@ -746,8 +732,7 @@ static int cx231xx_usb_probe(struct usb_interface *interface, ...@@ -746,8 +732,7 @@ static int cx231xx_usb_probe(struct usb_interface *interface,
} }
for (i = 0; i < dev->video_mode.num_alt; i++) { for (i = 0; i < dev->video_mode.num_alt; i++) {
u16 tmp = u16 tmp = le16_to_cpu(uif->altsetting[i].endpoint[isoc_pipe].
le16_to_cpu(uif->altsetting[i].endpoint[isoc_pipe].
desc.wMaxPacketSize); desc.wMaxPacketSize);
dev->video_mode.alt_max_pkt_size[i] = dev->video_mode.alt_max_pkt_size[i] =
(tmp & 0x07ff) * (((tmp & 0x1800) >> 11) + 1); (tmp & 0x07ff) * (((tmp & 0x1800) >> 11) + 1);
...@@ -756,8 +741,7 @@ static int cx231xx_usb_probe(struct usb_interface *interface, ...@@ -756,8 +741,7 @@ static int cx231xx_usb_probe(struct usb_interface *interface,
} }
/* compute alternate max packet sizes for vbi */ /* compute alternate max packet sizes for vbi */
uif = uif = udev->actconfig->interface[dev->current_pcb_config.
udev->actconfig->interface[dev->current_pcb_config.
hs_config_info[0].interface_info. hs_config_info[0].interface_info.
vanc_index + 1]; vanc_index + 1];
...@@ -766,7 +750,7 @@ static int cx231xx_usb_probe(struct usb_interface *interface, ...@@ -766,7 +750,7 @@ static int cx231xx_usb_probe(struct usb_interface *interface,
bEndpointAddress); bEndpointAddress);
dev->vbi_mode.num_alt = uif->num_altsetting; dev->vbi_mode.num_alt = uif->num_altsetting;
cx231xx_info(": EndPoint Addr 0x%x, Alternate settings: %i\n", cx231xx_info("EndPoint Addr 0x%x, Alternate settings: %i\n",
dev->vbi_mode.end_point_addr, dev->vbi_mode.end_point_addr,
dev->vbi_mode.num_alt); dev->vbi_mode.num_alt);
dev->vbi_mode.alt_max_pkt_size = dev->vbi_mode.alt_max_pkt_size =
...@@ -791,8 +775,7 @@ static int cx231xx_usb_probe(struct usb_interface *interface, ...@@ -791,8 +775,7 @@ static int cx231xx_usb_probe(struct usb_interface *interface,
} }
/* compute alternate max packet sizes for sliced CC */ /* compute alternate max packet sizes for sliced CC */
uif = uif = udev->actconfig->interface[dev->current_pcb_config.
udev->actconfig->interface[dev->current_pcb_config.
hs_config_info[0].interface_info. hs_config_info[0].interface_info.
hanc_index + 1]; hanc_index + 1];
...@@ -801,7 +784,7 @@ static int cx231xx_usb_probe(struct usb_interface *interface, ...@@ -801,7 +784,7 @@ static int cx231xx_usb_probe(struct usb_interface *interface,
bEndpointAddress); bEndpointAddress);
dev->sliced_cc_mode.num_alt = uif->num_altsetting; dev->sliced_cc_mode.num_alt = uif->num_altsetting;
cx231xx_info(": EndPoint Addr 0x%x, Alternate settings: %i\n", cx231xx_info("EndPoint Addr 0x%x, Alternate settings: %i\n",
dev->sliced_cc_mode.end_point_addr, dev->sliced_cc_mode.end_point_addr,
dev->sliced_cc_mode.num_alt); dev->sliced_cc_mode.num_alt);
dev->sliced_cc_mode.alt_max_pkt_size = dev->sliced_cc_mode.alt_max_pkt_size =
...@@ -816,8 +799,7 @@ static int cx231xx_usb_probe(struct usb_interface *interface, ...@@ -816,8 +799,7 @@ static int cx231xx_usb_probe(struct usb_interface *interface,
} }
for (i = 0; i < dev->sliced_cc_mode.num_alt; i++) { for (i = 0; i < dev->sliced_cc_mode.num_alt; i++) {
u16 tmp = u16 tmp = le16_to_cpu(uif->altsetting[i].endpoint[isoc_pipe].
le16_to_cpu(uif->altsetting[i].endpoint[isoc_pipe].
desc.wMaxPacketSize); desc.wMaxPacketSize);
dev->sliced_cc_mode.alt_max_pkt_size[i] = dev->sliced_cc_mode.alt_max_pkt_size[i] =
(tmp & 0x07ff) * (((tmp & 0x1800) >> 11) + 1); (tmp & 0x07ff) * (((tmp & 0x1800) >> 11) + 1);
...@@ -826,10 +808,8 @@ static int cx231xx_usb_probe(struct usb_interface *interface, ...@@ -826,10 +808,8 @@ static int cx231xx_usb_probe(struct usb_interface *interface,
} }
if (dev->current_pcb_config.ts1_source != 0xff) { if (dev->current_pcb_config.ts1_source != 0xff) {
/* compute alternate max packet sizes for TS1 */ /* compute alternate max packet sizes for TS1 */
uif = uif = udev->actconfig->interface[dev->current_pcb_config.
udev->actconfig->interface[dev->current_pcb_config.
hs_config_info[0]. hs_config_info[0].
interface_info. interface_info.
ts1_index + 1]; ts1_index + 1];
...@@ -839,8 +819,7 @@ static int cx231xx_usb_probe(struct usb_interface *interface, ...@@ -839,8 +819,7 @@ static int cx231xx_usb_probe(struct usb_interface *interface,
desc.bEndpointAddress); desc.bEndpointAddress);
dev->ts1_mode.num_alt = uif->num_altsetting; dev->ts1_mode.num_alt = uif->num_altsetting;
cx231xx_info cx231xx_info("EndPoint Addr 0x%x, Alternate settings: %i\n",
(": EndPoint Addr 0x%x, Alternate settings: %i\n",
dev->ts1_mode.end_point_addr, dev->ts1_mode.end_point_addr,
dev->ts1_mode.num_alt); dev->ts1_mode.num_alt);
dev->ts1_mode.alt_max_pkt_size = dev->ts1_mode.alt_max_pkt_size =
...@@ -855,34 +834,18 @@ static int cx231xx_usb_probe(struct usb_interface *interface, ...@@ -855,34 +834,18 @@ static int cx231xx_usb_probe(struct usb_interface *interface,
} }
for (i = 0; i < dev->ts1_mode.num_alt; i++) { for (i = 0; i < dev->ts1_mode.num_alt; i++) {
u16 tmp = u16 tmp = le16_to_cpu(uif->altsetting[i].
le16_to_cpu(uif->altsetting[i].
endpoint[isoc_pipe].desc. endpoint[isoc_pipe].desc.
wMaxPacketSize); wMaxPacketSize);
dev->ts1_mode.alt_max_pkt_size[i] = dev->ts1_mode.alt_max_pkt_size[i] =
(tmp & 0x07ff) * (((tmp & 0x1800) >> 11) + (tmp & 0x07ff) * (((tmp & 0x1800) >> 11) + 1);
1); cx231xx_info("Alternate setting %i, max size= %i\n", i,
cx231xx_info
("Alternate setting %i, max size= %i\n", i,
dev->ts1_mode.alt_max_pkt_size[i]); dev->ts1_mode.alt_max_pkt_size[i]);
} }
} }
}
/* save our data pointer in this interface device */
usb_set_intfdata(lif, dev);
/* load other modules required */ /* load other modules required */
if ((dev->interface_count - 1) == dev->max_iad_interface_count) {
cx231xx_info("Calling request modules\n");
request_modules(dev); request_modules(dev);
}
if (skip_interface) {
cx231xx_info("Skipping the interface\n");
return -ENODEV;
}
return 0; return 0;
} }
...@@ -902,6 +865,9 @@ static void cx231xx_usb_disconnect(struct usb_interface *interface) ...@@ -902,6 +865,9 @@ static void cx231xx_usb_disconnect(struct usb_interface *interface)
if (!dev) if (!dev)
return; return;
if (!dev->udev)
return;
/* delete v4l2 device */ /* delete v4l2 device */
v4l2_device_unregister(&dev->v4l2_dev); v4l2_device_unregister(&dev->v4l2_dev);
......
Markdown is supported
0%
or
You are about to add 0 people to the discussion. Proceed with caution.
Finish editing this message first!
Please register or to comment