73 static int usbatm_print_packet(struct usbatm_data *instance, const unsigned char *data, int len);
280 static inline struct usbatm_vcc_data *usbatm_find_vcc(struct usbatm_data *instance,  in usbatm_find_vcc()  argument
285 	list_for_each_entry(vcc_data, &instance->vcc_list, list)  in usbatm_find_vcc()
291 static void usbatm_extract_one_cell(struct usbatm_data *instance, unsigned char *source)  in usbatm_extract_one_cell()  argument
299 	if ((vci != instance->cached_vci) || (vpi != instance->cached_vpi)) {  in usbatm_extract_one_cell()
300 		instance->cached_vpi = vpi;  in usbatm_extract_one_cell()
301 		instance->cached_vci = vci;  in usbatm_extract_one_cell()
303 		instance->cached_vcc = usbatm_find_vcc(instance, vpi, vci);  in usbatm_extract_one_cell()
305 		if (!instance->cached_vcc)  in usbatm_extract_one_cell()
306 			atm_rldbg(instance, "%s: unknown vpi/vci (%hd/%d)!\n", __func__, vpi, vci);  in usbatm_extract_one_cell()
309 	if (!instance->cached_vcc)  in usbatm_extract_one_cell()
312 	vcc = instance->cached_vcc->vcc;  in usbatm_extract_one_cell()
317 			atm_warn(instance, "%s: OAM not supported (vpi %d, vci %d)!\n",  in usbatm_extract_one_cell()
323 	sarb = instance->cached_vcc->sarb;  in usbatm_extract_one_cell()
326 		atm_rldbg(instance, "%s: buffer overrun (sarb->len %u, vcc: 0x%p)!\n",  in usbatm_extract_one_cell()
344 			atm_rldbg(instance, "%s: bogus length %u (vcc: 0x%p)!\n",  in usbatm_extract_one_cell()
353 			atm_rldbg(instance, "%s: bogus pdu_length %u (sarb->len: %u, vcc: 0x%p)!\n",  in usbatm_extract_one_cell()
360 			atm_rldbg(instance, "%s: packet failed crc check (vcc: 0x%p)!\n",  in usbatm_extract_one_cell()
366 		vdbg(&instance->usb_intf->dev,  in usbatm_extract_one_cell()
373 				atm_err(instance, "%s: no memory for skb (length: %u)!\n",  in usbatm_extract_one_cell()
379 		vdbg(&instance->usb_intf->dev,  in usbatm_extract_one_cell()
384 			atm_rldbg(instance, "%s: failed atm_charge (skb->truesize: %u)!\n",  in usbatm_extract_one_cell()
395 		vdbg(&instance->usb_intf->dev,  in usbatm_extract_one_cell()
399 		PACKETDEBUG(instance, skb->data, skb->len);  in usbatm_extract_one_cell()
409 static void usbatm_extract_cells(struct usbatm_data *instance,  in usbatm_extract_cells()  argument
412 	unsigned int stride = instance->rx_channel.stride;  in usbatm_extract_cells()
413 	unsigned int buf_usage = instance->buf_usage;  in usbatm_extract_cells()
420 		unsigned char *cell_buf = instance->cell_buf;  in usbatm_extract_cells()
428 			usbatm_extract_one_cell(instance, cell_buf);  in usbatm_extract_cells()
429 			instance->buf_usage = 0;  in usbatm_extract_cells()
433 			instance->buf_usage = buf_usage + avail_data;  in usbatm_extract_cells()
439 		usbatm_extract_one_cell(instance, source);  in usbatm_extract_cells()
444 		memcpy(instance->cell_buf, source, avail_data);  in usbatm_extract_cells()
445 		instance->buf_usage = avail_data;  in usbatm_extract_cells()
454 static unsigned int usbatm_write_cells(struct usbatm_data *instance,  in usbatm_write_cells()  argument
461 	unsigned int stride = instance->tx_channel.stride;  in usbatm_write_cells()
516 	struct usbatm_data *instance = (struct usbatm_data *)data;  in usbatm_rx_process()  local
519 	while ((urb = usbatm_pop_urb(&instance->rx_channel))) {  in usbatm_rx_process()
520 		vdbg(&instance->usb_intf->dev,  in usbatm_rx_process()
526 			const unsigned int packet_size = instance->rx_channel.packet_size;  in usbatm_rx_process()
537 						usbatm_extract_cells(instance, merge_start, merge_length);  in usbatm_rx_process()
541 					atm_rldbg(instance, "%s: status %d in frame %d!\n", __func__, urb->status, i);  in usbatm_rx_process()
543 						usbatm_extract_cells(instance, merge_start, merge_length);  in usbatm_rx_process()
545 					instance->buf_usage = 0;  in usbatm_rx_process()
550 				usbatm_extract_cells(instance, merge_start, merge_length);  in usbatm_rx_process()
553 				usbatm_extract_cells(instance, urb->transfer_buffer, urb->actual_length);  in usbatm_rx_process()
555 				instance->buf_usage = 0;  in usbatm_rx_process()
569 	struct usbatm_data *instance = (struct usbatm_data *)data;  in usbatm_tx_process()  local
570 	struct sk_buff *skb = instance->current_skb;  in usbatm_tx_process()
572 	const unsigned int buf_size = instance->tx_channel.buf_size;  in usbatm_tx_process()
577 		skb = skb_dequeue(&instance->sndqueue);  in usbatm_tx_process()
581 			urb = usbatm_pop_urb(&instance->tx_channel);  in usbatm_tx_process()
589 		bytes_written += usbatm_write_cells(instance, skb,  in usbatm_tx_process()
593 		vdbg(&instance->usb_intf->dev,  in usbatm_tx_process()
603 			skb = skb_dequeue(&instance->sndqueue);  in usbatm_tx_process()
615 	instance->current_skb = skb;  in usbatm_tx_process()
618 static void usbatm_cancel_send(struct usbatm_data *instance,  in usbatm_cancel_send()  argument
623 	spin_lock_irq(&instance->sndqueue.lock);  in usbatm_cancel_send()
624 	skb_queue_walk_safe(&instance->sndqueue, skb, n) {  in usbatm_cancel_send()
626 			atm_dbg(instance, "%s: popping skb 0x%p\n", __func__, skb);  in usbatm_cancel_send()
627 			__skb_unlink(skb, &instance->sndqueue);  in usbatm_cancel_send()
631 	spin_unlock_irq(&instance->sndqueue.lock);  in usbatm_cancel_send()
633 	tasklet_disable(&instance->tx_channel.tasklet);  in usbatm_cancel_send()
634 	if ((skb = instance->current_skb) && (UDSL_SKB(skb)->atm.vcc == vcc)) {  in usbatm_cancel_send()
635 		atm_dbg(instance, "%s: popping current skb (0x%p)\n", __func__, skb);  in usbatm_cancel_send()
636 		instance->current_skb = NULL;  in usbatm_cancel_send()
639 	tasklet_enable(&instance->tx_channel.tasklet);  in usbatm_cancel_send()
644 	struct usbatm_data *instance = vcc->dev->dev_data;  in usbatm_atm_send()  local
649 	if (!instance || instance->disconnected) {  in usbatm_atm_send()
651 		printk_ratelimited(KERN_DEBUG "%s: %s!\n", __func__, instance ? "disconnected" : "NULL instance");  in usbatm_atm_send()
658 		atm_rldbg(instance, "%s: unsupported ATM type %d!\n", __func__, vcc->qos.aal);  in usbatm_atm_send()
664 		atm_rldbg(instance, "%s: packet too long (%d vs %d)!\n",  in usbatm_atm_send()
670 	PACKETDEBUG(instance, skb->data, skb->len);  in usbatm_atm_send()
677 	skb_queue_tail(&instance->sndqueue, skb);  in usbatm_atm_send()
678 	tasklet_schedule(&instance->tx_channel.tasklet);  in usbatm_atm_send()
694 	struct usbatm_data *instance = container_of(kref, struct usbatm_data, refcount);  in usbatm_destroy_instance()  local
696 	tasklet_kill(&instance->rx_channel.tasklet);  in usbatm_destroy_instance()
697 	tasklet_kill(&instance->tx_channel.tasklet);  in usbatm_destroy_instance()
698 	usb_put_dev(instance->usb_dev);  in usbatm_destroy_instance()
699 	kfree(instance);  in usbatm_destroy_instance()
702 static void usbatm_get_instance(struct usbatm_data *instance)  in usbatm_get_instance()  argument
704 	kref_get(&instance->refcount);  in usbatm_get_instance()
707 static void usbatm_put_instance(struct usbatm_data *instance)  in usbatm_put_instance()  argument
709 	kref_put(&instance->refcount, usbatm_destroy_instance);  in usbatm_put_instance()
719 	struct usbatm_data *instance = atm_dev->dev_data;  in usbatm_atm_dev_close()  local
721 	if (!instance)  in usbatm_atm_dev_close()
725 	usbatm_put_instance(instance);	/* taken in usbatm_atm_init */  in usbatm_atm_dev_close()
730 	struct usbatm_data *instance = atm_dev->dev_data;  in usbatm_atm_proc_read()  local
733 	if (!instance)  in usbatm_atm_proc_read()
737 		return sprintf(page, "%s\n", instance->description);  in usbatm_atm_proc_read()
752 		if (instance->disconnected)  in usbatm_atm_proc_read()
770 	struct usbatm_data *instance = vcc->dev->dev_data;  in usbatm_atm_open()  local
776 	if (!instance)  in usbatm_atm_open()
781 		atm_warn(instance, "%s: unsupported ATM type %d!\n", __func__, vcc->qos.aal);  in usbatm_atm_open()
787 		atm_dbg(instance, "%s: max_sdu %d out of range!\n", __func__, vcc->qos.rxtp.max_sdu);  in usbatm_atm_open()
791 	mutex_lock(&instance->serialize);	/* vs self, usbatm_atm_close, usbatm_usb_disconnect */  in usbatm_atm_open()
793 	if (instance->disconnected) {  in usbatm_atm_open()
794 		atm_dbg(instance, "%s: disconnected!\n", __func__);  in usbatm_atm_open()
799 	if (usbatm_find_vcc(instance, vpi, vci)) {  in usbatm_atm_open()
800 		atm_dbg(instance, "%s: %hd/%d already in use!\n", __func__, vpi, vci);  in usbatm_atm_open()
817 		atm_err(instance, "%s: no memory for SAR buffer!\n", __func__);  in usbatm_atm_open()
824 	tasklet_disable(&instance->rx_channel.tasklet);  in usbatm_atm_open()
825 	instance->cached_vcc = new;  in usbatm_atm_open()
826 	instance->cached_vpi = vpi;  in usbatm_atm_open()
827 	instance->cached_vci = vci;  in usbatm_atm_open()
828 	list_add(&new->list, &instance->vcc_list);  in usbatm_atm_open()
829 	tasklet_enable(&instance->rx_channel.tasklet);  in usbatm_atm_open()
835 	mutex_unlock(&instance->serialize);  in usbatm_atm_open()
837 	atm_dbg(instance, "%s: allocated vcc data 0x%p\n", __func__, new);  in usbatm_atm_open()
843 	mutex_unlock(&instance->serialize);  in usbatm_atm_open()
849 	struct usbatm_data *instance = vcc->dev->dev_data;  in usbatm_atm_close()  local
852 	if (!instance || !vcc_data)  in usbatm_atm_close()
855 	usbatm_cancel_send(instance, vcc);  in usbatm_atm_close()
857 	mutex_lock(&instance->serialize);	/* vs self, usbatm_atm_open, usbatm_usb_disconnect */  in usbatm_atm_close()
859 	tasklet_disable(&instance->rx_channel.tasklet);  in usbatm_atm_close()
860 	if (instance->cached_vcc == vcc_data) {  in usbatm_atm_close()
861 		instance->cached_vcc = NULL;  in usbatm_atm_close()
862 		instance->cached_vpi = ATM_VPI_UNSPEC;  in usbatm_atm_close()
863 		instance->cached_vci = ATM_VCI_UNSPEC;  in usbatm_atm_close()
866 	tasklet_enable(&instance->rx_channel.tasklet);  in usbatm_atm_close()
880 	mutex_unlock(&instance->serialize);  in usbatm_atm_close()
886 	struct usbatm_data *instance = atm_dev->dev_data;  in usbatm_atm_ioctl()  local
888 	if (!instance || instance->disconnected)  in usbatm_atm_ioctl()
899 static int usbatm_atm_init(struct usbatm_data *instance)  in usbatm_atm_init()  argument
908 	atm_dev = atm_dev_register(instance->driver_name,  in usbatm_atm_init()
909 				   &instance->usb_intf->dev, &usbatm_atm_devops,  in usbatm_atm_init()
912 		usb_err(instance, "%s: failed to register ATM device!\n", __func__);  in usbatm_atm_init()
916 	instance->atm_dev = atm_dev;  in usbatm_atm_init()
925 	if (instance->driver->atm_start && ((ret = instance->driver->atm_start(instance, atm_dev)) < 0)) {  in usbatm_atm_init()
926 		atm_err(instance, "%s: atm_start failed: %d!\n", __func__, ret);  in usbatm_atm_init()
930 	usbatm_get_instance(instance);	/* dropped in usbatm_atm_dev_close */  in usbatm_atm_init()
934 	atm_dev->dev_data = instance;  in usbatm_atm_init()
938 		usbatm_submit_urb(instance->urbs[i]);  in usbatm_atm_init()
943 	instance->atm_dev = NULL;  in usbatm_atm_init()
955 	struct usbatm_data *instance = arg;  in usbatm_do_heavy_init()  local
959 	complete(&instance->thread_started);  in usbatm_do_heavy_init()
961 	ret = instance->driver->heavy_init(instance, instance->usb_intf);  in usbatm_do_heavy_init()
964 		ret = usbatm_atm_init(instance);  in usbatm_do_heavy_init()
966 	mutex_lock(&instance->serialize);  in usbatm_do_heavy_init()
967 	instance->thread = NULL;  in usbatm_do_heavy_init()
968 	mutex_unlock(&instance->serialize);  in usbatm_do_heavy_init()
970 	complete_and_exit(&instance->thread_exited, ret);  in usbatm_do_heavy_init()
973 static int usbatm_heavy_init(struct usbatm_data *instance)  in usbatm_heavy_init()  argument
977 	t = kthread_create(usbatm_do_heavy_init, instance, "%s",  in usbatm_heavy_init()
978 			instance->driver->driver_name);  in usbatm_heavy_init()
980 		usb_err(instance, "%s: failed to create kernel_thread (%ld)!\n",  in usbatm_heavy_init()
985 	instance->thread = t;  in usbatm_heavy_init()
987 	wait_for_completion(&instance->thread_started);  in usbatm_heavy_init()
1011 	struct usbatm_data *instance;  in usbatm_usb_probe()  local
1018 …instance = kzalloc(sizeof(*instance) + sizeof(struct urb *) * (num_rcv_urbs + num_snd_urbs), GFP_K…  in usbatm_usb_probe()
1019 	if (!instance)  in usbatm_usb_probe()
1024 	instance->driver = driver;  in usbatm_usb_probe()
1025 	strlcpy(instance->driver_name, driver->driver_name,  in usbatm_usb_probe()
1026 		sizeof(instance->driver_name));  in usbatm_usb_probe()
1028 	instance->usb_dev = usb_dev;  in usbatm_usb_probe()
1029 	instance->usb_intf = intf;  in usbatm_usb_probe()
1031 	buf = instance->description;  in usbatm_usb_probe()
1032 	length = sizeof(instance->description);  in usbatm_usb_probe()
1053 	if (driver->bind && (error = driver->bind(instance, intf, id)) < 0) {  in usbatm_usb_probe()
1060 	kref_init(&instance->refcount);		/* dropped in usbatm_usb_disconnect */  in usbatm_usb_probe()
1061 	mutex_init(&instance->serialize);  in usbatm_usb_probe()
1063 	instance->thread = NULL;  in usbatm_usb_probe()
1064 	init_completion(&instance->thread_started);  in usbatm_usb_probe()
1065 	init_completion(&instance->thread_exited);  in usbatm_usb_probe()
1067 	INIT_LIST_HEAD(&instance->vcc_list);  in usbatm_usb_probe()
1068 	skb_queue_head_init(&instance->sndqueue);  in usbatm_usb_probe()
1070 	usbatm_init_channel(&instance->rx_channel);  in usbatm_usb_probe()
1071 	usbatm_init_channel(&instance->tx_channel);  in usbatm_usb_probe()
1072 	tasklet_init(&instance->rx_channel.tasklet, usbatm_rx_process, (unsigned long)instance);  in usbatm_usb_probe()
1073 	tasklet_init(&instance->tx_channel.tasklet, usbatm_tx_process, (unsigned long)instance);  in usbatm_usb_probe()
1074 	instance->rx_channel.stride = ATM_CELL_SIZE + driver->rx_padding;  in usbatm_usb_probe()
1075 	instance->tx_channel.stride = ATM_CELL_SIZE + driver->tx_padding;  in usbatm_usb_probe()
1076 	instance->rx_channel.usbatm = instance->tx_channel.usbatm = instance;  in usbatm_usb_probe()
1078 	if ((instance->flags & UDSL_USE_ISOC) && driver->isoc_in)  in usbatm_usb_probe()
1079 		instance->rx_channel.endpoint = usb_rcvisocpipe(usb_dev, driver->isoc_in);  in usbatm_usb_probe()
1081 		instance->rx_channel.endpoint = usb_rcvbulkpipe(usb_dev, driver->bulk_in);  in usbatm_usb_probe()
1083 	instance->tx_channel.endpoint = usb_sndbulkpipe(usb_dev, driver->bulk_out);  in usbatm_usb_probe()
1086 	instance->tx_channel.buf_size = max(instance->tx_channel.stride,  in usbatm_usb_probe()
1087 			snd_buf_bytes - (snd_buf_bytes % instance->tx_channel.stride));  in usbatm_usb_probe()
1090 	maxpacket = usb_maxpacket(usb_dev, instance->rx_channel.endpoint, 0);  in usbatm_usb_probe()
1094 				usb_pipeendpoint(instance->rx_channel.endpoint));  in usbatm_usb_probe()
1104 	instance->rx_channel.buf_size = num_packets * maxpacket;  in usbatm_usb_probe()
1105 	instance->rx_channel.packet_size = maxpacket;  in usbatm_usb_probe()
1109 			&instance->tx_channel : &instance->rx_channel;  in usbatm_usb_probe()
1120 			&instance->rx_channel : &instance->tx_channel;  in usbatm_usb_probe()
1130 		instance->urbs[i] = urb;  in usbatm_usb_probe()
1139 		usb_fill_bulk_urb(urb, instance->usb_dev, channel->endpoint,  in usbatm_usb_probe()
1160 	instance->cached_vpi = ATM_VPI_UNSPEC;  in usbatm_usb_probe()
1161 	instance->cached_vci = ATM_VCI_UNSPEC;  in usbatm_usb_probe()
1162 	instance->cell_buf = kmalloc(instance->rx_channel.stride, GFP_KERNEL);  in usbatm_usb_probe()
1164 	if (!instance->cell_buf) {  in usbatm_usb_probe()
1169 	if (!(instance->flags & UDSL_SKIP_HEAVY_INIT) && driver->heavy_init) {  in usbatm_usb_probe()
1170 		error = usbatm_heavy_init(instance);  in usbatm_usb_probe()
1172 		complete(&instance->thread_exited);	/* pretend that heavy_init was run */  in usbatm_usb_probe()
1173 		error = usbatm_atm_init(instance);  in usbatm_usb_probe()
1180 	usb_set_intfdata(intf, instance);  in usbatm_usb_probe()
1185 	if (instance->driver->unbind)  in usbatm_usb_probe()
1186 		instance->driver->unbind(instance, intf);  in usbatm_usb_probe()
1188 	kfree(instance->cell_buf);  in usbatm_usb_probe()
1191 		if (instance->urbs[i])  in usbatm_usb_probe()
1192 			kfree(instance->urbs[i]->transfer_buffer);  in usbatm_usb_probe()
1193 		usb_free_urb(instance->urbs[i]);  in usbatm_usb_probe()
1196 	kfree(instance);  in usbatm_usb_probe()
1205 	struct usbatm_data *instance = usb_get_intfdata(intf);  in usbatm_usb_disconnect()  local
1209 	if (!instance) {  in usbatm_usb_disconnect()
1216 	mutex_lock(&instance->serialize);  in usbatm_usb_disconnect()
1217 	instance->disconnected = 1;  in usbatm_usb_disconnect()
1218 	if (instance->thread != NULL)  in usbatm_usb_disconnect()
1219 		send_sig(SIGTERM, instance->thread, 1);  in usbatm_usb_disconnect()
1220 	mutex_unlock(&instance->serialize);  in usbatm_usb_disconnect()
1222 	wait_for_completion(&instance->thread_exited);  in usbatm_usb_disconnect()
1224 	mutex_lock(&instance->serialize);  in usbatm_usb_disconnect()
1225 	list_for_each_entry(vcc_data, &instance->vcc_list, list)  in usbatm_usb_disconnect()
1227 	mutex_unlock(&instance->serialize);  in usbatm_usb_disconnect()
1229 	tasklet_disable(&instance->rx_channel.tasklet);  in usbatm_usb_disconnect()
1230 	tasklet_disable(&instance->tx_channel.tasklet);  in usbatm_usb_disconnect()
1233 		usb_kill_urb(instance->urbs[i]);  in usbatm_usb_disconnect()
1235 	del_timer_sync(&instance->rx_channel.delay);  in usbatm_usb_disconnect()
1236 	del_timer_sync(&instance->tx_channel.delay);  in usbatm_usb_disconnect()
1240 	INIT_LIST_HEAD(&instance->rx_channel.list);  in usbatm_usb_disconnect()
1241 	INIT_LIST_HEAD(&instance->tx_channel.list);  in usbatm_usb_disconnect()
1243 	tasklet_enable(&instance->rx_channel.tasklet);  in usbatm_usb_disconnect()
1244 	tasklet_enable(&instance->tx_channel.tasklet);  in usbatm_usb_disconnect()
1246 	if (instance->atm_dev && instance->driver->atm_stop)  in usbatm_usb_disconnect()
1247 		instance->driver->atm_stop(instance, instance->atm_dev);  in usbatm_usb_disconnect()
1249 	if (instance->driver->unbind)  in usbatm_usb_disconnect()
1250 		instance->driver->unbind(instance, intf);  in usbatm_usb_disconnect()
1252 	instance->driver_data = NULL;  in usbatm_usb_disconnect()
1255 		kfree(instance->urbs[i]->transfer_buffer);  in usbatm_usb_disconnect()
1256 		usb_free_urb(instance->urbs[i]);  in usbatm_usb_disconnect()
1259 	kfree(instance->cell_buf);  in usbatm_usb_disconnect()
1262 	if (instance->atm_dev) {  in usbatm_usb_disconnect()
1263 		atm_dev_deregister(instance->atm_dev);  in usbatm_usb_disconnect()
1264 		instance->atm_dev = NULL;  in usbatm_usb_disconnect()
1267 	usbatm_put_instance(instance);	/* taken in usbatm_usb_probe */  in usbatm_usb_disconnect()
1309 static int usbatm_print_packet(struct usbatm_data *instance,  in usbatm_print_packet()  argument
1320 		dev_dbg(&instance->usb_intf->dev, "%s", buffer);  in usbatm_print_packet()