static void usb_net_raw_ip_exit(void)
{
int i;
pr_info("usb_net_raw_ip_exit {\n");
/* destroy multiple raw-ip network devices */
for (i = 0; i < max_intfs; i++) {
/* unregister network device */
if (usb_net_raw_ip_dev[i]) {
unregister_netdev(usb_net_raw_ip_dev[i]);
free_netdev(usb_net_raw_ip_dev[i]);
usb_net_raw_ip_dev[i] = (struct net_device *) 0;
}
/* close baseband usb */
if (baseband_usb_net[i]) {
/* 77228-5 patch */
/* stop usb tx */
if (baseband_usb_net[i]->usb.tx_workqueue) {
destroy_workqueue(baseband_usb_net[i]
->usb.tx_workqueue);
baseband_usb_net[i]->usb.tx_workqueue
= (struct workqueue_struct *) 0;
}
if (baseband_usb_net[i]->usb.tx_urb) {
usb_kill_urb(baseband_usb_net[i]->usb.tx_urb);
baseband_usb_net[i]->usb.tx_urb
= (struct urb *) 0;
}
/* stop usb rx */
if (baseband_usb_net[i]->usb.rx_urb) {
usb_kill_urb(baseband_usb_net[i]->usb.rx_urb);
baseband_usb_net[i]->usb.rx_urb
= (struct urb *) 0;
}
/* 77969-7 patch*/
usb_net_raw_ip_free_rx_urb(baseband_usb_net[i]);
/* 77969-7 patch*/
/* close usb */
/* 77228-5 patch */
baseband_usb_close(baseband_usb_net[i]);
baseband_usb_net[i] = (struct baseband_usb *) 0;
}
}
pr_info("usb_net_raw_ip_exit }\n");
}
static int usb_net_raw_ip_init(void)
{
int i;
int err;
char name[32];
pr_debug("usb_net_raw_ip_init {\n");
/* create multiple raw-ip network devices */
for (i = 0; i < max_intfs; i++) {
/* open baseband usb */
g_i = i;
baseband_usb_net[i] = baseband_usb_open(i, usb_net_raw_ip_vid,
usb_net_raw_ip_pid, usb_net_raw_ip_intf[i]);
if (!baseband_usb_net[i]) {
pr_err("cannot open baseband usb net\n");
err = -1;
goto error_exit;
}
/* register network device */
usb_net_raw_ip_dev[i] = alloc_netdev(0,
BASEBAND_USB_NET_DEV_NAME,
ether_setup);
if (!usb_net_raw_ip_dev[i]) {
pr_err("alloc_netdev() failed\n");
err = -ENOMEM;
goto error_exit;
}
usb_net_raw_ip_dev[i]->netdev_ops = &usb_net_raw_ip_ops;
usb_net_raw_ip_dev[i]->watchdog_timeo = TX_TIMEOUT;
random_ether_addr(usb_net_raw_ip_dev[i]->dev_addr);
err = register_netdev(usb_net_raw_ip_dev[i]);
if (err < 0) {
pr_err("cannot register network device - %d\n", err);
goto error_exit;
}
pr_debug("registered baseband usb network device"
" - dev %p name %s\n", usb_net_raw_ip_dev[i],
BASEBAND_USB_NET_DEV_NAME);
/* start usb rx */
err = usb_net_raw_ip_setup_rx_urb(baseband_usb_net[i]);
if (err < 0) {
pr_err("setup reusable rx urb failed - err %d\n", err);
goto error_exit;
}
err = usb_net_raw_ip_rx_urb_submit(baseband_usb_net[i]);
if (err < 0) {
pr_err("submit rx failed - err %d\n", err);
goto error_exit;
}
/* start usb tx */
init_usb_anchor(&baseband_usb_net[i]->usb.tx_urb_deferred);
sprintf(name, "raw_ip_tx_wq-%d",
baseband_usb_net[i]->baseband_index);
baseband_usb_net[i]->usb.tx_workqueue
= create_singlethread_workqueue(name);
if (!baseband_usb_net[i]->usb.tx_workqueue) {
pr_err("cannot create workqueue\n");
goto error_exit;
}
INIT_WORK(&baseband_usb_net[i]->usb.tx_work,
usb_net_raw_ip_tx_urb_work);
}
pr_debug("usb_net_raw_ip_init }\n");
return 0;
error_exit:
/* destroy multiple raw-ip network devices */
for (i = 0; i < max_intfs; i++) {
/* unregister network device */
if (usb_net_raw_ip_dev[i]) {
unregister_netdev(usb_net_raw_ip_dev[i]);
free_netdev(usb_net_raw_ip_dev[i]);
usb_net_raw_ip_dev[i] = (struct net_device *) 0;
}
/* close baseband usb */
if (baseband_usb_net[i]) {
/* stop usb tx */
if (baseband_usb_net[i]->usb.tx_workqueue) {
destroy_workqueue(baseband_usb_net[i]
->usb.tx_workqueue);
baseband_usb_net[i]->usb.tx_workqueue
= (struct workqueue_struct *) 0;
}
if (baseband_usb_net[i]->usb.tx_urb) {
usb_kill_urb(baseband_usb_net[i]->usb.tx_urb);
baseband_usb_net[i]->usb.tx_urb
= (struct urb *) 0;
}
/* stop usb rx */
if (baseband_usb_net[i]->usb.rx_urb) {
usb_kill_urb(baseband_usb_net[i]->usb.rx_urb);
baseband_usb_net[i]->usb.rx_urb
= (struct urb *) 0;
}
usb_net_raw_ip_free_rx_urb(baseband_usb_net[i]);
/* close usb */
baseband_usb_close(baseband_usb_net[i]);
baseband_usb_net[i] = (struct baseband_usb *) 0;
}
}
return err;
}
static void usb_net_raw_ip_exit(void)
{
struct baseband_usb *usb;
int i, j;
pr_debug("usb_net_raw_ip_exit {\n");
/* destroy multiple raw-ip network devices */
for (i = 0; i < max_intfs; i++) {
usb = baseband_usb_net[i];
/* stop baseband usb urbs */
if (usb) {
if (usb->usb.interface)
usb_autopm_get_interface(usb->usb.interface);
if (usb->usb.tx_workqueue)
cancel_work_sync(&usb->usb.tx_work);
/* stop usb tx */
pr_debug("%s: kill tx urb\n", __func__);
if (usb->usb.tx_urb) {
usb_kill_urb(usb->usb.tx_urb);
usb->usb.tx_urb = NULL;
}
/* stop usb rx */
pr_debug("%s: kill rx urbs\n", __func__);
for (j = 0; j < RAWIP_RX_BUFS; j++) {
if (usb->urb_r[j])
usb_kill_urb(usb->urb_r[j]);
}
usb_net_raw_ip_free_rx_urb(usb);
if (usb->usb.interface)
usb_autopm_put_interface(usb->usb.interface);
}
pr_debug("%s: unregister netdev\n", __func__);
/* unregister network device */
if (usb_net_raw_ip_dev[i]) {
unregister_netdev(usb_net_raw_ip_dev[i]);
free_netdev(usb_net_raw_ip_dev[i]);
usb_net_raw_ip_dev[i] = (struct net_device *) 0;
}
if (usb) {
pr_debug("%s: destroy tx workqueue\n", __func__);
if (usb->usb.tx_workqueue) {
destroy_workqueue(usb->usb.tx_workqueue);
usb->usb.tx_workqueue = NULL;
}
/* close usb */
baseband_usb_close(usb);
baseband_usb_net[i] = NULL;
}
}
pr_debug("close usb driver {\n");
usb_deregister(&baseband_usb_driver);
pr_debug("close usb driver }\n");
pr_debug("usb_net_raw_ip_exit }\n");
}
