126 	struct dln2_dev *dln2 = dev_get_drvdata(pdev->dev.parent);  in dln2_register_event_cb()  local
139 	spin_lock_irqsave(&dln2->event_cb_lock, flags);  in dln2_register_event_cb()
141 	list_for_each_entry(i, &dln2->event_cb_list, list) {  in dln2_register_event_cb()
149 		list_add_rcu(&entry->list, &dln2->event_cb_list);  in dln2_register_event_cb()
151 	spin_unlock_irqrestore(&dln2->event_cb_lock, flags);  in dln2_register_event_cb()
162 	struct dln2_dev *dln2 = dev_get_drvdata(pdev->dev.parent);  in dln2_unregister_event_cb()  local
167 	spin_lock_irqsave(&dln2->event_cb_lock, flags);  in dln2_unregister_event_cb()
169 	list_for_each_entry(i, &dln2->event_cb_list, list) {  in dln2_unregister_event_cb()
177 	spin_unlock_irqrestore(&dln2->event_cb_lock, flags);  in dln2_unregister_event_cb()
191 static bool dln2_transfer_complete(struct dln2_dev *dln2, struct urb *urb,  in dln2_transfer_complete()  argument
194 	struct device *dev = &dln2->interface->dev;  in dln2_transfer_complete()
195 	struct dln2_mod_rx_slots *rxs = &dln2->mod_rx_slots[handle];  in dln2_transfer_complete()
220 static void dln2_run_event_callbacks(struct dln2_dev *dln2, u16 id, u16 echo,  in dln2_run_event_callbacks()  argument
227 	list_for_each_entry_rcu(i, &dln2->event_cb_list, list) {  in dln2_run_event_callbacks()
239 	struct dln2_dev *dln2 = urb->context;  in dln2_rx()  local
241 	struct device *dev = &dln2->interface->dev;  in dln2_rx()
288 		dln2_run_event_callbacks(dln2, id, echo, data, len);  in dln2_rx()
291 		if (dln2_transfer_complete(dln2, urb, handle, echo))  in dln2_rx()
326 static int dln2_send_wait(struct dln2_dev *dln2, u16 handle, u16 cmd, u16 echo,  in dln2_send_wait()  argument
338 	ret = usb_bulk_msg(dln2->usb_dev,  in dln2_send_wait()
339 			   usb_sndbulkpipe(dln2->usb_dev, dln2->ep_out),  in dln2_send_wait()
347 static bool find_free_slot(struct dln2_dev *dln2, u16 handle, int *slot)  in find_free_slot()  argument
352 	if (dln2->disconnect) {  in find_free_slot()
357 	rxs = &dln2->mod_rx_slots[handle];  in find_free_slot()
375 static int alloc_rx_slot(struct dln2_dev *dln2, u16 handle)  in alloc_rx_slot()  argument
384 	ret = wait_event_interruptible(dln2->mod_rx_slots[handle].wq,  in alloc_rx_slot()
385 				       find_free_slot(dln2, handle, &slot));  in alloc_rx_slot()
392 static void free_rx_slot(struct dln2_dev *dln2, u16 handle, int slot)  in free_rx_slot()  argument
399 	rxs = &dln2->mod_rx_slots[handle];  in free_rx_slot()
415 		struct device *dev = &dln2->interface->dev;  in free_rx_slot()
425 static int _dln2_transfer(struct dln2_dev *dln2, u16 handle, u16 cmd,  in _dln2_transfer()  argument
433 	struct device *dev = &dln2->interface->dev;  in _dln2_transfer()
435 	struct dln2_mod_rx_slots *rxs = &dln2->mod_rx_slots[handle];  in _dln2_transfer()
438 	spin_lock(&dln2->disconnect_lock);  in _dln2_transfer()
439 	if (!dln2->disconnect)  in _dln2_transfer()
440 		dln2->active_transfers++;  in _dln2_transfer()
443 	spin_unlock(&dln2->disconnect_lock);  in _dln2_transfer()
448 	rx_slot = alloc_rx_slot(dln2, handle);  in _dln2_transfer()
454 	ret = dln2_send_wait(dln2, handle, cmd, rx_slot, obuf, obuf_len);  in _dln2_transfer()
471 	if (dln2->disconnect) {  in _dln2_transfer()
501 	free_rx_slot(dln2, handle, rx_slot);  in _dln2_transfer()
503 	spin_lock(&dln2->disconnect_lock);  in _dln2_transfer()
504 	dln2->active_transfers--;  in _dln2_transfer()
505 	spin_unlock(&dln2->disconnect_lock);  in _dln2_transfer()
506 	if (dln2->disconnect)  in _dln2_transfer()
507 		wake_up(&dln2->disconnect_wq);  in _dln2_transfer()
517 	struct dln2_dev *dln2;  in dln2_transfer()  local
520 	dln2 = dev_get_drvdata(pdev->dev.parent);  in dln2_transfer()
524 	return _dln2_transfer(dln2, handle, cmd, obuf, obuf_len, ibuf,  in dln2_transfer()
529 static int dln2_check_hw(struct dln2_dev *dln2)  in dln2_check_hw()  argument
535 	ret = _dln2_transfer(dln2, DLN2_HANDLE_CTRL, CMD_GET_DEVICE_VER,  in dln2_check_hw()
543 		dev_err(&dln2->interface->dev, "Device ID 0x%x not supported\n",  in dln2_check_hw()
551 static int dln2_print_serialno(struct dln2_dev *dln2)  in dln2_print_serialno()  argument
556 	struct device *dev = &dln2->interface->dev;  in dln2_print_serialno()
558 	ret = _dln2_transfer(dln2, DLN2_HANDLE_CTRL, CMD_GET_DEVICE_SN, NULL, 0,  in dln2_print_serialno()
570 static int dln2_hw_init(struct dln2_dev *dln2)  in dln2_hw_init()  argument
574 	ret = dln2_check_hw(dln2);  in dln2_hw_init()
578 	return dln2_print_serialno(dln2);  in dln2_hw_init()
581 static void dln2_free_rx_urbs(struct dln2_dev *dln2)  in dln2_free_rx_urbs()  argument
586 		usb_free_urb(dln2->rx_urb[i]);  in dln2_free_rx_urbs()
587 		kfree(dln2->rx_buf[i]);  in dln2_free_rx_urbs()
591 static void dln2_stop_rx_urbs(struct dln2_dev *dln2)  in dln2_stop_rx_urbs()  argument
596 		usb_kill_urb(dln2->rx_urb[i]);  in dln2_stop_rx_urbs()
599 static void dln2_free(struct dln2_dev *dln2)  in dln2_free()  argument
601 	dln2_free_rx_urbs(dln2);  in dln2_free()
602 	usb_put_dev(dln2->usb_dev);  in dln2_free()
603 	kfree(dln2);  in dln2_free()
606 static int dln2_setup_rx_urbs(struct dln2_dev *dln2,  in dln2_setup_rx_urbs()  argument
613 		dln2->rx_buf[i] = kmalloc(rx_max_size, GFP_KERNEL);  in dln2_setup_rx_urbs()
614 		if (!dln2->rx_buf[i])  in dln2_setup_rx_urbs()
617 		dln2->rx_urb[i] = usb_alloc_urb(0, GFP_KERNEL);  in dln2_setup_rx_urbs()
618 		if (!dln2->rx_urb[i])  in dln2_setup_rx_urbs()
621 		usb_fill_bulk_urb(dln2->rx_urb[i], dln2->usb_dev,  in dln2_setup_rx_urbs()
622 				  usb_rcvbulkpipe(dln2->usb_dev, dln2->ep_in),  in dln2_setup_rx_urbs()
623 				  dln2->rx_buf[i], rx_max_size, dln2_rx, dln2);  in dln2_setup_rx_urbs()
629 static int dln2_start_rx_urbs(struct dln2_dev *dln2, gfp_t gfp)  in dln2_start_rx_urbs()  argument
631 	struct device *dev = &dln2->interface->dev;  in dln2_start_rx_urbs()
636 		ret = usb_submit_urb(dln2->rx_urb[i], gfp);  in dln2_start_rx_urbs()
680 static void dln2_stop(struct dln2_dev *dln2)  in dln2_stop()  argument
685 	spin_lock(&dln2->disconnect_lock);  in dln2_stop()
686 	dln2->disconnect = true;  in dln2_stop()
687 	spin_unlock(&dln2->disconnect_lock);  in dln2_stop()
691 		struct dln2_mod_rx_slots *rxs = &dln2->mod_rx_slots[i];  in dln2_stop()
708 	wait_event(dln2->disconnect_wq, !dln2->active_transfers);  in dln2_stop()
710 	dln2_stop_rx_urbs(dln2);  in dln2_stop()
715 	struct dln2_dev *dln2 = usb_get_intfdata(interface);  in dln2_disconnect()  local
717 	dln2_stop(dln2);  in dln2_disconnect()
721 	dln2_free(dln2);  in dln2_disconnect()
729 	struct dln2_dev *dln2;  in dln2_probe()  local
737 	dln2 = kzalloc(sizeof(*dln2), GFP_KERNEL);  in dln2_probe()
738 	if (!dln2)  in dln2_probe()
741 	dln2->ep_out = hostif->endpoint[0].desc.bEndpointAddress;  in dln2_probe()
742 	dln2->ep_in = hostif->endpoint[1].desc.bEndpointAddress;  in dln2_probe()
743 	dln2->usb_dev = usb_get_dev(interface_to_usbdev(interface));  in dln2_probe()
744 	dln2->interface = interface;  in dln2_probe()
745 	usb_set_intfdata(interface, dln2);  in dln2_probe()
746 	init_waitqueue_head(&dln2->disconnect_wq);  in dln2_probe()
749 		init_waitqueue_head(&dln2->mod_rx_slots[i].wq);  in dln2_probe()
750 		spin_lock_init(&dln2->mod_rx_slots[i].lock);  in dln2_probe()
752 			init_completion(&dln2->mod_rx_slots[i].slots[j].done);  in dln2_probe()
755 	spin_lock_init(&dln2->event_cb_lock);  in dln2_probe()
756 	spin_lock_init(&dln2->disconnect_lock);  in dln2_probe()
757 	INIT_LIST_HEAD(&dln2->event_cb_list);  in dln2_probe()
759 	ret = dln2_setup_rx_urbs(dln2, hostif);  in dln2_probe()
763 	ret = dln2_start_rx_urbs(dln2, GFP_KERNEL);  in dln2_probe()
767 	ret = dln2_hw_init(dln2);  in dln2_probe()
782 	dln2_stop_rx_urbs(dln2);  in dln2_probe()
785 	dln2_free(dln2);  in dln2_probe()
792 	struct dln2_dev *dln2 = usb_get_intfdata(iface);  in dln2_suspend()  local
794 	dln2_stop(dln2);  in dln2_suspend()
801 	struct dln2_dev *dln2 = usb_get_intfdata(iface);  in dln2_resume()  local
803 	dln2->disconnect = false;  in dln2_resume()
805 	return dln2_start_rx_urbs(dln2, GFP_NOIO);  in dln2_resume()