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()
388 				atm_err(instance, "%s: no memory for skb (length: %u)!\n",  in usbatm_extract_one_cell()
394 		vdbg(&instance->usb_intf->dev,  in usbatm_extract_one_cell()
399 			atm_rldbg(instance, "%s: failed atm_charge (skb->truesize: %u)!\n",  in usbatm_extract_one_cell()
410 		vdbg(&instance->usb_intf->dev,  in usbatm_extract_one_cell()
414 		PACKETDEBUG(instance, skb->data, skb->len);  in usbatm_extract_one_cell()
424 static void usbatm_extract_cells(struct usbatm_data *instance,  in usbatm_extract_cells()  argument
427 	unsigned int stride = instance->rx_channel.stride;  in usbatm_extract_cells()
428 	unsigned int buf_usage = instance->buf_usage;  in usbatm_extract_cells()
435 		unsigned char *cell_buf = instance->cell_buf;  in usbatm_extract_cells()
443 			usbatm_extract_one_cell(instance, cell_buf);  in usbatm_extract_cells()
444 			instance->buf_usage = 0;  in usbatm_extract_cells()
448 			instance->buf_usage = buf_usage + avail_data;  in usbatm_extract_cells()
454 		usbatm_extract_one_cell(instance, source);  in usbatm_extract_cells()
459 		memcpy(instance->cell_buf, source, avail_data);  in usbatm_extract_cells()
460 		instance->buf_usage = avail_data;  in usbatm_extract_cells()
469 static unsigned int usbatm_write_cells(struct usbatm_data *instance,  in usbatm_write_cells()  argument
476 	unsigned int stride = instance->tx_channel.stride;  in usbatm_write_cells()
531 	struct usbatm_data *instance = (struct usbatm_data *)data;  in usbatm_rx_process()  local
534 	while ((urb = usbatm_pop_urb(&instance->rx_channel))) {  in usbatm_rx_process()
535 		vdbg(&instance->usb_intf->dev,  in usbatm_rx_process()
541 			const unsigned int packet_size = instance->rx_channel.packet_size;  in usbatm_rx_process()
552 						usbatm_extract_cells(instance, merge_start, merge_length);  in usbatm_rx_process()
556 					atm_rldbg(instance, "%s: status %d in frame %d!\n", __func__, urb->status, i);  in usbatm_rx_process()
558 						usbatm_extract_cells(instance, merge_start, merge_length);  in usbatm_rx_process()
560 					instance->buf_usage = 0;  in usbatm_rx_process()
565 				usbatm_extract_cells(instance, merge_start, merge_length);  in usbatm_rx_process()
568 				usbatm_extract_cells(instance, urb->transfer_buffer, urb->actual_length);  in usbatm_rx_process()
570 				instance->buf_usage = 0;  in usbatm_rx_process()
584 	struct usbatm_data *instance = (struct usbatm_data *)data;  in usbatm_tx_process()  local
585 	struct sk_buff *skb = instance->current_skb;  in usbatm_tx_process()
587 	const unsigned int buf_size = instance->tx_channel.buf_size;  in usbatm_tx_process()
592 		skb = skb_dequeue(&instance->sndqueue);  in usbatm_tx_process()
596 			urb = usbatm_pop_urb(&instance->tx_channel);  in usbatm_tx_process()
604 		bytes_written += usbatm_write_cells(instance, skb,  in usbatm_tx_process()
608 		vdbg(&instance->usb_intf->dev,  in usbatm_tx_process()
618 			skb = skb_dequeue(&instance->sndqueue);  in usbatm_tx_process()
630 	instance->current_skb = skb;  in usbatm_tx_process()
633 static void usbatm_cancel_send(struct usbatm_data *instance,  in usbatm_cancel_send()  argument
638 	spin_lock_irq(&instance->sndqueue.lock);  in usbatm_cancel_send()
639 	skb_queue_walk_safe(&instance->sndqueue, skb, n) {  in usbatm_cancel_send()
641 			atm_dbg(instance, "%s: popping skb 0x%p\n", __func__, skb);  in usbatm_cancel_send()
642 			__skb_unlink(skb, &instance->sndqueue);  in usbatm_cancel_send()
646 	spin_unlock_irq(&instance->sndqueue.lock);  in usbatm_cancel_send()
648 	tasklet_disable(&instance->tx_channel.tasklet);  in usbatm_cancel_send()
649 	if ((skb = instance->current_skb) && (UDSL_SKB(skb)->atm.vcc == vcc)) {  in usbatm_cancel_send()
650 		atm_dbg(instance, "%s: popping current skb (0x%p)\n", __func__, skb);  in usbatm_cancel_send()
651 		instance->current_skb = NULL;  in usbatm_cancel_send()
654 	tasklet_enable(&instance->tx_channel.tasklet);  in usbatm_cancel_send()
659 	struct usbatm_data *instance = vcc->dev->dev_data;  in usbatm_atm_send()  local
664 	if (!instance || instance->disconnected) {  in usbatm_atm_send()
666 		printk_ratelimited(KERN_DEBUG "%s: %s!\n", __func__, instance ? "disconnected" : "NULL instance");  in usbatm_atm_send()
673 		atm_rldbg(instance, "%s: unsupported ATM type %d!\n", __func__, vcc->qos.aal);  in usbatm_atm_send()
679 		atm_rldbg(instance, "%s: packet too long (%d vs %d)!\n",  in usbatm_atm_send()
685 	PACKETDEBUG(instance, skb->data, skb->len);  in usbatm_atm_send()
692 	skb_queue_tail(&instance->sndqueue, skb);  in usbatm_atm_send()
693 	tasklet_schedule(&instance->tx_channel.tasklet);  in usbatm_atm_send()
709 	struct usbatm_data *instance = container_of(kref, struct usbatm_data, refcount);  in usbatm_destroy_instance()  local
711 	tasklet_kill(&instance->rx_channel.tasklet);  in usbatm_destroy_instance()
712 	tasklet_kill(&instance->tx_channel.tasklet);  in usbatm_destroy_instance()
713 	usb_put_dev(instance->usb_dev);  in usbatm_destroy_instance()
714 	kfree(instance);  in usbatm_destroy_instance()
717 static void usbatm_get_instance(struct usbatm_data *instance)  in usbatm_get_instance()  argument
719 	kref_get(&instance->refcount);  in usbatm_get_instance()
722 static void usbatm_put_instance(struct usbatm_data *instance)  in usbatm_put_instance()  argument
724 	kref_put(&instance->refcount, usbatm_destroy_instance);  in usbatm_put_instance()
734 	struct usbatm_data *instance = atm_dev->dev_data;  in usbatm_atm_dev_close()  local
736 	if (!instance)  in usbatm_atm_dev_close()
740 	usbatm_put_instance(instance);	/* taken in usbatm_atm_init */  in usbatm_atm_dev_close()
745 	struct usbatm_data *instance = atm_dev->dev_data;  in usbatm_atm_proc_read()  local
748 	if (!instance)  in usbatm_atm_proc_read()
752 		return sprintf(page, "%s\n", instance->description);  in usbatm_atm_proc_read()
767 		if (instance->disconnected)  in usbatm_atm_proc_read()
785 	struct usbatm_data *instance = vcc->dev->dev_data;  in usbatm_atm_open()  local
791 	if (!instance)  in usbatm_atm_open()
796 		atm_warn(instance, "%s: unsupported ATM type %d!\n", __func__, vcc->qos.aal);  in usbatm_atm_open()
802 		atm_dbg(instance, "%s: max_sdu %d out of range!\n", __func__, vcc->qos.rxtp.max_sdu);  in usbatm_atm_open()
806 	mutex_lock(&instance->serialize);	/* vs self, usbatm_atm_close, usbatm_usb_disconnect */  in usbatm_atm_open()
808 	if (instance->disconnected) {  in usbatm_atm_open()
809 		atm_dbg(instance, "%s: disconnected!\n", __func__);  in usbatm_atm_open()
814 	if (usbatm_find_vcc(instance, vpi, vci)) {  in usbatm_atm_open()
815 		atm_dbg(instance, "%s: %hd/%d already in use!\n", __func__, vpi, vci);  in usbatm_atm_open()
822 		atm_err(instance, "%s: no memory for vcc_data!\n", __func__);  in usbatm_atm_open()
833 		atm_err(instance, "%s: no memory for SAR buffer!\n", __func__);  in usbatm_atm_open()
840 	tasklet_disable(&instance->rx_channel.tasklet);  in usbatm_atm_open()
841 	instance->cached_vcc = new;  in usbatm_atm_open()
842 	instance->cached_vpi = vpi;  in usbatm_atm_open()
843 	instance->cached_vci = vci;  in usbatm_atm_open()
844 	list_add(&new->list, &instance->vcc_list);  in usbatm_atm_open()
845 	tasklet_enable(&instance->rx_channel.tasklet);  in usbatm_atm_open()
851 	mutex_unlock(&instance->serialize);  in usbatm_atm_open()
853 	atm_dbg(instance, "%s: allocated vcc data 0x%p\n", __func__, new);  in usbatm_atm_open()
859 	mutex_unlock(&instance->serialize);  in usbatm_atm_open()
865 	struct usbatm_data *instance = vcc->dev->dev_data;  in usbatm_atm_close()  local
868 	if (!instance || !vcc_data)  in usbatm_atm_close()
871 	usbatm_cancel_send(instance, vcc);  in usbatm_atm_close()
873 	mutex_lock(&instance->serialize);	/* vs self, usbatm_atm_open, usbatm_usb_disconnect */  in usbatm_atm_close()
875 	tasklet_disable(&instance->rx_channel.tasklet);  in usbatm_atm_close()
876 	if (instance->cached_vcc == vcc_data) {  in usbatm_atm_close()
877 		instance->cached_vcc = NULL;  in usbatm_atm_close()
878 		instance->cached_vpi = ATM_VPI_UNSPEC;  in usbatm_atm_close()
879 		instance->cached_vci = ATM_VCI_UNSPEC;  in usbatm_atm_close()
882 	tasklet_enable(&instance->rx_channel.tasklet);  in usbatm_atm_close()
896 	mutex_unlock(&instance->serialize);  in usbatm_atm_close()
902 	struct usbatm_data *instance = atm_dev->dev_data;  in usbatm_atm_ioctl()  local
904 	if (!instance || instance->disconnected)  in usbatm_atm_ioctl()
915 static int usbatm_atm_init(struct usbatm_data *instance)  in usbatm_atm_init()  argument
924 	atm_dev = atm_dev_register(instance->driver_name,  in usbatm_atm_init()
925 				   &instance->usb_intf->dev, &usbatm_atm_devops,  in usbatm_atm_init()
928 		usb_err(instance, "%s: failed to register ATM device!\n", __func__);  in usbatm_atm_init()
932 	instance->atm_dev = atm_dev;  in usbatm_atm_init()
941 	if (instance->driver->atm_start && ((ret = instance->driver->atm_start(instance, atm_dev)) < 0)) {  in usbatm_atm_init()
942 		atm_err(instance, "%s: atm_start failed: %d!\n", __func__, ret);  in usbatm_atm_init()
946 	usbatm_get_instance(instance);	/* dropped in usbatm_atm_dev_close */  in usbatm_atm_init()
950 	atm_dev->dev_data = instance;  in usbatm_atm_init()
954 		usbatm_submit_urb(instance->urbs[i]);  in usbatm_atm_init()
959 	instance->atm_dev = NULL;  in usbatm_atm_init()
971 	struct usbatm_data *instance = arg;  in usbatm_do_heavy_init()  local
975 	complete(&instance->thread_started);  in usbatm_do_heavy_init()
977 	ret = instance->driver->heavy_init(instance, instance->usb_intf);  in usbatm_do_heavy_init()
980 		ret = usbatm_atm_init(instance);  in usbatm_do_heavy_init()
982 	mutex_lock(&instance->serialize);  in usbatm_do_heavy_init()
983 	instance->thread = NULL;  in usbatm_do_heavy_init()
984 	mutex_unlock(&instance->serialize);  in usbatm_do_heavy_init()
986 	complete_and_exit(&instance->thread_exited, ret);  in usbatm_do_heavy_init()
989 static int usbatm_heavy_init(struct usbatm_data *instance)  in usbatm_heavy_init()  argument
993 	t = kthread_create(usbatm_do_heavy_init, instance, "%s",  in usbatm_heavy_init()
994 			instance->driver->driver_name);  in usbatm_heavy_init()
996 		usb_err(instance, "%s: failed to create kernel_thread (%ld)!\n",  in usbatm_heavy_init()
1001 	instance->thread = t;  in usbatm_heavy_init()
1003 	wait_for_completion(&instance->thread_started);  in usbatm_heavy_init()
1027 	struct usbatm_data *instance;  in usbatm_usb_probe()  local
1034 …instance = kzalloc(sizeof(*instance) + sizeof(struct urb *) * (num_rcv_urbs + num_snd_urbs), GFP_K…  in usbatm_usb_probe()
1035 	if (!instance) {  in usbatm_usb_probe()
1042 	instance->driver = driver;  in usbatm_usb_probe()
1043 	strlcpy(instance->driver_name, driver->driver_name,  in usbatm_usb_probe()
1044 		sizeof(instance->driver_name));  in usbatm_usb_probe()
1046 	instance->usb_dev = usb_dev;  in usbatm_usb_probe()
1047 	instance->usb_intf = intf;  in usbatm_usb_probe()
1049 	buf = instance->description;  in usbatm_usb_probe()
1050 	length = sizeof(instance->description);  in usbatm_usb_probe()
1071 	if (driver->bind && (error = driver->bind(instance, intf, id)) < 0) {  in usbatm_usb_probe()
1078 	kref_init(&instance->refcount);		/* dropped in usbatm_usb_disconnect */  in usbatm_usb_probe()
1079 	mutex_init(&instance->serialize);  in usbatm_usb_probe()
1081 	instance->thread = NULL;  in usbatm_usb_probe()
1082 	init_completion(&instance->thread_started);  in usbatm_usb_probe()
1083 	init_completion(&instance->thread_exited);  in usbatm_usb_probe()
1085 	INIT_LIST_HEAD(&instance->vcc_list);  in usbatm_usb_probe()
1086 	skb_queue_head_init(&instance->sndqueue);  in usbatm_usb_probe()
1088 	usbatm_init_channel(&instance->rx_channel);  in usbatm_usb_probe()
1089 	usbatm_init_channel(&instance->tx_channel);  in usbatm_usb_probe()
1090 	tasklet_init(&instance->rx_channel.tasklet, usbatm_rx_process, (unsigned long)instance);  in usbatm_usb_probe()
1091 	tasklet_init(&instance->tx_channel.tasklet, usbatm_tx_process, (unsigned long)instance);  in usbatm_usb_probe()
1092 	instance->rx_channel.stride = ATM_CELL_SIZE + driver->rx_padding;  in usbatm_usb_probe()
1093 	instance->tx_channel.stride = ATM_CELL_SIZE + driver->tx_padding;  in usbatm_usb_probe()
1094 	instance->rx_channel.usbatm = instance->tx_channel.usbatm = instance;  in usbatm_usb_probe()
1096 	if ((instance->flags & UDSL_USE_ISOC) && driver->isoc_in)  in usbatm_usb_probe()
1097 		instance->rx_channel.endpoint = usb_rcvisocpipe(usb_dev, driver->isoc_in);  in usbatm_usb_probe()
1099 		instance->rx_channel.endpoint = usb_rcvbulkpipe(usb_dev, driver->bulk_in);  in usbatm_usb_probe()
1101 	instance->tx_channel.endpoint = usb_sndbulkpipe(usb_dev, driver->bulk_out);  in usbatm_usb_probe()
1104 	instance->tx_channel.buf_size = max(instance->tx_channel.stride,  in usbatm_usb_probe()
1105 			snd_buf_bytes - (snd_buf_bytes % instance->tx_channel.stride));  in usbatm_usb_probe()
1108 	maxpacket = usb_maxpacket(usb_dev, instance->rx_channel.endpoint, 0);  in usbatm_usb_probe()
1112 				usb_pipeendpoint(instance->rx_channel.endpoint));  in usbatm_usb_probe()
1122 	instance->rx_channel.buf_size = num_packets * maxpacket;  in usbatm_usb_probe()
1123 	instance->rx_channel.packet_size = maxpacket;  in usbatm_usb_probe()
1127 			&instance->tx_channel : &instance->rx_channel;  in usbatm_usb_probe()
1138 			&instance->rx_channel : &instance->tx_channel;  in usbatm_usb_probe()
1149 		instance->urbs[i] = urb;  in usbatm_usb_probe()
1159 		usb_fill_bulk_urb(urb, instance->usb_dev, channel->endpoint,  in usbatm_usb_probe()
1180 	instance->cached_vpi = ATM_VPI_UNSPEC;  in usbatm_usb_probe()
1181 	instance->cached_vci = ATM_VCI_UNSPEC;  in usbatm_usb_probe()
1182 	instance->cell_buf = kmalloc(instance->rx_channel.stride, GFP_KERNEL);  in usbatm_usb_probe()
1184 	if (!instance->cell_buf) {  in usbatm_usb_probe()
1190 	if (!(instance->flags & UDSL_SKIP_HEAVY_INIT) && driver->heavy_init) {  in usbatm_usb_probe()
1191 		error = usbatm_heavy_init(instance);  in usbatm_usb_probe()
1193 		complete(&instance->thread_exited);	/* pretend that heavy_init was run */  in usbatm_usb_probe()
1194 		error = usbatm_atm_init(instance);  in usbatm_usb_probe()
1201 	usb_set_intfdata(intf, instance);  in usbatm_usb_probe()
1206 	if (instance->driver->unbind)  in usbatm_usb_probe()
1207 		instance->driver->unbind(instance, intf);  in usbatm_usb_probe()
1209 	kfree(instance->cell_buf);  in usbatm_usb_probe()
1212 		if (instance->urbs[i])  in usbatm_usb_probe()
1213 			kfree(instance->urbs[i]->transfer_buffer);  in usbatm_usb_probe()
1214 		usb_free_urb(instance->urbs[i]);  in usbatm_usb_probe()
1217 	kfree(instance);  in usbatm_usb_probe()
1226 	struct usbatm_data *instance = usb_get_intfdata(intf);  in usbatm_usb_disconnect()  local
1230 	if (!instance) {  in usbatm_usb_disconnect()
1237 	mutex_lock(&instance->serialize);  in usbatm_usb_disconnect()
1238 	instance->disconnected = 1;  in usbatm_usb_disconnect()
1239 	if (instance->thread != NULL)  in usbatm_usb_disconnect()
1240 		send_sig(SIGTERM, instance->thread, 1);  in usbatm_usb_disconnect()
1241 	mutex_unlock(&instance->serialize);  in usbatm_usb_disconnect()
1243 	wait_for_completion(&instance->thread_exited);  in usbatm_usb_disconnect()
1245 	mutex_lock(&instance->serialize);  in usbatm_usb_disconnect()
1246 	list_for_each_entry(vcc_data, &instance->vcc_list, list)  in usbatm_usb_disconnect()
1248 	mutex_unlock(&instance->serialize);  in usbatm_usb_disconnect()
1250 	tasklet_disable(&instance->rx_channel.tasklet);  in usbatm_usb_disconnect()
1251 	tasklet_disable(&instance->tx_channel.tasklet);  in usbatm_usb_disconnect()
1254 		usb_kill_urb(instance->urbs[i]);  in usbatm_usb_disconnect()
1256 	del_timer_sync(&instance->rx_channel.delay);  in usbatm_usb_disconnect()
1257 	del_timer_sync(&instance->tx_channel.delay);  in usbatm_usb_disconnect()
1261 	INIT_LIST_HEAD(&instance->rx_channel.list);  in usbatm_usb_disconnect()
1262 	INIT_LIST_HEAD(&instance->tx_channel.list);  in usbatm_usb_disconnect()
1264 	tasklet_enable(&instance->rx_channel.tasklet);  in usbatm_usb_disconnect()
1265 	tasklet_enable(&instance->tx_channel.tasklet);  in usbatm_usb_disconnect()
1267 	if (instance->atm_dev && instance->driver->atm_stop)  in usbatm_usb_disconnect()
1268 		instance->driver->atm_stop(instance, instance->atm_dev);  in usbatm_usb_disconnect()
1270 	if (instance->driver->unbind)  in usbatm_usb_disconnect()
1271 		instance->driver->unbind(instance, intf);  in usbatm_usb_disconnect()
1273 	instance->driver_data = NULL;  in usbatm_usb_disconnect()
1276 		kfree(instance->urbs[i]->transfer_buffer);  in usbatm_usb_disconnect()
1277 		usb_free_urb(instance->urbs[i]);  in usbatm_usb_disconnect()
1280 	kfree(instance->cell_buf);  in usbatm_usb_disconnect()
1283 	if (instance->atm_dev) {  in usbatm_usb_disconnect()
1284 		atm_dev_deregister(instance->atm_dev);  in usbatm_usb_disconnect()
1285 		instance->atm_dev = NULL;  in usbatm_usb_disconnect()
1288 	usbatm_put_instance(instance);	/* taken in usbatm_usb_probe */  in usbatm_usb_disconnect()
1331 static int usbatm_print_packet(struct usbatm_data *instance,  in usbatm_print_packet()  argument
1342 		dev_dbg(&instance->usb_intf->dev, "%s", buffer);  in usbatm_print_packet()