87 static int usbatm_print_packet(struct usbatm_data *instance, const unsigned char *data, int len);
295 static inline struct usbatm_vcc_data *usbatm_find_vcc(struct usbatm_data *instance,  in usbatm_find_vcc()  argument
300 	list_for_each_entry(vcc_data, &instance->vcc_list, list)  in usbatm_find_vcc()
306 static void usbatm_extract_one_cell(struct usbatm_data *instance, unsigned char *source)  in usbatm_extract_one_cell()  argument
314 	if ((vci != instance->cached_vci) || (vpi != instance->cached_vpi)) {  in usbatm_extract_one_cell()
315 		instance->cached_vpi = vpi;  in usbatm_extract_one_cell()
316 		instance->cached_vci = vci;  in usbatm_extract_one_cell()
318 		instance->cached_vcc = usbatm_find_vcc(instance, vpi, vci);  in usbatm_extract_one_cell()
320 		if (!instance->cached_vcc)  in usbatm_extract_one_cell()
321 			atm_rldbg(instance, "%s: unknown vpi/vci (%hd/%d)!\n", __func__, vpi, vci);  in usbatm_extract_one_cell()
324 	if (!instance->cached_vcc)  in usbatm_extract_one_cell()
327 	vcc = instance->cached_vcc->vcc;  in usbatm_extract_one_cell()
332 			atm_warn(instance, "%s: OAM not supported (vpi %d, vci %d)!\n",  in usbatm_extract_one_cell()
338 	sarb = instance->cached_vcc->sarb;  in usbatm_extract_one_cell()
341 		atm_rldbg(instance, "%s: buffer overrun (sarb->len %u, vcc: 0x%p)!\n",  in usbatm_extract_one_cell()
359 			atm_rldbg(instance, "%s: bogus length %u (vcc: 0x%p)!\n",  in usbatm_extract_one_cell()
368 			atm_rldbg(instance, "%s: bogus pdu_length %u (sarb->len: %u, vcc: 0x%p)!\n",  in usbatm_extract_one_cell()
375 			atm_rldbg(instance, "%s: packet failed crc check (vcc: 0x%p)!\n",  in usbatm_extract_one_cell()
381 		vdbg(&instance->usb_intf->dev,  in usbatm_extract_one_cell()
387 				atm_err(instance, "%s: no memory for skb (length: %u)!\n",  in usbatm_extract_one_cell()
393 		vdbg(&instance->usb_intf->dev,  in usbatm_extract_one_cell()
398 			atm_rldbg(instance, "%s: failed atm_charge (skb->truesize: %u)!\n",  in usbatm_extract_one_cell()
409 		vdbg(&instance->usb_intf->dev,  in usbatm_extract_one_cell()
413 		PACKETDEBUG(instance, skb->data, skb->len);  in usbatm_extract_one_cell()
423 static void usbatm_extract_cells(struct usbatm_data *instance,  in usbatm_extract_cells()  argument
426 	unsigned int stride = instance->rx_channel.stride;  in usbatm_extract_cells()
427 	unsigned int buf_usage = instance->buf_usage;  in usbatm_extract_cells()
434 		unsigned char *cell_buf = instance->cell_buf;  in usbatm_extract_cells()
442 			usbatm_extract_one_cell(instance, cell_buf);  in usbatm_extract_cells()
443 			instance->buf_usage = 0;  in usbatm_extract_cells()
447 			instance->buf_usage = buf_usage + avail_data;  in usbatm_extract_cells()
453 		usbatm_extract_one_cell(instance, source);  in usbatm_extract_cells()
458 		memcpy(instance->cell_buf, source, avail_data);  in usbatm_extract_cells()
459 		instance->buf_usage = avail_data;  in usbatm_extract_cells()
468 static unsigned int usbatm_write_cells(struct usbatm_data *instance,  in usbatm_write_cells()  argument
475 	unsigned int stride = instance->tx_channel.stride;  in usbatm_write_cells()
530 	struct usbatm_data *instance = (struct usbatm_data *)data;  in usbatm_rx_process()  local
533 	while ((urb = usbatm_pop_urb(&instance->rx_channel))) {  in usbatm_rx_process()
534 		vdbg(&instance->usb_intf->dev,  in usbatm_rx_process()
540 			const unsigned int packet_size = instance->rx_channel.packet_size;  in usbatm_rx_process()
551 						usbatm_extract_cells(instance, merge_start, merge_length);  in usbatm_rx_process()
555 					atm_rldbg(instance, "%s: status %d in frame %d!\n", __func__, urb->status, i);  in usbatm_rx_process()
557 						usbatm_extract_cells(instance, merge_start, merge_length);  in usbatm_rx_process()
559 					instance->buf_usage = 0;  in usbatm_rx_process()
564 				usbatm_extract_cells(instance, merge_start, merge_length);  in usbatm_rx_process()
567 				usbatm_extract_cells(instance, urb->transfer_buffer, urb->actual_length);  in usbatm_rx_process()
569 				instance->buf_usage = 0;  in usbatm_rx_process()
583 	struct usbatm_data *instance = (struct usbatm_data *)data;  in usbatm_tx_process()  local
584 	struct sk_buff *skb = instance->current_skb;  in usbatm_tx_process()
586 	const unsigned int buf_size = instance->tx_channel.buf_size;  in usbatm_tx_process()
591 		skb = skb_dequeue(&instance->sndqueue);  in usbatm_tx_process()
595 			urb = usbatm_pop_urb(&instance->tx_channel);  in usbatm_tx_process()
603 		bytes_written += usbatm_write_cells(instance, skb,  in usbatm_tx_process()
607 		vdbg(&instance->usb_intf->dev,  in usbatm_tx_process()
617 			skb = skb_dequeue(&instance->sndqueue);  in usbatm_tx_process()
629 	instance->current_skb = skb;  in usbatm_tx_process()
632 static void usbatm_cancel_send(struct usbatm_data *instance,  in usbatm_cancel_send()  argument
637 	spin_lock_irq(&instance->sndqueue.lock);  in usbatm_cancel_send()
638 	skb_queue_walk_safe(&instance->sndqueue, skb, n) {  in usbatm_cancel_send()
640 			atm_dbg(instance, "%s: popping skb 0x%p\n", __func__, skb);  in usbatm_cancel_send()
641 			__skb_unlink(skb, &instance->sndqueue);  in usbatm_cancel_send()
645 	spin_unlock_irq(&instance->sndqueue.lock);  in usbatm_cancel_send()
647 	tasklet_disable(&instance->tx_channel.tasklet);  in usbatm_cancel_send()
648 	if ((skb = instance->current_skb) && (UDSL_SKB(skb)->atm.vcc == vcc)) {  in usbatm_cancel_send()
649 		atm_dbg(instance, "%s: popping current skb (0x%p)\n", __func__, skb);  in usbatm_cancel_send()
650 		instance->current_skb = NULL;  in usbatm_cancel_send()
653 	tasklet_enable(&instance->tx_channel.tasklet);  in usbatm_cancel_send()
658 	struct usbatm_data *instance = vcc->dev->dev_data;  in usbatm_atm_send()  local
663 	if (!instance || instance->disconnected) {  in usbatm_atm_send()
665 		printk_ratelimited(KERN_DEBUG "%s: %s!\n", __func__, instance ? "disconnected" : "NULL instance");  in usbatm_atm_send()
672 		atm_rldbg(instance, "%s: unsupported ATM type %d!\n", __func__, vcc->qos.aal);  in usbatm_atm_send()
678 		atm_rldbg(instance, "%s: packet too long (%d vs %d)!\n",  in usbatm_atm_send()
684 	PACKETDEBUG(instance, skb->data, skb->len);  in usbatm_atm_send()
691 	skb_queue_tail(&instance->sndqueue, skb);  in usbatm_atm_send()
692 	tasklet_schedule(&instance->tx_channel.tasklet);  in usbatm_atm_send()
708 	struct usbatm_data *instance = container_of(kref, struct usbatm_data, refcount);  in usbatm_destroy_instance()  local
710 	tasklet_kill(&instance->rx_channel.tasklet);  in usbatm_destroy_instance()
711 	tasklet_kill(&instance->tx_channel.tasklet);  in usbatm_destroy_instance()
712 	usb_put_dev(instance->usb_dev);  in usbatm_destroy_instance()
713 	kfree(instance);  in usbatm_destroy_instance()
716 static void usbatm_get_instance(struct usbatm_data *instance)  in usbatm_get_instance()  argument
718 	kref_get(&instance->refcount);  in usbatm_get_instance()
721 static void usbatm_put_instance(struct usbatm_data *instance)  in usbatm_put_instance()  argument
723 	kref_put(&instance->refcount, usbatm_destroy_instance);  in usbatm_put_instance()
733 	struct usbatm_data *instance = atm_dev->dev_data;  in usbatm_atm_dev_close()  local
735 	if (!instance)  in usbatm_atm_dev_close()
739 	usbatm_put_instance(instance);	/* taken in usbatm_atm_init */  in usbatm_atm_dev_close()
744 	struct usbatm_data *instance = atm_dev->dev_data;  in usbatm_atm_proc_read()  local
747 	if (!instance)  in usbatm_atm_proc_read()
751 		return sprintf(page, "%s\n", instance->description);  in usbatm_atm_proc_read()
766 		if (instance->disconnected)  in usbatm_atm_proc_read()
784 	struct usbatm_data *instance = vcc->dev->dev_data;  in usbatm_atm_open()  local
790 	if (!instance)  in usbatm_atm_open()
795 		atm_warn(instance, "%s: unsupported ATM type %d!\n", __func__, vcc->qos.aal);  in usbatm_atm_open()
801 		atm_dbg(instance, "%s: max_sdu %d out of range!\n", __func__, vcc->qos.rxtp.max_sdu);  in usbatm_atm_open()
805 	mutex_lock(&instance->serialize);	/* vs self, usbatm_atm_close, usbatm_usb_disconnect */  in usbatm_atm_open()
807 	if (instance->disconnected) {  in usbatm_atm_open()
808 		atm_dbg(instance, "%s: disconnected!\n", __func__);  in usbatm_atm_open()
813 	if (usbatm_find_vcc(instance, vpi, vci)) {  in usbatm_atm_open()
814 		atm_dbg(instance, "%s: %hd/%d already in use!\n", __func__, vpi, vci);  in usbatm_atm_open()
820 		atm_err(instance, "%s: no memory for vcc_data!\n", __func__);  in usbatm_atm_open()
831 		atm_err(instance, "%s: no memory for SAR buffer!\n", __func__);  in usbatm_atm_open()
838 	tasklet_disable(&instance->rx_channel.tasklet);  in usbatm_atm_open()
839 	instance->cached_vcc = new;  in usbatm_atm_open()
840 	instance->cached_vpi = vpi;  in usbatm_atm_open()
841 	instance->cached_vci = vci;  in usbatm_atm_open()
842 	list_add(&new->list, &instance->vcc_list);  in usbatm_atm_open()
843 	tasklet_enable(&instance->rx_channel.tasklet);  in usbatm_atm_open()
849 	mutex_unlock(&instance->serialize);  in usbatm_atm_open()
851 	atm_dbg(instance, "%s: allocated vcc data 0x%p\n", __func__, new);  in usbatm_atm_open()
857 	mutex_unlock(&instance->serialize);  in usbatm_atm_open()
863 	struct usbatm_data *instance = vcc->dev->dev_data;  in usbatm_atm_close()  local
866 	if (!instance || !vcc_data)  in usbatm_atm_close()
869 	usbatm_cancel_send(instance, vcc);  in usbatm_atm_close()
871 	mutex_lock(&instance->serialize);	/* vs self, usbatm_atm_open, usbatm_usb_disconnect */  in usbatm_atm_close()
873 	tasklet_disable(&instance->rx_channel.tasklet);  in usbatm_atm_close()
874 	if (instance->cached_vcc == vcc_data) {  in usbatm_atm_close()
875 		instance->cached_vcc = NULL;  in usbatm_atm_close()
876 		instance->cached_vpi = ATM_VPI_UNSPEC;  in usbatm_atm_close()
877 		instance->cached_vci = ATM_VCI_UNSPEC;  in usbatm_atm_close()
880 	tasklet_enable(&instance->rx_channel.tasklet);  in usbatm_atm_close()
894 	mutex_unlock(&instance->serialize);  in usbatm_atm_close()
900 	struct usbatm_data *instance = atm_dev->dev_data;  in usbatm_atm_ioctl()  local
902 	if (!instance || instance->disconnected)  in usbatm_atm_ioctl()
913 static int usbatm_atm_init(struct usbatm_data *instance)  in usbatm_atm_init()  argument
922 	atm_dev = atm_dev_register(instance->driver_name,  in usbatm_atm_init()
923 				   &instance->usb_intf->dev, &usbatm_atm_devops,  in usbatm_atm_init()
926 		usb_err(instance, "%s: failed to register ATM device!\n", __func__);  in usbatm_atm_init()
930 	instance->atm_dev = atm_dev;  in usbatm_atm_init()
939 	if (instance->driver->atm_start && ((ret = instance->driver->atm_start(instance, atm_dev)) < 0)) {  in usbatm_atm_init()
940 		atm_err(instance, "%s: atm_start failed: %d!\n", __func__, ret);  in usbatm_atm_init()
944 	usbatm_get_instance(instance);	/* dropped in usbatm_atm_dev_close */  in usbatm_atm_init()
948 	atm_dev->dev_data = instance;  in usbatm_atm_init()
952 		usbatm_submit_urb(instance->urbs[i]);  in usbatm_atm_init()
957 	instance->atm_dev = NULL;  in usbatm_atm_init()
969 	struct usbatm_data *instance = arg;  in usbatm_do_heavy_init()  local
973 	complete(&instance->thread_started);  in usbatm_do_heavy_init()
975 	ret = instance->driver->heavy_init(instance, instance->usb_intf);  in usbatm_do_heavy_init()
978 		ret = usbatm_atm_init(instance);  in usbatm_do_heavy_init()
980 	mutex_lock(&instance->serialize);  in usbatm_do_heavy_init()
981 	instance->thread = NULL;  in usbatm_do_heavy_init()
982 	mutex_unlock(&instance->serialize);  in usbatm_do_heavy_init()
984 	complete_and_exit(&instance->thread_exited, ret);  in usbatm_do_heavy_init()
987 static int usbatm_heavy_init(struct usbatm_data *instance)  in usbatm_heavy_init()  argument
991 	t = kthread_create(usbatm_do_heavy_init, instance, "%s",  in usbatm_heavy_init()
992 			instance->driver->driver_name);  in usbatm_heavy_init()
994 		usb_err(instance, "%s: failed to create kernel_thread (%ld)!\n",  in usbatm_heavy_init()
999 	instance->thread = t;  in usbatm_heavy_init()
1001 	wait_for_completion(&instance->thread_started);  in usbatm_heavy_init()
1025 	struct usbatm_data *instance;  in usbatm_usb_probe()  local
1032 …instance = kzalloc(sizeof(*instance) + sizeof(struct urb *) * (num_rcv_urbs + num_snd_urbs), GFP_K…  in usbatm_usb_probe()
1033 	if (!instance) {  in usbatm_usb_probe()
1040 	instance->driver = driver;  in usbatm_usb_probe()
1041 	strlcpy(instance->driver_name, driver->driver_name,  in usbatm_usb_probe()
1042 		sizeof(instance->driver_name));  in usbatm_usb_probe()
1044 	instance->usb_dev = usb_dev;  in usbatm_usb_probe()
1045 	instance->usb_intf = intf;  in usbatm_usb_probe()
1047 	buf = instance->description;  in usbatm_usb_probe()
1048 	length = sizeof(instance->description);  in usbatm_usb_probe()
1069 	if (driver->bind && (error = driver->bind(instance, intf, id)) < 0) {  in usbatm_usb_probe()
1076 	kref_init(&instance->refcount);		/* dropped in usbatm_usb_disconnect */  in usbatm_usb_probe()
1077 	mutex_init(&instance->serialize);  in usbatm_usb_probe()
1079 	instance->thread = NULL;  in usbatm_usb_probe()
1080 	init_completion(&instance->thread_started);  in usbatm_usb_probe()
1081 	init_completion(&instance->thread_exited);  in usbatm_usb_probe()
1083 	INIT_LIST_HEAD(&instance->vcc_list);  in usbatm_usb_probe()
1084 	skb_queue_head_init(&instance->sndqueue);  in usbatm_usb_probe()
1086 	usbatm_init_channel(&instance->rx_channel);  in usbatm_usb_probe()
1087 	usbatm_init_channel(&instance->tx_channel);  in usbatm_usb_probe()
1088 	tasklet_init(&instance->rx_channel.tasklet, usbatm_rx_process, (unsigned long)instance);  in usbatm_usb_probe()
1089 	tasklet_init(&instance->tx_channel.tasklet, usbatm_tx_process, (unsigned long)instance);  in usbatm_usb_probe()
1090 	instance->rx_channel.stride = ATM_CELL_SIZE + driver->rx_padding;  in usbatm_usb_probe()
1091 	instance->tx_channel.stride = ATM_CELL_SIZE + driver->tx_padding;  in usbatm_usb_probe()
1092 	instance->rx_channel.usbatm = instance->tx_channel.usbatm = instance;  in usbatm_usb_probe()
1094 	if ((instance->flags & UDSL_USE_ISOC) && driver->isoc_in)  in usbatm_usb_probe()
1095 		instance->rx_channel.endpoint = usb_rcvisocpipe(usb_dev, driver->isoc_in);  in usbatm_usb_probe()
1097 		instance->rx_channel.endpoint = usb_rcvbulkpipe(usb_dev, driver->bulk_in);  in usbatm_usb_probe()
1099 	instance->tx_channel.endpoint = usb_sndbulkpipe(usb_dev, driver->bulk_out);  in usbatm_usb_probe()
1102 	instance->tx_channel.buf_size = max(instance->tx_channel.stride,  in usbatm_usb_probe()
1103 			snd_buf_bytes - (snd_buf_bytes % instance->tx_channel.stride));  in usbatm_usb_probe()
1106 	maxpacket = usb_maxpacket(usb_dev, instance->rx_channel.endpoint, 0);  in usbatm_usb_probe()
1110 				usb_pipeendpoint(instance->rx_channel.endpoint));  in usbatm_usb_probe()
1120 	instance->rx_channel.buf_size = num_packets * maxpacket;  in usbatm_usb_probe()
1121 	instance->rx_channel.packet_size = maxpacket;  in usbatm_usb_probe()
1125 			&instance->tx_channel : &instance->rx_channel;  in usbatm_usb_probe()
1136 			&instance->rx_channel : &instance->tx_channel;  in usbatm_usb_probe()
1147 		instance->urbs[i] = urb;  in usbatm_usb_probe()
1157 		usb_fill_bulk_urb(urb, instance->usb_dev, channel->endpoint,  in usbatm_usb_probe()
1178 	instance->cached_vpi = ATM_VPI_UNSPEC;  in usbatm_usb_probe()
1179 	instance->cached_vci = ATM_VCI_UNSPEC;  in usbatm_usb_probe()
1180 	instance->cell_buf = kmalloc(instance->rx_channel.stride, GFP_KERNEL);  in usbatm_usb_probe()
1182 	if (!instance->cell_buf) {  in usbatm_usb_probe()
1188 	if (!(instance->flags & UDSL_SKIP_HEAVY_INIT) && driver->heavy_init) {  in usbatm_usb_probe()
1189 		error = usbatm_heavy_init(instance);  in usbatm_usb_probe()
1191 		complete(&instance->thread_exited);	/* pretend that heavy_init was run */  in usbatm_usb_probe()
1192 		error = usbatm_atm_init(instance);  in usbatm_usb_probe()
1199 	usb_set_intfdata(intf, instance);  in usbatm_usb_probe()
1204 	if (instance->driver->unbind)  in usbatm_usb_probe()
1205 		instance->driver->unbind(instance, intf);  in usbatm_usb_probe()
1207 	kfree(instance->cell_buf);  in usbatm_usb_probe()
1210 		if (instance->urbs[i])  in usbatm_usb_probe()
1211 			kfree(instance->urbs[i]->transfer_buffer);  in usbatm_usb_probe()
1212 		usb_free_urb(instance->urbs[i]);  in usbatm_usb_probe()
1215 	kfree(instance);  in usbatm_usb_probe()
1224 	struct usbatm_data *instance = usb_get_intfdata(intf);  in usbatm_usb_disconnect()  local
1228 	if (!instance) {  in usbatm_usb_disconnect()
1235 	mutex_lock(&instance->serialize);  in usbatm_usb_disconnect()
1236 	instance->disconnected = 1;  in usbatm_usb_disconnect()
1237 	if (instance->thread != NULL)  in usbatm_usb_disconnect()
1238 		send_sig(SIGTERM, instance->thread, 1);  in usbatm_usb_disconnect()
1239 	mutex_unlock(&instance->serialize);  in usbatm_usb_disconnect()
1241 	wait_for_completion(&instance->thread_exited);  in usbatm_usb_disconnect()
1243 	mutex_lock(&instance->serialize);  in usbatm_usb_disconnect()
1244 	list_for_each_entry(vcc_data, &instance->vcc_list, list)  in usbatm_usb_disconnect()
1246 	mutex_unlock(&instance->serialize);  in usbatm_usb_disconnect()
1248 	tasklet_disable(&instance->rx_channel.tasklet);  in usbatm_usb_disconnect()
1249 	tasklet_disable(&instance->tx_channel.tasklet);  in usbatm_usb_disconnect()
1252 		usb_kill_urb(instance->urbs[i]);  in usbatm_usb_disconnect()
1254 	del_timer_sync(&instance->rx_channel.delay);  in usbatm_usb_disconnect()
1255 	del_timer_sync(&instance->tx_channel.delay);  in usbatm_usb_disconnect()
1259 	INIT_LIST_HEAD(&instance->rx_channel.list);  in usbatm_usb_disconnect()
1260 	INIT_LIST_HEAD(&instance->tx_channel.list);  in usbatm_usb_disconnect()
1262 	tasklet_enable(&instance->rx_channel.tasklet);  in usbatm_usb_disconnect()
1263 	tasklet_enable(&instance->tx_channel.tasklet);  in usbatm_usb_disconnect()
1265 	if (instance->atm_dev && instance->driver->atm_stop)  in usbatm_usb_disconnect()
1266 		instance->driver->atm_stop(instance, instance->atm_dev);  in usbatm_usb_disconnect()
1268 	if (instance->driver->unbind)  in usbatm_usb_disconnect()
1269 		instance->driver->unbind(instance, intf);  in usbatm_usb_disconnect()
1271 	instance->driver_data = NULL;  in usbatm_usb_disconnect()
1274 		kfree(instance->urbs[i]->transfer_buffer);  in usbatm_usb_disconnect()
1275 		usb_free_urb(instance->urbs[i]);  in usbatm_usb_disconnect()
1278 	kfree(instance->cell_buf);  in usbatm_usb_disconnect()
1281 	if (instance->atm_dev) {  in usbatm_usb_disconnect()
1282 		atm_dev_deregister(instance->atm_dev);  in usbatm_usb_disconnect()
1283 		instance->atm_dev = NULL;  in usbatm_usb_disconnect()
1286 	usbatm_put_instance(instance);	/* taken in usbatm_usb_probe */  in usbatm_usb_disconnect()
1329 static int usbatm_print_packet(struct usbatm_data *instance,  in usbatm_print_packet()  argument
1340 		dev_dbg(&instance->usb_intf->dev, "%s", buffer);  in usbatm_print_packet()