Linux Audio

Check our new training course

Loading...
v6.8
  1// SPDX-License-Identifier: GPL-2.0+
  2/*****************************************************************************/
  3
  4/*
  5 *	uss720.c  --  USS720 USB Parport Cable.
  6 *
  7 *	Copyright (C) 1999, 2005, 2010
  8 *	    Thomas Sailer (t.sailer@alumni.ethz.ch)
  9 *
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 10 *  Based on parport_pc.c
 11 *
 12 *  History:
 13 *   0.1  04.08.1999  Created
 14 *   0.2  07.08.1999  Some fixes mainly suggested by Tim Waugh
 15 *		      Interrupt handling currently disabled because
 16 *		      usb_request_irq crashes somewhere within ohci.c
 17 *		      for no apparent reason (that is for me, anyway)
 18 *		      ECP currently untested
 19 *   0.3  10.08.1999  fixing merge errors
 20 *   0.4  13.08.1999  Added Vendor/Product ID of Brad Hard's cable
 21 *   0.5  20.09.1999  usb_control_msg wrapper used
 22 *        Nov01.2000  usb_device_table support by Adam J. Richter
 23 *        08.04.2001  Identify version on module load.  gb
 24 *   0.6  02.09.2005  Fix "scheduling in interrupt" problem by making save/restore
 25 *                    context asynchronous
 26 *
 27 */
 28
 29/*****************************************************************************/
 30
 31#include <linux/module.h>
 32#include <linux/socket.h>
 33#include <linux/parport.h>
 34#include <linux/init.h>
 35#include <linux/usb.h>
 36#include <linux/delay.h>
 37#include <linux/completion.h>
 38#include <linux/kref.h>
 39#include <linux/slab.h>
 40#include <linux/sched/signal.h>
 41
 
 
 
 
 42#define DRIVER_AUTHOR "Thomas M. Sailer, t.sailer@alumni.ethz.ch"
 43#define DRIVER_DESC "USB Parport Cable driver for Cables using the Lucent Technologies USS720 Chip"
 44
 45/* --------------------------------------------------------------------- */
 46
 47struct parport_uss720_private {
 48	struct usb_device *usbdev;
 49	struct parport *pp;
 50	struct kref ref_count;
 51	__u8 reg[7];  /* USB registers */
 52	struct list_head asynclist;
 53	spinlock_t asynclock;
 54};
 55
 56struct uss720_async_request {
 57	struct parport_uss720_private *priv;
 58	struct kref ref_count;
 59	struct list_head asynclist;
 60	struct completion compl;
 61	struct urb *urb;
 62	struct usb_ctrlrequest *dr;
 63	__u8 reg[7];
 64};
 65
 66/* --------------------------------------------------------------------- */
 67
 68static void destroy_priv(struct kref *kref)
 69{
 70	struct parport_uss720_private *priv = container_of(kref, struct parport_uss720_private, ref_count);
 71
 72	dev_dbg(&priv->usbdev->dev, "destroying priv datastructure\n");
 73	usb_put_dev(priv->usbdev);
 74	priv->usbdev = NULL;
 75	kfree(priv);
 76}
 77
 78static void destroy_async(struct kref *kref)
 79{
 80	struct uss720_async_request *rq = container_of(kref, struct uss720_async_request, ref_count);
 81	struct parport_uss720_private *priv = rq->priv;
 82	unsigned long flags;
 83
 84	if (likely(rq->urb))
 85		usb_free_urb(rq->urb);
 86	kfree(rq->dr);
 87	spin_lock_irqsave(&priv->asynclock, flags);
 88	list_del_init(&rq->asynclist);
 89	spin_unlock_irqrestore(&priv->asynclock, flags);
 90	kfree(rq);
 91	kref_put(&priv->ref_count, destroy_priv);
 92}
 93
 94/* --------------------------------------------------------------------- */
 95
 96static void async_complete(struct urb *urb)
 97{
 98	struct uss720_async_request *rq;
 99	struct parport *pp;
100	struct parport_uss720_private *priv;
101	int status = urb->status;
102
103	rq = urb->context;
104	priv = rq->priv;
105	pp = priv->pp;
106	if (status) {
107		dev_err(&urb->dev->dev, "async_complete: urb error %d\n",
108			status);
109	} else if (rq->dr->bRequest == 3) {
110		memcpy(priv->reg, rq->reg, sizeof(priv->reg));
111#if 0
112		dev_dbg(&priv->usbdev->dev, "async_complete regs %7ph\n",
113			priv->reg);
 
 
 
 
114#endif
115		/* if nAck interrupts are enabled and we have an interrupt, call the interrupt procedure */
116		if (rq->reg[2] & rq->reg[1] & 0x10 && pp)
117			parport_generic_irq(pp);
118	}
119	complete(&rq->compl);
120	kref_put(&rq->ref_count, destroy_async);
121}
122
123static struct uss720_async_request *submit_async_request(struct parport_uss720_private *priv,
124							 __u8 request, __u8 requesttype, __u16 value, __u16 index,
125							 gfp_t mem_flags)
126{
127	struct usb_device *usbdev;
128	struct uss720_async_request *rq;
129	unsigned long flags;
130	int ret;
131
132	if (!priv)
133		return NULL;
134	usbdev = priv->usbdev;
135	if (!usbdev)
136		return NULL;
137	rq = kzalloc(sizeof(struct uss720_async_request), mem_flags);
138	if (!rq)
 
139		return NULL;
 
140	kref_init(&rq->ref_count);
141	INIT_LIST_HEAD(&rq->asynclist);
142	init_completion(&rq->compl);
143	kref_get(&priv->ref_count);
144	rq->priv = priv;
145	rq->urb = usb_alloc_urb(0, mem_flags);
146	if (!rq->urb) {
147		kref_put(&rq->ref_count, destroy_async);
 
148		return NULL;
149	}
150	rq->dr = kmalloc(sizeof(*rq->dr), mem_flags);
151	if (!rq->dr) {
152		kref_put(&rq->ref_count, destroy_async);
153		return NULL;
154	}
155	rq->dr->bRequestType = requesttype;
156	rq->dr->bRequest = request;
157	rq->dr->wValue = cpu_to_le16(value);
158	rq->dr->wIndex = cpu_to_le16(index);
159	rq->dr->wLength = cpu_to_le16((request == 3) ? sizeof(rq->reg) : 0);
160	usb_fill_control_urb(rq->urb, usbdev, (requesttype & 0x80) ? usb_rcvctrlpipe(usbdev, 0) : usb_sndctrlpipe(usbdev, 0),
161			     (unsigned char *)rq->dr,
162			     (request == 3) ? rq->reg : NULL, (request == 3) ? sizeof(rq->reg) : 0, async_complete, rq);
163	/* rq->urb->transfer_flags |= URB_ASYNC_UNLINK; */
164	spin_lock_irqsave(&priv->asynclock, flags);
165	list_add_tail(&rq->asynclist, &priv->asynclist);
166	spin_unlock_irqrestore(&priv->asynclock, flags);
167	kref_get(&rq->ref_count);
168	ret = usb_submit_urb(rq->urb, mem_flags);
169	if (!ret)
170		return rq;
171	destroy_async(&rq->ref_count);
172	dev_err(&usbdev->dev, "submit_async_request submit_urb failed with %d\n", ret);
173	return NULL;
174}
175
176static unsigned int kill_all_async_requests_priv(struct parport_uss720_private *priv)
177{
178	struct uss720_async_request *rq;
179	unsigned long flags;
180	unsigned int ret = 0;
181
182	spin_lock_irqsave(&priv->asynclock, flags);
183	list_for_each_entry(rq, &priv->asynclist, asynclist) {
184		usb_unlink_urb(rq->urb);
185		ret++;
186	}
187	spin_unlock_irqrestore(&priv->asynclock, flags);
188	return ret;
189}
190
191/* --------------------------------------------------------------------- */
192
193static int get_1284_register(struct parport *pp, unsigned char reg, unsigned char *val, gfp_t mem_flags)
194{
195	struct parport_uss720_private *priv;
196	struct uss720_async_request *rq;
197	static const unsigned char regindex[9] = {
198		4, 0, 1, 5, 5, 0, 2, 3, 6
199	};
200	int ret;
201
202	if (!pp)
203		return -EIO;
204	priv = pp->private_data;
205	rq = submit_async_request(priv, 3, 0xc0, ((unsigned int)reg) << 8, 0, mem_flags);
206	if (!rq) {
207		dev_err(&priv->usbdev->dev, "get_1284_register(%u) failed",
208			(unsigned int)reg);
209		return -EIO;
210	}
211	if (!val) {
212		kref_put(&rq->ref_count, destroy_async);
213		return 0;
214	}
215	if (wait_for_completion_timeout(&rq->compl, HZ)) {
216		ret = rq->urb->status;
217		*val = priv->reg[(reg >= 9) ? 0 : regindex[reg]];
218		if (ret)
219			printk(KERN_WARNING "get_1284_register: "
220			       "usb error %d\n", ret);
221		kref_put(&rq->ref_count, destroy_async);
222		return ret;
223	}
224	printk(KERN_WARNING "get_1284_register timeout\n");
225	kill_all_async_requests_priv(priv);
226	return -EIO;
227}
228
229static int set_1284_register(struct parport *pp, unsigned char reg, unsigned char val, gfp_t mem_flags)
230{
231	struct parport_uss720_private *priv;
232	struct uss720_async_request *rq;
233
234	if (!pp)
235		return -EIO;
236	priv = pp->private_data;
237	rq = submit_async_request(priv, 4, 0x40, (((unsigned int)reg) << 8) | val, 0, mem_flags);
238	if (!rq) {
239		dev_err(&priv->usbdev->dev, "set_1284_register(%u,%u) failed",
240			(unsigned int)reg, (unsigned int)val);
241		return -EIO;
242	}
243	kref_put(&rq->ref_count, destroy_async);
244	return 0;
245}
246
247/* --------------------------------------------------------------------- */
248
249/* ECR modes */
250#define ECR_SPP 00
251#define ECR_PS2 01
252#define ECR_PPF 02
253#define ECR_ECP 03
254#define ECR_EPP 04
255
256/* Safely change the mode bits in the ECR */
257static int change_mode(struct parport *pp, int m)
258{
259	struct parport_uss720_private *priv = pp->private_data;
260	int mode;
261	__u8 reg;
262
263	if (get_1284_register(pp, 6, &reg, GFP_KERNEL))
264		return -EIO;
265	/* Bits <7:5> contain the mode. */
266	mode = (priv->reg[2] >> 5) & 0x7;
267	if (mode == m)
268		return 0;
269	/* We have to go through mode 000 or 001 */
270	if (mode > ECR_PS2 && m > ECR_PS2)
271		if (change_mode(pp, ECR_PS2))
272			return -EIO;
273
274	if (m <= ECR_PS2 && !(priv->reg[1] & 0x20)) {
275		/* This mode resets the FIFO, so we may
276		 * have to wait for it to drain first. */
277		unsigned long expire = jiffies + pp->physport->cad->timeout;
278		switch (mode) {
279		case ECR_PPF: /* Parallel Port FIFO mode */
280		case ECR_ECP: /* ECP Parallel Port mode */
281			/* Poll slowly. */
282			for (;;) {
283				if (get_1284_register(pp, 6, &reg, GFP_KERNEL))
284					return -EIO;
285				if (priv->reg[2] & 0x01)
286					break;
287				if (time_after_eq (jiffies, expire))
288					/* The FIFO is stuck. */
289					return -EBUSY;
290				msleep_interruptible(10);
291				if (signal_pending (current))
292					break;
293			}
294		}
295	}
296	/* Set the mode. */
297	if (set_1284_register(pp, 6, m << 5, GFP_KERNEL))
298		return -EIO;
299	if (get_1284_register(pp, 6, &reg, GFP_KERNEL))
300		return -EIO;
301	return 0;
302}
303
304/*
305 * Clear TIMEOUT BIT in EPP MODE
306 */
307static int clear_epp_timeout(struct parport *pp)
308{
309	unsigned char stat;
310
311	if (get_1284_register(pp, 1, &stat, GFP_KERNEL))
312		return 1;
313	return stat & 1;
314}
315
316/*
317 * Access functions.
318 */
319#if 0
320static int uss720_irq(int usbstatus, void *buffer, int len, void *dev_id)
321{
322	struct parport *pp = (struct parport *)dev_id;
323	struct parport_uss720_private *priv = pp->private_data;	
324
325	if (usbstatus != 0 || len < 4 || !buffer)
326		return 1;
327	memcpy(priv->reg, buffer, 4);
328	/* if nAck interrupts are enabled and we have an interrupt, call the interrupt procedure */
329	if (priv->reg[2] & priv->reg[1] & 0x10)
330		parport_generic_irq(pp);
331	return 1;
332}
333#endif
334
335static void parport_uss720_write_data(struct parport *pp, unsigned char d)
336{
337	set_1284_register(pp, 0, d, GFP_KERNEL);
338}
339
340static unsigned char parport_uss720_read_data(struct parport *pp)
341{
342	unsigned char ret;
343
344	if (get_1284_register(pp, 0, &ret, GFP_KERNEL))
345		return 0;
346	return ret;
347}
348
349static void parport_uss720_write_control(struct parport *pp, unsigned char d)
350{
351	struct parport_uss720_private *priv = pp->private_data;	
352
353	d = (d & 0xf) | (priv->reg[1] & 0xf0);
354	if (set_1284_register(pp, 2, d, GFP_KERNEL))
355		return;
356	priv->reg[1] = d;
357}
358
359static unsigned char parport_uss720_read_control(struct parport *pp)
360{
361	struct parport_uss720_private *priv = pp->private_data;	
362	return priv->reg[1] & 0xf; /* Use soft copy */
363}
364
365static unsigned char parport_uss720_frob_control(struct parport *pp, unsigned char mask, unsigned char val)
366{
367	struct parport_uss720_private *priv = pp->private_data;	
368	unsigned char d;
369
370	mask &= 0x0f;
371	val &= 0x0f;
372	d = (priv->reg[1] & (~mask)) ^ val;
373	if (set_1284_register(pp, 2, d, GFP_ATOMIC))
374		return 0;
375	priv->reg[1] = d;
376	return d & 0xf;
377}
378
379static unsigned char parport_uss720_read_status(struct parport *pp)
380{
381	unsigned char ret;
382
383	if (get_1284_register(pp, 1, &ret, GFP_ATOMIC))
384		return 0;
385	return ret & 0xf8;
386}
387
388static void parport_uss720_disable_irq(struct parport *pp)
389{
390	struct parport_uss720_private *priv = pp->private_data;	
391	unsigned char d;
392
393	d = priv->reg[1] & ~0x10;
394	if (set_1284_register(pp, 2, d, GFP_KERNEL))
395		return;
396	priv->reg[1] = d;
397}
398
399static void parport_uss720_enable_irq(struct parport *pp)
400{
401	struct parport_uss720_private *priv = pp->private_data;	
402	unsigned char d;
403
404	d = priv->reg[1] | 0x10;
405	if (set_1284_register(pp, 2, d, GFP_KERNEL))
406		return;
407	priv->reg[1] = d;
408}
409
410static void parport_uss720_data_forward (struct parport *pp)
411{
412	struct parport_uss720_private *priv = pp->private_data;	
413	unsigned char d;
414
415	d = priv->reg[1] & ~0x20;
416	if (set_1284_register(pp, 2, d, GFP_KERNEL))
417		return;
418	priv->reg[1] = d;
419}
420
421static void parport_uss720_data_reverse (struct parport *pp)
422{
423	struct parport_uss720_private *priv = pp->private_data;	
424	unsigned char d;
425
426	d = priv->reg[1] | 0x20;
427	if (set_1284_register(pp, 2, d, GFP_KERNEL))
428		return;
429	priv->reg[1] = d;
430}
431
432static void parport_uss720_init_state(struct pardevice *dev, struct parport_state *s)
433{
434	s->u.pc.ctr = 0xc | (dev->irq_func ? 0x10 : 0x0);
435	s->u.pc.ecr = 0x24;
436}
437
438static void parport_uss720_save_state(struct parport *pp, struct parport_state *s)
439{
440	struct parport_uss720_private *priv = pp->private_data;	
441
442#if 0
443	if (get_1284_register(pp, 2, NULL, GFP_ATOMIC))
444		return;
445#endif
446	s->u.pc.ctr = priv->reg[1];
447	s->u.pc.ecr = priv->reg[2];
448}
449
450static void parport_uss720_restore_state(struct parport *pp, struct parport_state *s)
451{
452	struct parport_uss720_private *priv = pp->private_data;
453
454	set_1284_register(pp, 2, s->u.pc.ctr, GFP_ATOMIC);
455	set_1284_register(pp, 6, s->u.pc.ecr, GFP_ATOMIC);
456	get_1284_register(pp, 2, NULL, GFP_ATOMIC);
457	priv->reg[1] = s->u.pc.ctr;
458	priv->reg[2] = s->u.pc.ecr;
459}
460
461static size_t parport_uss720_epp_read_data(struct parport *pp, void *buf, size_t length, int flags)
462{
463	struct parport_uss720_private *priv = pp->private_data;	
464	size_t got = 0;
465
466	if (change_mode(pp, ECR_EPP))
467		return 0;
468	for (; got < length; got++) {
469		if (get_1284_register(pp, 4, (char *)buf, GFP_KERNEL))
470			break;
471		buf++;
472		if (priv->reg[0] & 0x01) {
473			clear_epp_timeout(pp);
474			break;
475		}
476	}
477	change_mode(pp, ECR_PS2);
478	return got;
479}
480
481static size_t parport_uss720_epp_write_data(struct parport *pp, const void *buf, size_t length, int flags)
482{
483#if 0
484	struct parport_uss720_private *priv = pp->private_data;	
485	size_t written = 0;
486
487	if (change_mode(pp, ECR_EPP))
488		return 0;
489	for (; written < length; written++) {
490		if (set_1284_register(pp, 4, (char *)buf, GFP_KERNEL))
491			break;
492		((char*)buf)++;
493		if (get_1284_register(pp, 1, NULL, GFP_KERNEL))
494			break;
495		if (priv->reg[0] & 0x01) {
496			clear_epp_timeout(pp);
497			break;
498		}
499	}
500	change_mode(pp, ECR_PS2);
501	return written;
502#else
503	struct parport_uss720_private *priv = pp->private_data;
504	struct usb_device *usbdev = priv->usbdev;
505	int rlen = 0;
506	int i;
507
508	if (!usbdev)
509		return 0;
510	if (change_mode(pp, ECR_EPP))
511		return 0;
512	i = usb_bulk_msg(usbdev, usb_sndbulkpipe(usbdev, 1), (void *)buf, length, &rlen, 20000);
513	if (i)
514		printk(KERN_ERR "uss720: sendbulk ep 1 buf %p len %zu rlen %u\n", buf, length, rlen);
515	change_mode(pp, ECR_PS2);
516	return rlen;
517#endif
518}
519
520static size_t parport_uss720_epp_read_addr(struct parport *pp, void *buf, size_t length, int flags)
521{
522	struct parport_uss720_private *priv = pp->private_data;	
523	size_t got = 0;
524
525	if (change_mode(pp, ECR_EPP))
526		return 0;
527	for (; got < length; got++) {
528		if (get_1284_register(pp, 3, (char *)buf, GFP_KERNEL))
529			break;
530		buf++;
531		if (priv->reg[0] & 0x01) {
532			clear_epp_timeout(pp);
533			break;
534		}
535	}
536	change_mode(pp, ECR_PS2);
537	return got;
538}
539
540static size_t parport_uss720_epp_write_addr(struct parport *pp, const void *buf, size_t length, int flags)
541{
542	struct parport_uss720_private *priv = pp->private_data;	
543	size_t written = 0;
544
545	if (change_mode(pp, ECR_EPP))
546		return 0;
547	for (; written < length; written++) {
548		if (set_1284_register(pp, 3, *(char *)buf, GFP_KERNEL))
549			break;
550		buf++;
551		if (get_1284_register(pp, 1, NULL, GFP_KERNEL))
552			break;
553		if (priv->reg[0] & 0x01) {
554			clear_epp_timeout(pp);
555			break;
556		}
557	}
558	change_mode(pp, ECR_PS2);
559	return written;
560}
561
562static size_t parport_uss720_ecp_write_data(struct parport *pp, const void *buffer, size_t len, int flags)
563{
564	struct parport_uss720_private *priv = pp->private_data;
565	struct usb_device *usbdev = priv->usbdev;
566	int rlen = 0;
567	int i;
568
569	if (!usbdev)
570		return 0;
571	if (change_mode(pp, ECR_ECP))
572		return 0;
573	i = usb_bulk_msg(usbdev, usb_sndbulkpipe(usbdev, 1), (void *)buffer, len, &rlen, 20000);
574	if (i)
575		printk(KERN_ERR "uss720: sendbulk ep 1 buf %p len %zu rlen %u\n", buffer, len, rlen);
576	change_mode(pp, ECR_PS2);
577	return rlen;
578}
579
580static size_t parport_uss720_ecp_read_data(struct parport *pp, void *buffer, size_t len, int flags)
581{
582	struct parport_uss720_private *priv = pp->private_data;
583	struct usb_device *usbdev = priv->usbdev;
584	int rlen = 0;
585	int i;
586
587	if (!usbdev)
588		return 0;
589	if (change_mode(pp, ECR_ECP))
590		return 0;
591	i = usb_bulk_msg(usbdev, usb_rcvbulkpipe(usbdev, 2), buffer, len, &rlen, 20000);
592	if (i)
593		printk(KERN_ERR "uss720: recvbulk ep 2 buf %p len %zu rlen %u\n", buffer, len, rlen);
594	change_mode(pp, ECR_PS2);
595	return rlen;
596}
597
598static size_t parport_uss720_ecp_write_addr(struct parport *pp, const void *buffer, size_t len, int flags)
599{
600	size_t written = 0;
601
602	if (change_mode(pp, ECR_ECP))
603		return 0;
604	for (; written < len; written++) {
605		if (set_1284_register(pp, 5, *(char *)buffer, GFP_KERNEL))
606			break;
607		buffer++;
608	}
609	change_mode(pp, ECR_PS2);
610	return written;
611}
612
613static size_t parport_uss720_write_compat(struct parport *pp, const void *buffer, size_t len, int flags)
614{
615	struct parport_uss720_private *priv = pp->private_data;
616	struct usb_device *usbdev = priv->usbdev;
617	int rlen = 0;
618	int i;
619
620	if (!usbdev)
621		return 0;
622	if (change_mode(pp, ECR_PPF))
623		return 0;
624	i = usb_bulk_msg(usbdev, usb_sndbulkpipe(usbdev, 1), (void *)buffer, len, &rlen, 20000);
625	if (i)
626		printk(KERN_ERR "uss720: sendbulk ep 1 buf %p len %zu rlen %u\n", buffer, len, rlen);
627	change_mode(pp, ECR_PS2);
628	return rlen;
629}
630
631/* --------------------------------------------------------------------- */
632
633static struct parport_operations parport_uss720_ops = 
634{
635	.owner =		THIS_MODULE,
636	.write_data =		parport_uss720_write_data,
637	.read_data =		parport_uss720_read_data,
638
639	.write_control =	parport_uss720_write_control,
640	.read_control =		parport_uss720_read_control,
641	.frob_control =		parport_uss720_frob_control,
642
643	.read_status =		parport_uss720_read_status,
644
645	.enable_irq =		parport_uss720_enable_irq,
646	.disable_irq =		parport_uss720_disable_irq,
647
648	.data_forward =		parport_uss720_data_forward,
649	.data_reverse =		parport_uss720_data_reverse,
650
651	.init_state =		parport_uss720_init_state,
652	.save_state =		parport_uss720_save_state,
653	.restore_state =	parport_uss720_restore_state,
654
655	.epp_write_data =	parport_uss720_epp_write_data,
656	.epp_read_data =	parport_uss720_epp_read_data,
657	.epp_write_addr =	parport_uss720_epp_write_addr,
658	.epp_read_addr =	parport_uss720_epp_read_addr,
659
660	.ecp_write_data =	parport_uss720_ecp_write_data,
661	.ecp_read_data =	parport_uss720_ecp_read_data,
662	.ecp_write_addr =	parport_uss720_ecp_write_addr,
663
664	.compat_write_data =	parport_uss720_write_compat,
665	.nibble_read_data =	parport_ieee1284_read_nibble,
666	.byte_read_data =	parport_ieee1284_read_byte,
667};
668
669/* --------------------------------------------------------------------- */
670
671static int uss720_probe(struct usb_interface *intf,
672			const struct usb_device_id *id)
673{
674	struct usb_device *usbdev = usb_get_dev(interface_to_usbdev(intf));
675	struct usb_host_interface *interface;
676	struct usb_endpoint_descriptor *epd;
677	struct parport_uss720_private *priv;
678	struct parport *pp;
679	unsigned char reg;
680	int i;
681
682	dev_dbg(&intf->dev, "probe: vendor id 0x%x, device id 0x%x\n",
683		le16_to_cpu(usbdev->descriptor.idVendor),
684		le16_to_cpu(usbdev->descriptor.idProduct));
685
686	/* our known interfaces have 3 alternate settings */
687	if (intf->num_altsetting != 3) {
688		usb_put_dev(usbdev);
689		return -ENODEV;
690	}
691	i = usb_set_interface(usbdev, intf->altsetting->desc.bInterfaceNumber, 2);
692	dev_dbg(&intf->dev, "set interface result %d\n", i);
693
694	interface = intf->cur_altsetting;
695
696	if (interface->desc.bNumEndpoints < 3) {
697		usb_put_dev(usbdev);
698		return -ENODEV;
699	}
700
701	/*
702	 * Allocate parport interface 
703	 */
704	priv = kzalloc(sizeof(struct parport_uss720_private), GFP_KERNEL);
705	if (!priv) {
706		usb_put_dev(usbdev);
707		return -ENOMEM;
708	}
709	priv->pp = NULL;
710	priv->usbdev = usbdev;
711	kref_init(&priv->ref_count);
712	spin_lock_init(&priv->asynclock);
713	INIT_LIST_HEAD(&priv->asynclist);
714	pp = parport_register_port(0, PARPORT_IRQ_NONE, PARPORT_DMA_NONE, &parport_uss720_ops);
715	if (!pp) {
716		printk(KERN_WARNING "uss720: could not register parport\n");
717		goto probe_abort;
718	}
719
720	priv->pp = pp;
721	pp->private_data = priv;
722	pp->modes = PARPORT_MODE_PCSPP | PARPORT_MODE_TRISTATE | PARPORT_MODE_EPP | PARPORT_MODE_ECP | PARPORT_MODE_COMPAT;
723
724	/* set the USS720 control register to manual mode, no ECP compression, enable all ints */
725	set_1284_register(pp, 7, 0x00, GFP_KERNEL);
726	set_1284_register(pp, 6, 0x30, GFP_KERNEL);  /* PS/2 mode */
727	set_1284_register(pp, 2, 0x0c, GFP_KERNEL);
728	/* debugging */
729	get_1284_register(pp, 0, &reg, GFP_KERNEL);
730	dev_dbg(&intf->dev, "reg: %7ph\n", priv->reg);
731
732	i = usb_find_last_int_in_endpoint(interface, &epd);
733	if (!i) {
734		dev_dbg(&intf->dev, "epaddr %d interval %d\n",
735				epd->bEndpointAddress, epd->bInterval);
736	}
737	parport_announce_port(pp);
738
739	usb_set_intfdata(intf, pp);
740	return 0;
741
742probe_abort:
743	kill_all_async_requests_priv(priv);
744	kref_put(&priv->ref_count, destroy_priv);
745	return -ENODEV;
746}
747
748static void uss720_disconnect(struct usb_interface *intf)
749{
750	struct parport *pp = usb_get_intfdata(intf);
751	struct parport_uss720_private *priv;
 
752
753	dev_dbg(&intf->dev, "disconnect\n");
754	usb_set_intfdata(intf, NULL);
755	if (pp) {
756		priv = pp->private_data;
 
 
757		priv->pp = NULL;
758		dev_dbg(&intf->dev, "parport_remove_port\n");
759		parport_remove_port(pp);
760		parport_put_port(pp);
761		kill_all_async_requests_priv(priv);
762		kref_put(&priv->ref_count, destroy_priv);
763	}
764	dev_dbg(&intf->dev, "disconnect done\n");
765}
766
767/* table of cables that work through this driver */
768static const struct usb_device_id uss720_table[] = {
769	{ USB_DEVICE(0x047e, 0x1001) },
770	{ USB_DEVICE(0x04b8, 0x0002) },
771	{ USB_DEVICE(0x04b8, 0x0003) },
772	{ USB_DEVICE(0x050d, 0x0002) },
773	{ USB_DEVICE(0x050d, 0x1202) },
774	{ USB_DEVICE(0x0557, 0x2001) },
775	{ USB_DEVICE(0x05ab, 0x0002) },
776	{ USB_DEVICE(0x06c6, 0x0100) },
777	{ USB_DEVICE(0x0729, 0x1284) },
778	{ USB_DEVICE(0x1293, 0x0002) },
 
779	{ }						/* Terminating entry */
780};
781
782MODULE_DEVICE_TABLE (usb, uss720_table);
783
784
785static struct usb_driver uss720_driver = {
786	.name =		"uss720",
787	.probe =	uss720_probe,
788	.disconnect =	uss720_disconnect,
789	.id_table =	uss720_table,
790};
791
792/* --------------------------------------------------------------------- */
793
794MODULE_AUTHOR(DRIVER_AUTHOR);
795MODULE_DESCRIPTION(DRIVER_DESC);
796MODULE_LICENSE("GPL");
797
798static int __init uss720_init(void)
799{
800	int retval;
801	retval = usb_register(&uss720_driver);
802	if (retval)
803		goto out;
804
805	printk(KERN_INFO KBUILD_MODNAME ": " DRIVER_DESC "\n");
 
806	printk(KERN_INFO KBUILD_MODNAME ": NOTE: this is a special purpose "
807	       "driver to allow nonstandard\n");
808	printk(KERN_INFO KBUILD_MODNAME ": protocols (eg. bitbang) over "
809	       "USS720 usb to parallel cables\n");
810	printk(KERN_INFO KBUILD_MODNAME ": If you just want to connect to a "
811	       "printer, use usblp instead\n");
812out:
813	return retval;
814}
815
816static void __exit uss720_cleanup(void)
817{
818	usb_deregister(&uss720_driver);
819}
820
821module_init(uss720_init);
822module_exit(uss720_cleanup);
823
824/* --------------------------------------------------------------------- */
v3.15
 
  1/*****************************************************************************/
  2
  3/*
  4 *	uss720.c  --  USS720 USB Parport Cable.
  5 *
  6 *	Copyright (C) 1999, 2005, 2010
  7 *	    Thomas Sailer (t.sailer@alumni.ethz.ch)
  8 *
  9 *	This program is free software; you can redistribute it and/or modify
 10 *	it under the terms of the GNU General Public License as published by
 11 *	the Free Software Foundation; either version 2 of the License, or
 12 *	(at your option) any later version.
 13 *
 14 *	This program is distributed in the hope that it will be useful,
 15 *	but WITHOUT ANY WARRANTY; without even the implied warranty of
 16 *	MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
 17 *	GNU General Public License for more details.
 18 *
 19 *	You should have received a copy of the GNU General Public License
 20 *	along with this program; if not, write to the Free Software
 21 *	Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA.
 22 *
 23 *  Based on parport_pc.c
 24 *
 25 *  History:
 26 *   0.1  04.08.1999  Created
 27 *   0.2  07.08.1999  Some fixes mainly suggested by Tim Waugh
 28 *		      Interrupt handling currently disabled because
 29 *		      usb_request_irq crashes somewhere within ohci.c
 30 *		      for no apparent reason (that is for me, anyway)
 31 *		      ECP currently untested
 32 *   0.3  10.08.1999  fixing merge errors
 33 *   0.4  13.08.1999  Added Vendor/Product ID of Brad Hard's cable
 34 *   0.5  20.09.1999  usb_control_msg wrapper used
 35 *        Nov01.2000  usb_device_table support by Adam J. Richter
 36 *        08.04.2001  Identify version on module load.  gb
 37 *   0.6  02.09.2005  Fix "scheduling in interrupt" problem by making save/restore
 38 *                    context asynchronous
 39 *
 40 */
 41
 42/*****************************************************************************/
 43
 44#include <linux/module.h>
 45#include <linux/socket.h>
 46#include <linux/parport.h>
 47#include <linux/init.h>
 48#include <linux/usb.h>
 49#include <linux/delay.h>
 50#include <linux/completion.h>
 51#include <linux/kref.h>
 52#include <linux/slab.h>
 
 53
 54/*
 55 * Version Information
 56 */
 57#define DRIVER_VERSION "v0.6"
 58#define DRIVER_AUTHOR "Thomas M. Sailer, t.sailer@alumni.ethz.ch"
 59#define DRIVER_DESC "USB Parport Cable driver for Cables using the Lucent Technologies USS720 Chip"
 60
 61/* --------------------------------------------------------------------- */
 62
 63struct parport_uss720_private {
 64	struct usb_device *usbdev;
 65	struct parport *pp;
 66	struct kref ref_count;
 67	__u8 reg[7];  /* USB registers */
 68	struct list_head asynclist;
 69	spinlock_t asynclock;
 70};
 71
 72struct uss720_async_request {
 73	struct parport_uss720_private *priv;
 74	struct kref ref_count;
 75	struct list_head asynclist;
 76	struct completion compl;
 77	struct urb *urb;
 78	struct usb_ctrlrequest *dr;
 79	__u8 reg[7];
 80};
 81
 82/* --------------------------------------------------------------------- */
 83
 84static void destroy_priv(struct kref *kref)
 85{
 86	struct parport_uss720_private *priv = container_of(kref, struct parport_uss720_private, ref_count);
 87
 88	dev_dbg(&priv->usbdev->dev, "destroying priv datastructure\n");
 89	usb_put_dev(priv->usbdev);
 
 90	kfree(priv);
 91}
 92
 93static void destroy_async(struct kref *kref)
 94{
 95	struct uss720_async_request *rq = container_of(kref, struct uss720_async_request, ref_count);
 96	struct parport_uss720_private *priv = rq->priv;
 97	unsigned long flags;
 98
 99	if (likely(rq->urb))
100		usb_free_urb(rq->urb);
101	kfree(rq->dr);
102	spin_lock_irqsave(&priv->asynclock, flags);
103	list_del_init(&rq->asynclist);
104	spin_unlock_irqrestore(&priv->asynclock, flags);
105	kfree(rq);
106	kref_put(&priv->ref_count, destroy_priv);
107}
108
109/* --------------------------------------------------------------------- */
110
111static void async_complete(struct urb *urb)
112{
113	struct uss720_async_request *rq;
114	struct parport *pp;
115	struct parport_uss720_private *priv;
116	int status = urb->status;
117
118	rq = urb->context;
119	priv = rq->priv;
120	pp = priv->pp;
121	if (status) {
122		dev_err(&urb->dev->dev, "async_complete: urb error %d\n",
123			status);
124	} else if (rq->dr->bRequest == 3) {
125		memcpy(priv->reg, rq->reg, sizeof(priv->reg));
126#if 0
127		dev_dbg(&priv->usbdev->dev,
128			"async_complete regs %02x %02x %02x %02x %02x %02x %02x\n",
129			(unsigned int)priv->reg[0], (unsigned int)priv->reg[1],
130			(unsigned int)priv->reg[2], (unsigned int)priv->reg[3],
131			(unsigned int)priv->reg[4], (unsigned int)priv->reg[5],
132			(unsigned int)priv->reg[6]);
133#endif
134		/* if nAck interrupts are enabled and we have an interrupt, call the interrupt procedure */
135		if (rq->reg[2] & rq->reg[1] & 0x10 && pp)
136			parport_generic_irq(pp);
137	}
138	complete(&rq->compl);
139	kref_put(&rq->ref_count, destroy_async);
140}
141
142static struct uss720_async_request *submit_async_request(struct parport_uss720_private *priv,
143							 __u8 request, __u8 requesttype, __u16 value, __u16 index,
144							 gfp_t mem_flags)
145{
146	struct usb_device *usbdev;
147	struct uss720_async_request *rq;
148	unsigned long flags;
149	int ret;
150
151	if (!priv)
152		return NULL;
153	usbdev = priv->usbdev;
154	if (!usbdev)
155		return NULL;
156	rq = kzalloc(sizeof(struct uss720_async_request), mem_flags);
157	if (!rq) {
158		dev_err(&usbdev->dev, "submit_async_request out of memory\n");
159		return NULL;
160	}
161	kref_init(&rq->ref_count);
162	INIT_LIST_HEAD(&rq->asynclist);
163	init_completion(&rq->compl);
164	kref_get(&priv->ref_count);
165	rq->priv = priv;
166	rq->urb = usb_alloc_urb(0, mem_flags);
167	if (!rq->urb) {
168		kref_put(&rq->ref_count, destroy_async);
169		dev_err(&usbdev->dev, "submit_async_request out of memory\n");
170		return NULL;
171	}
172	rq->dr = kmalloc(sizeof(*rq->dr), mem_flags);
173	if (!rq->dr) {
174		kref_put(&rq->ref_count, destroy_async);
175		return NULL;
176	}
177	rq->dr->bRequestType = requesttype;
178	rq->dr->bRequest = request;
179	rq->dr->wValue = cpu_to_le16(value);
180	rq->dr->wIndex = cpu_to_le16(index);
181	rq->dr->wLength = cpu_to_le16((request == 3) ? sizeof(rq->reg) : 0);
182	usb_fill_control_urb(rq->urb, usbdev, (requesttype & 0x80) ? usb_rcvctrlpipe(usbdev, 0) : usb_sndctrlpipe(usbdev, 0),
183			     (unsigned char *)rq->dr,
184			     (request == 3) ? rq->reg : NULL, (request == 3) ? sizeof(rq->reg) : 0, async_complete, rq);
185	/* rq->urb->transfer_flags |= URB_ASYNC_UNLINK; */
186	spin_lock_irqsave(&priv->asynclock, flags);
187	list_add_tail(&rq->asynclist, &priv->asynclist);
188	spin_unlock_irqrestore(&priv->asynclock, flags);
189	kref_get(&rq->ref_count);
190	ret = usb_submit_urb(rq->urb, mem_flags);
191	if (!ret)
192		return rq;
193	destroy_async(&rq->ref_count);
194	dev_err(&usbdev->dev, "submit_async_request submit_urb failed with %d\n", ret);
195	return NULL;
196}
197
198static unsigned int kill_all_async_requests_priv(struct parport_uss720_private *priv)
199{
200	struct uss720_async_request *rq;
201	unsigned long flags;
202	unsigned int ret = 0;
203
204	spin_lock_irqsave(&priv->asynclock, flags);
205	list_for_each_entry(rq, &priv->asynclist, asynclist) {
206		usb_unlink_urb(rq->urb);
207		ret++;
208	}
209	spin_unlock_irqrestore(&priv->asynclock, flags);
210	return ret;
211}
212
213/* --------------------------------------------------------------------- */
214
215static int get_1284_register(struct parport *pp, unsigned char reg, unsigned char *val, gfp_t mem_flags)
216{
217	struct parport_uss720_private *priv;
218	struct uss720_async_request *rq;
219	static const unsigned char regindex[9] = {
220		4, 0, 1, 5, 5, 0, 2, 3, 6
221	};
222	int ret;
223
224	if (!pp)
225		return -EIO;
226	priv = pp->private_data;
227	rq = submit_async_request(priv, 3, 0xc0, ((unsigned int)reg) << 8, 0, mem_flags);
228	if (!rq) {
229		dev_err(&priv->usbdev->dev, "get_1284_register(%u) failed",
230			(unsigned int)reg);
231		return -EIO;
232	}
233	if (!val) {
234		kref_put(&rq->ref_count, destroy_async);
235		return 0;
236	}
237	if (wait_for_completion_timeout(&rq->compl, HZ)) {
238		ret = rq->urb->status;
239		*val = priv->reg[(reg >= 9) ? 0 : regindex[reg]];
240		if (ret)
241			printk(KERN_WARNING "get_1284_register: "
242			       "usb error %d\n", ret);
243		kref_put(&rq->ref_count, destroy_async);
244		return ret;
245	}
246	printk(KERN_WARNING "get_1284_register timeout\n");
247	kill_all_async_requests_priv(priv);
248	return -EIO;
249}
250
251static int set_1284_register(struct parport *pp, unsigned char reg, unsigned char val, gfp_t mem_flags)
252{
253	struct parport_uss720_private *priv;
254	struct uss720_async_request *rq;
255
256	if (!pp)
257		return -EIO;
258	priv = pp->private_data;
259	rq = submit_async_request(priv, 4, 0x40, (((unsigned int)reg) << 8) | val, 0, mem_flags);
260	if (!rq) {
261		dev_err(&priv->usbdev->dev, "set_1284_register(%u,%u) failed",
262			(unsigned int)reg, (unsigned int)val);
263		return -EIO;
264	}
265	kref_put(&rq->ref_count, destroy_async);
266	return 0;
267}
268
269/* --------------------------------------------------------------------- */
270
271/* ECR modes */
272#define ECR_SPP 00
273#define ECR_PS2 01
274#define ECR_PPF 02
275#define ECR_ECP 03
276#define ECR_EPP 04
277
278/* Safely change the mode bits in the ECR */
279static int change_mode(struct parport *pp, int m)
280{
281	struct parport_uss720_private *priv = pp->private_data;
282	int mode;
283	__u8 reg;
284
285	if (get_1284_register(pp, 6, &reg, GFP_KERNEL))
286		return -EIO;
287	/* Bits <7:5> contain the mode. */
288	mode = (priv->reg[2] >> 5) & 0x7;
289	if (mode == m)
290		return 0;
291	/* We have to go through mode 000 or 001 */
292	if (mode > ECR_PS2 && m > ECR_PS2)
293		if (change_mode(pp, ECR_PS2))
294			return -EIO;
295
296	if (m <= ECR_PS2 && !(priv->reg[1] & 0x20)) {
297		/* This mode resets the FIFO, so we may
298		 * have to wait for it to drain first. */
299		unsigned long expire = jiffies + pp->physport->cad->timeout;
300		switch (mode) {
301		case ECR_PPF: /* Parallel Port FIFO mode */
302		case ECR_ECP: /* ECP Parallel Port mode */
303			/* Poll slowly. */
304			for (;;) {
305				if (get_1284_register(pp, 6, &reg, GFP_KERNEL))
306					return -EIO;
307				if (priv->reg[2] & 0x01)
308					break;
309				if (time_after_eq (jiffies, expire))
310					/* The FIFO is stuck. */
311					return -EBUSY;
312				msleep_interruptible(10);
313				if (signal_pending (current))
314					break;
315			}
316		}
317	}
318	/* Set the mode. */
319	if (set_1284_register(pp, 6, m << 5, GFP_KERNEL))
320		return -EIO;
321	if (get_1284_register(pp, 6, &reg, GFP_KERNEL))
322		return -EIO;
323	return 0;
324}
325
326/*
327 * Clear TIMEOUT BIT in EPP MODE
328 */
329static int clear_epp_timeout(struct parport *pp)
330{
331	unsigned char stat;
332
333	if (get_1284_register(pp, 1, &stat, GFP_KERNEL))
334		return 1;
335	return stat & 1;
336}
337
338/*
339 * Access functions.
340 */
341#if 0
342static int uss720_irq(int usbstatus, void *buffer, int len, void *dev_id)
343{
344	struct parport *pp = (struct parport *)dev_id;
345	struct parport_uss720_private *priv = pp->private_data;	
346
347	if (usbstatus != 0 || len < 4 || !buffer)
348		return 1;
349	memcpy(priv->reg, buffer, 4);
350	/* if nAck interrupts are enabled and we have an interrupt, call the interrupt procedure */
351	if (priv->reg[2] & priv->reg[1] & 0x10)
352		parport_generic_irq(pp);
353	return 1;
354}
355#endif
356
357static void parport_uss720_write_data(struct parport *pp, unsigned char d)
358{
359	set_1284_register(pp, 0, d, GFP_KERNEL);
360}
361
362static unsigned char parport_uss720_read_data(struct parport *pp)
363{
364	unsigned char ret;
365
366	if (get_1284_register(pp, 0, &ret, GFP_KERNEL))
367		return 0;
368	return ret;
369}
370
371static void parport_uss720_write_control(struct parport *pp, unsigned char d)
372{
373	struct parport_uss720_private *priv = pp->private_data;	
374
375	d = (d & 0xf) | (priv->reg[1] & 0xf0);
376	if (set_1284_register(pp, 2, d, GFP_KERNEL))
377		return;
378	priv->reg[1] = d;
379}
380
381static unsigned char parport_uss720_read_control(struct parport *pp)
382{
383	struct parport_uss720_private *priv = pp->private_data;	
384	return priv->reg[1] & 0xf; /* Use soft copy */
385}
386
387static unsigned char parport_uss720_frob_control(struct parport *pp, unsigned char mask, unsigned char val)
388{
389	struct parport_uss720_private *priv = pp->private_data;	
390	unsigned char d;
391
392	mask &= 0x0f;
393	val &= 0x0f;
394	d = (priv->reg[1] & (~mask)) ^ val;
395	if (set_1284_register(pp, 2, d, GFP_KERNEL))
396		return 0;
397	priv->reg[1] = d;
398	return d & 0xf;
399}
400
401static unsigned char parport_uss720_read_status(struct parport *pp)
402{
403	unsigned char ret;
404
405	if (get_1284_register(pp, 1, &ret, GFP_KERNEL))
406		return 0;
407	return ret & 0xf8;
408}
409
410static void parport_uss720_disable_irq(struct parport *pp)
411{
412	struct parport_uss720_private *priv = pp->private_data;	
413	unsigned char d;
414
415	d = priv->reg[1] & ~0x10;
416	if (set_1284_register(pp, 2, d, GFP_KERNEL))
417		return;
418	priv->reg[1] = d;
419}
420
421static void parport_uss720_enable_irq(struct parport *pp)
422{
423	struct parport_uss720_private *priv = pp->private_data;	
424	unsigned char d;
425
426	d = priv->reg[1] | 0x10;
427	if (set_1284_register(pp, 2, d, GFP_KERNEL))
428		return;
429	priv->reg[1] = d;
430}
431
432static void parport_uss720_data_forward (struct parport *pp)
433{
434	struct parport_uss720_private *priv = pp->private_data;	
435	unsigned char d;
436
437	d = priv->reg[1] & ~0x20;
438	if (set_1284_register(pp, 2, d, GFP_KERNEL))
439		return;
440	priv->reg[1] = d;
441}
442
443static void parport_uss720_data_reverse (struct parport *pp)
444{
445	struct parport_uss720_private *priv = pp->private_data;	
446	unsigned char d;
447
448	d = priv->reg[1] | 0x20;
449	if (set_1284_register(pp, 2, d, GFP_KERNEL))
450		return;
451	priv->reg[1] = d;
452}
453
454static void parport_uss720_init_state(struct pardevice *dev, struct parport_state *s)
455{
456	s->u.pc.ctr = 0xc | (dev->irq_func ? 0x10 : 0x0);
457	s->u.pc.ecr = 0x24;
458}
459
460static void parport_uss720_save_state(struct parport *pp, struct parport_state *s)
461{
462	struct parport_uss720_private *priv = pp->private_data;	
463
464#if 0
465	if (get_1284_register(pp, 2, NULL, GFP_ATOMIC))
466		return;
467#endif
468	s->u.pc.ctr = priv->reg[1];
469	s->u.pc.ecr = priv->reg[2];
470}
471
472static void parport_uss720_restore_state(struct parport *pp, struct parport_state *s)
473{
474	struct parport_uss720_private *priv = pp->private_data;
475
476	set_1284_register(pp, 2, s->u.pc.ctr, GFP_ATOMIC);
477	set_1284_register(pp, 6, s->u.pc.ecr, GFP_ATOMIC);
478	get_1284_register(pp, 2, NULL, GFP_ATOMIC);
479	priv->reg[1] = s->u.pc.ctr;
480	priv->reg[2] = s->u.pc.ecr;
481}
482
483static size_t parport_uss720_epp_read_data(struct parport *pp, void *buf, size_t length, int flags)
484{
485	struct parport_uss720_private *priv = pp->private_data;	
486	size_t got = 0;
487
488	if (change_mode(pp, ECR_EPP))
489		return 0;
490	for (; got < length; got++) {
491		if (get_1284_register(pp, 4, (char *)buf, GFP_KERNEL))
492			break;
493		buf++;
494		if (priv->reg[0] & 0x01) {
495			clear_epp_timeout(pp);
496			break;
497		}
498	}
499	change_mode(pp, ECR_PS2);
500	return got;
501}
502
503static size_t parport_uss720_epp_write_data(struct parport *pp, const void *buf, size_t length, int flags)
504{
505#if 0
506	struct parport_uss720_private *priv = pp->private_data;	
507	size_t written = 0;
508
509	if (change_mode(pp, ECR_EPP))
510		return 0;
511	for (; written < length; written++) {
512		if (set_1284_register(pp, 4, (char *)buf, GFP_KERNEL))
513			break;
514		((char*)buf)++;
515		if (get_1284_register(pp, 1, NULL, GFP_KERNEL))
516			break;
517		if (priv->reg[0] & 0x01) {
518			clear_epp_timeout(pp);
519			break;
520		}
521	}
522	change_mode(pp, ECR_PS2);
523	return written;
524#else
525	struct parport_uss720_private *priv = pp->private_data;
526	struct usb_device *usbdev = priv->usbdev;
527	int rlen;
528	int i;
529
530	if (!usbdev)
531		return 0;
532	if (change_mode(pp, ECR_EPP))
533		return 0;
534	i = usb_bulk_msg(usbdev, usb_sndbulkpipe(usbdev, 1), (void *)buf, length, &rlen, 20000);
535	if (i)
536		printk(KERN_ERR "uss720: sendbulk ep 1 buf %p len %Zu rlen %u\n", buf, length, rlen);
537	change_mode(pp, ECR_PS2);
538	return rlen;
539#endif
540}
541
542static size_t parport_uss720_epp_read_addr(struct parport *pp, void *buf, size_t length, int flags)
543{
544	struct parport_uss720_private *priv = pp->private_data;	
545	size_t got = 0;
546
547	if (change_mode(pp, ECR_EPP))
548		return 0;
549	for (; got < length; got++) {
550		if (get_1284_register(pp, 3, (char *)buf, GFP_KERNEL))
551			break;
552		buf++;
553		if (priv->reg[0] & 0x01) {
554			clear_epp_timeout(pp);
555			break;
556		}
557	}
558	change_mode(pp, ECR_PS2);
559	return got;
560}
561
562static size_t parport_uss720_epp_write_addr(struct parport *pp, const void *buf, size_t length, int flags)
563{
564	struct parport_uss720_private *priv = pp->private_data;	
565	size_t written = 0;
566
567	if (change_mode(pp, ECR_EPP))
568		return 0;
569	for (; written < length; written++) {
570		if (set_1284_register(pp, 3, *(char *)buf, GFP_KERNEL))
571			break;
572		buf++;
573		if (get_1284_register(pp, 1, NULL, GFP_KERNEL))
574			break;
575		if (priv->reg[0] & 0x01) {
576			clear_epp_timeout(pp);
577			break;
578		}
579	}
580	change_mode(pp, ECR_PS2);
581	return written;
582}
583
584static size_t parport_uss720_ecp_write_data(struct parport *pp, const void *buffer, size_t len, int flags)
585{
586	struct parport_uss720_private *priv = pp->private_data;
587	struct usb_device *usbdev = priv->usbdev;
588	int rlen;
589	int i;
590
591	if (!usbdev)
592		return 0;
593	if (change_mode(pp, ECR_ECP))
594		return 0;
595	i = usb_bulk_msg(usbdev, usb_sndbulkpipe(usbdev, 1), (void *)buffer, len, &rlen, 20000);
596	if (i)
597		printk(KERN_ERR "uss720: sendbulk ep 1 buf %p len %Zu rlen %u\n", buffer, len, rlen);
598	change_mode(pp, ECR_PS2);
599	return rlen;
600}
601
602static size_t parport_uss720_ecp_read_data(struct parport *pp, void *buffer, size_t len, int flags)
603{
604	struct parport_uss720_private *priv = pp->private_data;
605	struct usb_device *usbdev = priv->usbdev;
606	int rlen;
607	int i;
608
609	if (!usbdev)
610		return 0;
611	if (change_mode(pp, ECR_ECP))
612		return 0;
613	i = usb_bulk_msg(usbdev, usb_rcvbulkpipe(usbdev, 2), buffer, len, &rlen, 20000);
614	if (i)
615		printk(KERN_ERR "uss720: recvbulk ep 2 buf %p len %Zu rlen %u\n", buffer, len, rlen);
616	change_mode(pp, ECR_PS2);
617	return rlen;
618}
619
620static size_t parport_uss720_ecp_write_addr(struct parport *pp, const void *buffer, size_t len, int flags)
621{
622	size_t written = 0;
623
624	if (change_mode(pp, ECR_ECP))
625		return 0;
626	for (; written < len; written++) {
627		if (set_1284_register(pp, 5, *(char *)buffer, GFP_KERNEL))
628			break;
629		buffer++;
630	}
631	change_mode(pp, ECR_PS2);
632	return written;
633}
634
635static size_t parport_uss720_write_compat(struct parport *pp, const void *buffer, size_t len, int flags)
636{
637	struct parport_uss720_private *priv = pp->private_data;
638	struct usb_device *usbdev = priv->usbdev;
639	int rlen;
640	int i;
641
642	if (!usbdev)
643		return 0;
644	if (change_mode(pp, ECR_PPF))
645		return 0;
646	i = usb_bulk_msg(usbdev, usb_sndbulkpipe(usbdev, 1), (void *)buffer, len, &rlen, 20000);
647	if (i)
648		printk(KERN_ERR "uss720: sendbulk ep 1 buf %p len %Zu rlen %u\n", buffer, len, rlen);
649	change_mode(pp, ECR_PS2);
650	return rlen;
651}
652
653/* --------------------------------------------------------------------- */
654
655static struct parport_operations parport_uss720_ops = 
656{
657	.owner =		THIS_MODULE,
658	.write_data =		parport_uss720_write_data,
659	.read_data =		parport_uss720_read_data,
660
661	.write_control =	parport_uss720_write_control,
662	.read_control =		parport_uss720_read_control,
663	.frob_control =		parport_uss720_frob_control,
664
665	.read_status =		parport_uss720_read_status,
666
667	.enable_irq =		parport_uss720_enable_irq,
668	.disable_irq =		parport_uss720_disable_irq,
669
670	.data_forward =		parport_uss720_data_forward,
671	.data_reverse =		parport_uss720_data_reverse,
672
673	.init_state =		parport_uss720_init_state,
674	.save_state =		parport_uss720_save_state,
675	.restore_state =	parport_uss720_restore_state,
676
677	.epp_write_data =	parport_uss720_epp_write_data,
678	.epp_read_data =	parport_uss720_epp_read_data,
679	.epp_write_addr =	parport_uss720_epp_write_addr,
680	.epp_read_addr =	parport_uss720_epp_read_addr,
681
682	.ecp_write_data =	parport_uss720_ecp_write_data,
683	.ecp_read_data =	parport_uss720_ecp_read_data,
684	.ecp_write_addr =	parport_uss720_ecp_write_addr,
685
686	.compat_write_data =	parport_uss720_write_compat,
687	.nibble_read_data =	parport_ieee1284_read_nibble,
688	.byte_read_data =	parport_ieee1284_read_byte,
689};
690
691/* --------------------------------------------------------------------- */
692
693static int uss720_probe(struct usb_interface *intf,
694			const struct usb_device_id *id)
695{
696	struct usb_device *usbdev = usb_get_dev(interface_to_usbdev(intf));
697	struct usb_host_interface *interface;
698	struct usb_host_endpoint *endpoint;
699	struct parport_uss720_private *priv;
700	struct parport *pp;
701	unsigned char reg;
702	int i;
703
704	dev_dbg(&intf->dev, "probe: vendor id 0x%x, device id 0x%x\n",
705		le16_to_cpu(usbdev->descriptor.idVendor),
706		le16_to_cpu(usbdev->descriptor.idProduct));
707
708	/* our known interfaces have 3 alternate settings */
709	if (intf->num_altsetting != 3) {
710		usb_put_dev(usbdev);
711		return -ENODEV;
712	}
713	i = usb_set_interface(usbdev, intf->altsetting->desc.bInterfaceNumber, 2);
714	dev_dbg(&intf->dev, "set interface result %d\n", i);
715
716	interface = intf->cur_altsetting;
717
 
 
 
 
 
718	/*
719	 * Allocate parport interface 
720	 */
721	if (!(priv = kzalloc(sizeof(struct parport_uss720_private), GFP_KERNEL))) {
 
722		usb_put_dev(usbdev);
723		return -ENOMEM;
724	}
725	priv->pp = NULL;
726	priv->usbdev = usbdev;
727	kref_init(&priv->ref_count);
728	spin_lock_init(&priv->asynclock);
729	INIT_LIST_HEAD(&priv->asynclist);
730	if (!(pp = parport_register_port(0, PARPORT_IRQ_NONE, PARPORT_DMA_NONE, &parport_uss720_ops))) {
 
731		printk(KERN_WARNING "uss720: could not register parport\n");
732		goto probe_abort;
733	}
734
735	priv->pp = pp;
736	pp->private_data = priv;
737	pp->modes = PARPORT_MODE_PCSPP | PARPORT_MODE_TRISTATE | PARPORT_MODE_EPP | PARPORT_MODE_ECP | PARPORT_MODE_COMPAT;
738
739	/* set the USS720 control register to manual mode, no ECP compression, enable all ints */
740	set_1284_register(pp, 7, 0x00, GFP_KERNEL);
741	set_1284_register(pp, 6, 0x30, GFP_KERNEL);  /* PS/2 mode */
742	set_1284_register(pp, 2, 0x0c, GFP_KERNEL);
743	/* debugging */
744	get_1284_register(pp, 0, &reg, GFP_KERNEL);
745	dev_dbg(&intf->dev, "reg: %02x %02x %02x %02x %02x %02x %02x\n",
746		priv->reg[0], priv->reg[1], priv->reg[2], priv->reg[3],
747		priv->reg[4], priv->reg[5], priv->reg[6]);
748
749	endpoint = &interface->endpoint[2];
750	dev_dbg(&intf->dev, "epaddr %d interval %d\n",
751		endpoint->desc.bEndpointAddress, endpoint->desc.bInterval);
752	parport_announce_port(pp);
753
754	usb_set_intfdata(intf, pp);
755	return 0;
756
757probe_abort:
758	kill_all_async_requests_priv(priv);
759	kref_put(&priv->ref_count, destroy_priv);
760	return -ENODEV;
761}
762
763static void uss720_disconnect(struct usb_interface *intf)
764{
765	struct parport *pp = usb_get_intfdata(intf);
766	struct parport_uss720_private *priv;
767	struct usb_device *usbdev;
768
769	dev_dbg(&intf->dev, "disconnect\n");
770	usb_set_intfdata(intf, NULL);
771	if (pp) {
772		priv = pp->private_data;
773		usbdev = priv->usbdev;
774		priv->usbdev = NULL;
775		priv->pp = NULL;
776		dev_dbg(&intf->dev, "parport_remove_port\n");
777		parport_remove_port(pp);
778		parport_put_port(pp);
779		kill_all_async_requests_priv(priv);
780		kref_put(&priv->ref_count, destroy_priv);
781	}
782	dev_dbg(&intf->dev, "disconnect done\n");
783}
784
785/* table of cables that work through this driver */
786static const struct usb_device_id uss720_table[] = {
787	{ USB_DEVICE(0x047e, 0x1001) },
 
 
 
 
788	{ USB_DEVICE(0x0557, 0x2001) },
 
 
789	{ USB_DEVICE(0x0729, 0x1284) },
790	{ USB_DEVICE(0x1293, 0x0002) },
791	{ USB_DEVICE(0x050d, 0x0002) },
792	{ }						/* Terminating entry */
793};
794
795MODULE_DEVICE_TABLE (usb, uss720_table);
796
797
798static struct usb_driver uss720_driver = {
799	.name =		"uss720",
800	.probe =	uss720_probe,
801	.disconnect =	uss720_disconnect,
802	.id_table =	uss720_table,
803};
804
805/* --------------------------------------------------------------------- */
806
807MODULE_AUTHOR(DRIVER_AUTHOR);
808MODULE_DESCRIPTION(DRIVER_DESC);
809MODULE_LICENSE("GPL");
810
811static int __init uss720_init(void)
812{
813	int retval;
814	retval = usb_register(&uss720_driver);
815	if (retval)
816		goto out;
817
818	printk(KERN_INFO KBUILD_MODNAME ": " DRIVER_VERSION ":"
819	       DRIVER_DESC "\n");
820	printk(KERN_INFO KBUILD_MODNAME ": NOTE: this is a special purpose "
821	       "driver to allow nonstandard\n");
822	printk(KERN_INFO KBUILD_MODNAME ": protocols (eg. bitbang) over "
823	       "USS720 usb to parallel cables\n");
824	printk(KERN_INFO KBUILD_MODNAME ": If you just want to connect to a "
825	       "printer, use usblp instead\n");
826out:
827	return retval;
828}
829
830static void __exit uss720_cleanup(void)
831{
832	usb_deregister(&uss720_driver);
833}
834
835module_init(uss720_init);
836module_exit(uss720_cleanup);
837
838/* --------------------------------------------------------------------- */