xref: /OK3568_Linux_fs/kernel/drivers/char/lp.c (revision 4882a59341e53eb6f0b4789bf948001014eff981)
1*4882a593Smuzhiyun // SPDX-License-Identifier: GPL-2.0-only
2*4882a593Smuzhiyun /*
3*4882a593Smuzhiyun  * Generic parallel printer driver
4*4882a593Smuzhiyun  *
5*4882a593Smuzhiyun  * Copyright (C) 1992 by Jim Weigand and Linus Torvalds
6*4882a593Smuzhiyun  * Copyright (C) 1992,1993 by Michael K. Johnson
7*4882a593Smuzhiyun  * - Thanks much to Gunter Windau for pointing out to me where the error
8*4882a593Smuzhiyun  *   checking ought to be.
9*4882a593Smuzhiyun  * Copyright (C) 1993 by Nigel Gamble (added interrupt code)
10*4882a593Smuzhiyun  * Copyright (C) 1994 by Alan Cox (Modularised it)
11*4882a593Smuzhiyun  * LPCAREFUL, LPABORT, LPGETSTATUS added by Chris Metcalf, metcalf@lcs.mit.edu
12*4882a593Smuzhiyun  * Statistics and support for slow printers by Rob Janssen, rob@knoware.nl
13*4882a593Smuzhiyun  * "lp=" command line parameters added by Grant Guenther, grant@torque.net
14*4882a593Smuzhiyun  * lp_read (Status readback) support added by Carsten Gross,
15*4882a593Smuzhiyun  *                                             carsten@sol.wohnheim.uni-ulm.de
16*4882a593Smuzhiyun  * Support for parport by Philip Blundell <philb@gnu.org>
17*4882a593Smuzhiyun  * Parport sharing hacking by Andrea Arcangeli
18*4882a593Smuzhiyun  * Fixed kernel_(to/from)_user memory copy to check for errors
19*4882a593Smuzhiyun  * 				by Riccardo Facchetti <fizban@tin.it>
20*4882a593Smuzhiyun  * 22-JAN-1998  Added support for devfs  Richard Gooch <rgooch@atnf.csiro.au>
21*4882a593Smuzhiyun  * Redesigned interrupt handling for handle printers with buggy handshake
22*4882a593Smuzhiyun  *				by Andrea Arcangeli, 11 May 1998
23*4882a593Smuzhiyun  * Full efficient handling of printer with buggy irq handshake (now I have
24*4882a593Smuzhiyun  * understood the meaning of the strange handshake). This is done sending new
25*4882a593Smuzhiyun  * characters if the interrupt is just happened, even if the printer say to
26*4882a593Smuzhiyun  * be still BUSY. This is needed at least with Epson Stylus Color. To enable
27*4882a593Smuzhiyun  * the new TRUST_IRQ mode read the `LP OPTIMIZATION' section below...
28*4882a593Smuzhiyun  * Fixed the irq on the rising edge of the strobe case.
29*4882a593Smuzhiyun  * Obsoleted the CAREFUL flag since a printer that doesn' t work with
30*4882a593Smuzhiyun  * CAREFUL will block a bit after in lp_check_status().
31*4882a593Smuzhiyun  *				Andrea Arcangeli, 15 Oct 1998
32*4882a593Smuzhiyun  * Obsoleted and removed all the lowlevel stuff implemented in the last
33*4882a593Smuzhiyun  * month to use the IEEE1284 functions (that handle the _new_ compatibilty
34*4882a593Smuzhiyun  * mode fine).
35*4882a593Smuzhiyun  */
36*4882a593Smuzhiyun 
37*4882a593Smuzhiyun /* This driver should, in theory, work with any parallel port that has an
38*4882a593Smuzhiyun  * appropriate low-level driver; all I/O is done through the parport
39*4882a593Smuzhiyun  * abstraction layer.
40*4882a593Smuzhiyun  *
41*4882a593Smuzhiyun  * If this driver is built into the kernel, you can configure it using the
42*4882a593Smuzhiyun  * kernel command-line.  For example:
43*4882a593Smuzhiyun  *
44*4882a593Smuzhiyun  *	lp=parport1,none,parport2	(bind lp0 to parport1, disable lp1 and
45*4882a593Smuzhiyun  *					 bind lp2 to parport2)
46*4882a593Smuzhiyun  *
47*4882a593Smuzhiyun  *	lp=auto				(assign lp devices to all ports that
48*4882a593Smuzhiyun  *				         have printers attached, as determined
49*4882a593Smuzhiyun  *					 by the IEEE-1284 autoprobe)
50*4882a593Smuzhiyun  *
51*4882a593Smuzhiyun  *	lp=reset			(reset the printer during
52*4882a593Smuzhiyun  *					 initialisation)
53*4882a593Smuzhiyun  *
54*4882a593Smuzhiyun  *	lp=off				(disable the printer driver entirely)
55*4882a593Smuzhiyun  *
56*4882a593Smuzhiyun  * If the driver is loaded as a module, similar functionality is available
57*4882a593Smuzhiyun  * using module parameters.  The equivalent of the above commands would be:
58*4882a593Smuzhiyun  *
59*4882a593Smuzhiyun  *	# insmod lp.o parport=1,none,2
60*4882a593Smuzhiyun  *
61*4882a593Smuzhiyun  *	# insmod lp.o parport=auto
62*4882a593Smuzhiyun  *
63*4882a593Smuzhiyun  *	# insmod lp.o reset=1
64*4882a593Smuzhiyun  */
65*4882a593Smuzhiyun 
66*4882a593Smuzhiyun /* COMPATIBILITY WITH OLD KERNELS
67*4882a593Smuzhiyun  *
68*4882a593Smuzhiyun  * Under Linux 2.0 and previous versions, lp devices were bound to ports at
69*4882a593Smuzhiyun  * particular I/O addresses, as follows:
70*4882a593Smuzhiyun  *
71*4882a593Smuzhiyun  *	lp0		0x3bc
72*4882a593Smuzhiyun  *	lp1		0x378
73*4882a593Smuzhiyun  *	lp2		0x278
74*4882a593Smuzhiyun  *
75*4882a593Smuzhiyun  * The new driver, by default, binds lp devices to parport devices as it
76*4882a593Smuzhiyun  * finds them.  This means that if you only have one port, it will be bound
77*4882a593Smuzhiyun  * to lp0 regardless of its I/O address.  If you need the old behaviour, you
78*4882a593Smuzhiyun  * can force it using the parameters described above.
79*4882a593Smuzhiyun  */
80*4882a593Smuzhiyun 
81*4882a593Smuzhiyun /*
82*4882a593Smuzhiyun  * The new interrupt handling code take care of the buggy handshake
83*4882a593Smuzhiyun  * of some HP and Epson printer:
84*4882a593Smuzhiyun  * ___
85*4882a593Smuzhiyun  * ACK    _______________    ___________
86*4882a593Smuzhiyun  *                       |__|
87*4882a593Smuzhiyun  * ____
88*4882a593Smuzhiyun  * BUSY   _________              _______
89*4882a593Smuzhiyun  *                 |____________|
90*4882a593Smuzhiyun  *
91*4882a593Smuzhiyun  * I discovered this using the printer scanner that you can find at:
92*4882a593Smuzhiyun  *
93*4882a593Smuzhiyun  *	ftp://e-mind.com/pub/linux/pscan/
94*4882a593Smuzhiyun  *
95*4882a593Smuzhiyun  *					11 May 98, Andrea Arcangeli
96*4882a593Smuzhiyun  *
97*4882a593Smuzhiyun  * My printer scanner run on an Epson Stylus Color show that such printer
98*4882a593Smuzhiyun  * generates the irq on the _rising_ edge of the STROBE. Now lp handle
99*4882a593Smuzhiyun  * this case fine too.
100*4882a593Smuzhiyun  *
101*4882a593Smuzhiyun  *					15 Oct 1998, Andrea Arcangeli
102*4882a593Smuzhiyun  *
103*4882a593Smuzhiyun  * The so called `buggy' handshake is really the well documented
104*4882a593Smuzhiyun  * compatibility mode IEEE1284 handshake. They changed the well known
105*4882a593Smuzhiyun  * Centronics handshake acking in the middle of busy expecting to not
106*4882a593Smuzhiyun  * break drivers or legacy application, while they broken linux lp
107*4882a593Smuzhiyun  * until I fixed it reverse engineering the protocol by hand some
108*4882a593Smuzhiyun  * month ago...
109*4882a593Smuzhiyun  *
110*4882a593Smuzhiyun  *                                     14 Dec 1998, Andrea Arcangeli
111*4882a593Smuzhiyun  *
112*4882a593Smuzhiyun  * Copyright (C) 2000 by Tim Waugh (added LPSETTIMEOUT ioctl)
113*4882a593Smuzhiyun  */
114*4882a593Smuzhiyun 
115*4882a593Smuzhiyun #include <linux/module.h>
116*4882a593Smuzhiyun #include <linux/init.h>
117*4882a593Smuzhiyun 
118*4882a593Smuzhiyun #include <linux/errno.h>
119*4882a593Smuzhiyun #include <linux/kernel.h>
120*4882a593Smuzhiyun #include <linux/major.h>
121*4882a593Smuzhiyun #include <linux/sched/signal.h>
122*4882a593Smuzhiyun #include <linux/slab.h>
123*4882a593Smuzhiyun #include <linux/fcntl.h>
124*4882a593Smuzhiyun #include <linux/delay.h>
125*4882a593Smuzhiyun #include <linux/poll.h>
126*4882a593Smuzhiyun #include <linux/console.h>
127*4882a593Smuzhiyun #include <linux/device.h>
128*4882a593Smuzhiyun #include <linux/wait.h>
129*4882a593Smuzhiyun #include <linux/jiffies.h>
130*4882a593Smuzhiyun #include <linux/mutex.h>
131*4882a593Smuzhiyun #include <linux/compat.h>
132*4882a593Smuzhiyun 
133*4882a593Smuzhiyun #include <linux/parport.h>
134*4882a593Smuzhiyun #undef LP_STATS
135*4882a593Smuzhiyun #include <linux/lp.h>
136*4882a593Smuzhiyun 
137*4882a593Smuzhiyun #include <asm/irq.h>
138*4882a593Smuzhiyun #include <linux/uaccess.h>
139*4882a593Smuzhiyun 
140*4882a593Smuzhiyun /* if you have more than 8 printers, remember to increase LP_NO */
141*4882a593Smuzhiyun #define LP_NO 8
142*4882a593Smuzhiyun 
143*4882a593Smuzhiyun static DEFINE_MUTEX(lp_mutex);
144*4882a593Smuzhiyun static struct lp_struct lp_table[LP_NO];
145*4882a593Smuzhiyun static int port_num[LP_NO];
146*4882a593Smuzhiyun 
147*4882a593Smuzhiyun static unsigned int lp_count = 0;
148*4882a593Smuzhiyun static struct class *lp_class;
149*4882a593Smuzhiyun 
150*4882a593Smuzhiyun #ifdef CONFIG_LP_CONSOLE
151*4882a593Smuzhiyun static struct parport *console_registered;
152*4882a593Smuzhiyun #endif /* CONFIG_LP_CONSOLE */
153*4882a593Smuzhiyun 
154*4882a593Smuzhiyun #undef LP_DEBUG
155*4882a593Smuzhiyun 
156*4882a593Smuzhiyun /* Bits used to manage claiming the parport device */
157*4882a593Smuzhiyun #define LP_PREEMPT_REQUEST 1
158*4882a593Smuzhiyun #define LP_PARPORT_CLAIMED 2
159*4882a593Smuzhiyun 
160*4882a593Smuzhiyun /* --- low-level port access ----------------------------------- */
161*4882a593Smuzhiyun 
162*4882a593Smuzhiyun #define r_dtr(x)	(parport_read_data(lp_table[(x)].dev->port))
163*4882a593Smuzhiyun #define r_str(x)	(parport_read_status(lp_table[(x)].dev->port))
164*4882a593Smuzhiyun #define w_ctr(x,y)	do { parport_write_control(lp_table[(x)].dev->port, (y)); } while (0)
165*4882a593Smuzhiyun #define w_dtr(x,y)	do { parport_write_data(lp_table[(x)].dev->port, (y)); } while (0)
166*4882a593Smuzhiyun 
167*4882a593Smuzhiyun /* Claim the parport or block trying unless we've already claimed it */
lp_claim_parport_or_block(struct lp_struct * this_lp)168*4882a593Smuzhiyun static void lp_claim_parport_or_block(struct lp_struct *this_lp)
169*4882a593Smuzhiyun {
170*4882a593Smuzhiyun 	if (!test_and_set_bit(LP_PARPORT_CLAIMED, &this_lp->bits)) {
171*4882a593Smuzhiyun 		parport_claim_or_block(this_lp->dev);
172*4882a593Smuzhiyun 	}
173*4882a593Smuzhiyun }
174*4882a593Smuzhiyun 
175*4882a593Smuzhiyun /* Claim the parport or block trying unless we've already claimed it */
lp_release_parport(struct lp_struct * this_lp)176*4882a593Smuzhiyun static void lp_release_parport(struct lp_struct *this_lp)
177*4882a593Smuzhiyun {
178*4882a593Smuzhiyun 	if (test_and_clear_bit(LP_PARPORT_CLAIMED, &this_lp->bits)) {
179*4882a593Smuzhiyun 		parport_release(this_lp->dev);
180*4882a593Smuzhiyun 	}
181*4882a593Smuzhiyun }
182*4882a593Smuzhiyun 
183*4882a593Smuzhiyun 
184*4882a593Smuzhiyun 
lp_preempt(void * handle)185*4882a593Smuzhiyun static int lp_preempt(void *handle)
186*4882a593Smuzhiyun {
187*4882a593Smuzhiyun 	struct lp_struct *this_lp = (struct lp_struct *)handle;
188*4882a593Smuzhiyun 	set_bit(LP_PREEMPT_REQUEST, &this_lp->bits);
189*4882a593Smuzhiyun 	return 1;
190*4882a593Smuzhiyun }
191*4882a593Smuzhiyun 
192*4882a593Smuzhiyun 
193*4882a593Smuzhiyun /*
194*4882a593Smuzhiyun  * Try to negotiate to a new mode; if unsuccessful negotiate to
195*4882a593Smuzhiyun  * compatibility mode.  Return the mode we ended up in.
196*4882a593Smuzhiyun  */
lp_negotiate(struct parport * port,int mode)197*4882a593Smuzhiyun static int lp_negotiate(struct parport *port, int mode)
198*4882a593Smuzhiyun {
199*4882a593Smuzhiyun 	if (parport_negotiate(port, mode) != 0) {
200*4882a593Smuzhiyun 		mode = IEEE1284_MODE_COMPAT;
201*4882a593Smuzhiyun 		parport_negotiate(port, mode);
202*4882a593Smuzhiyun 	}
203*4882a593Smuzhiyun 
204*4882a593Smuzhiyun 	return mode;
205*4882a593Smuzhiyun }
206*4882a593Smuzhiyun 
lp_reset(int minor)207*4882a593Smuzhiyun static int lp_reset(int minor)
208*4882a593Smuzhiyun {
209*4882a593Smuzhiyun 	int retval;
210*4882a593Smuzhiyun 	lp_claim_parport_or_block(&lp_table[minor]);
211*4882a593Smuzhiyun 	w_ctr(minor, LP_PSELECP);
212*4882a593Smuzhiyun 	udelay(LP_DELAY);
213*4882a593Smuzhiyun 	w_ctr(minor, LP_PSELECP | LP_PINITP);
214*4882a593Smuzhiyun 	retval = r_str(minor);
215*4882a593Smuzhiyun 	lp_release_parport(&lp_table[minor]);
216*4882a593Smuzhiyun 	return retval;
217*4882a593Smuzhiyun }
218*4882a593Smuzhiyun 
lp_error(int minor)219*4882a593Smuzhiyun static void lp_error(int minor)
220*4882a593Smuzhiyun {
221*4882a593Smuzhiyun 	DEFINE_WAIT(wait);
222*4882a593Smuzhiyun 	int polling;
223*4882a593Smuzhiyun 
224*4882a593Smuzhiyun 	if (LP_F(minor) & LP_ABORT)
225*4882a593Smuzhiyun 		return;
226*4882a593Smuzhiyun 
227*4882a593Smuzhiyun 	polling = lp_table[minor].dev->port->irq == PARPORT_IRQ_NONE;
228*4882a593Smuzhiyun 	if (polling)
229*4882a593Smuzhiyun 		lp_release_parport(&lp_table[minor]);
230*4882a593Smuzhiyun 	prepare_to_wait(&lp_table[minor].waitq, &wait, TASK_INTERRUPTIBLE);
231*4882a593Smuzhiyun 	schedule_timeout(LP_TIMEOUT_POLLED);
232*4882a593Smuzhiyun 	finish_wait(&lp_table[minor].waitq, &wait);
233*4882a593Smuzhiyun 	if (polling)
234*4882a593Smuzhiyun 		lp_claim_parport_or_block(&lp_table[minor]);
235*4882a593Smuzhiyun 	else
236*4882a593Smuzhiyun 		parport_yield_blocking(lp_table[minor].dev);
237*4882a593Smuzhiyun }
238*4882a593Smuzhiyun 
lp_check_status(int minor)239*4882a593Smuzhiyun static int lp_check_status(int minor)
240*4882a593Smuzhiyun {
241*4882a593Smuzhiyun 	int error = 0;
242*4882a593Smuzhiyun 	unsigned int last = lp_table[minor].last_error;
243*4882a593Smuzhiyun 	unsigned char status = r_str(minor);
244*4882a593Smuzhiyun 	if ((status & LP_PERRORP) && !(LP_F(minor) & LP_CAREFUL))
245*4882a593Smuzhiyun 		/* No error. */
246*4882a593Smuzhiyun 		last = 0;
247*4882a593Smuzhiyun 	else if ((status & LP_POUTPA)) {
248*4882a593Smuzhiyun 		if (last != LP_POUTPA) {
249*4882a593Smuzhiyun 			last = LP_POUTPA;
250*4882a593Smuzhiyun 			printk(KERN_INFO "lp%d out of paper\n", minor);
251*4882a593Smuzhiyun 		}
252*4882a593Smuzhiyun 		error = -ENOSPC;
253*4882a593Smuzhiyun 	} else if (!(status & LP_PSELECD)) {
254*4882a593Smuzhiyun 		if (last != LP_PSELECD) {
255*4882a593Smuzhiyun 			last = LP_PSELECD;
256*4882a593Smuzhiyun 			printk(KERN_INFO "lp%d off-line\n", minor);
257*4882a593Smuzhiyun 		}
258*4882a593Smuzhiyun 		error = -EIO;
259*4882a593Smuzhiyun 	} else if (!(status & LP_PERRORP)) {
260*4882a593Smuzhiyun 		if (last != LP_PERRORP) {
261*4882a593Smuzhiyun 			last = LP_PERRORP;
262*4882a593Smuzhiyun 			printk(KERN_INFO "lp%d on fire\n", minor);
263*4882a593Smuzhiyun 		}
264*4882a593Smuzhiyun 		error = -EIO;
265*4882a593Smuzhiyun 	} else {
266*4882a593Smuzhiyun 		last = 0; /* Come here if LP_CAREFUL is set and no
267*4882a593Smuzhiyun 			     errors are reported. */
268*4882a593Smuzhiyun 	}
269*4882a593Smuzhiyun 
270*4882a593Smuzhiyun 	lp_table[minor].last_error = last;
271*4882a593Smuzhiyun 
272*4882a593Smuzhiyun 	if (last != 0)
273*4882a593Smuzhiyun 		lp_error(minor);
274*4882a593Smuzhiyun 
275*4882a593Smuzhiyun 	return error;
276*4882a593Smuzhiyun }
277*4882a593Smuzhiyun 
lp_wait_ready(int minor,int nonblock)278*4882a593Smuzhiyun static int lp_wait_ready(int minor, int nonblock)
279*4882a593Smuzhiyun {
280*4882a593Smuzhiyun 	int error = 0;
281*4882a593Smuzhiyun 
282*4882a593Smuzhiyun 	/* If we're not in compatibility mode, we're ready now! */
283*4882a593Smuzhiyun 	if (lp_table[minor].current_mode != IEEE1284_MODE_COMPAT) {
284*4882a593Smuzhiyun 		return 0;
285*4882a593Smuzhiyun 	}
286*4882a593Smuzhiyun 
287*4882a593Smuzhiyun 	do {
288*4882a593Smuzhiyun 		error = lp_check_status(minor);
289*4882a593Smuzhiyun 		if (error && (nonblock || (LP_F(minor) & LP_ABORT)))
290*4882a593Smuzhiyun 			break;
291*4882a593Smuzhiyun 		if (signal_pending(current)) {
292*4882a593Smuzhiyun 			error = -EINTR;
293*4882a593Smuzhiyun 			break;
294*4882a593Smuzhiyun 		}
295*4882a593Smuzhiyun 	} while (error);
296*4882a593Smuzhiyun 	return error;
297*4882a593Smuzhiyun }
298*4882a593Smuzhiyun 
lp_write(struct file * file,const char __user * buf,size_t count,loff_t * ppos)299*4882a593Smuzhiyun static ssize_t lp_write(struct file *file, const char __user *buf,
300*4882a593Smuzhiyun 			size_t count, loff_t *ppos)
301*4882a593Smuzhiyun {
302*4882a593Smuzhiyun 	unsigned int minor = iminor(file_inode(file));
303*4882a593Smuzhiyun 	struct parport *port = lp_table[minor].dev->port;
304*4882a593Smuzhiyun 	char *kbuf = lp_table[minor].lp_buffer;
305*4882a593Smuzhiyun 	ssize_t retv = 0;
306*4882a593Smuzhiyun 	ssize_t written;
307*4882a593Smuzhiyun 	size_t copy_size = count;
308*4882a593Smuzhiyun 	int nonblock = ((file->f_flags & O_NONBLOCK) ||
309*4882a593Smuzhiyun 			(LP_F(minor) & LP_ABORT));
310*4882a593Smuzhiyun 
311*4882a593Smuzhiyun #ifdef LP_STATS
312*4882a593Smuzhiyun 	if (time_after(jiffies, lp_table[minor].lastcall + LP_TIME(minor)))
313*4882a593Smuzhiyun 		lp_table[minor].runchars = 0;
314*4882a593Smuzhiyun 
315*4882a593Smuzhiyun 	lp_table[minor].lastcall = jiffies;
316*4882a593Smuzhiyun #endif
317*4882a593Smuzhiyun 
318*4882a593Smuzhiyun 	/* Need to copy the data from user-space. */
319*4882a593Smuzhiyun 	if (copy_size > LP_BUFFER_SIZE)
320*4882a593Smuzhiyun 		copy_size = LP_BUFFER_SIZE;
321*4882a593Smuzhiyun 
322*4882a593Smuzhiyun 	if (mutex_lock_interruptible(&lp_table[minor].port_mutex))
323*4882a593Smuzhiyun 		return -EINTR;
324*4882a593Smuzhiyun 
325*4882a593Smuzhiyun 	if (copy_from_user(kbuf, buf, copy_size)) {
326*4882a593Smuzhiyun 		retv = -EFAULT;
327*4882a593Smuzhiyun 		goto out_unlock;
328*4882a593Smuzhiyun 	}
329*4882a593Smuzhiyun 
330*4882a593Smuzhiyun 	/* Claim Parport or sleep until it becomes available
331*4882a593Smuzhiyun 	 */
332*4882a593Smuzhiyun 	lp_claim_parport_or_block(&lp_table[minor]);
333*4882a593Smuzhiyun 	/* Go to the proper mode. */
334*4882a593Smuzhiyun 	lp_table[minor].current_mode = lp_negotiate(port,
335*4882a593Smuzhiyun 						    lp_table[minor].best_mode);
336*4882a593Smuzhiyun 
337*4882a593Smuzhiyun 	parport_set_timeout(lp_table[minor].dev,
338*4882a593Smuzhiyun 			    (nonblock ? PARPORT_INACTIVITY_O_NONBLOCK
339*4882a593Smuzhiyun 			     : lp_table[minor].timeout));
340*4882a593Smuzhiyun 
341*4882a593Smuzhiyun 	if ((retv = lp_wait_ready(minor, nonblock)) == 0)
342*4882a593Smuzhiyun 	do {
343*4882a593Smuzhiyun 		/* Write the data. */
344*4882a593Smuzhiyun 		written = parport_write(port, kbuf, copy_size);
345*4882a593Smuzhiyun 		if (written > 0) {
346*4882a593Smuzhiyun 			copy_size -= written;
347*4882a593Smuzhiyun 			count -= written;
348*4882a593Smuzhiyun 			buf  += written;
349*4882a593Smuzhiyun 			retv += written;
350*4882a593Smuzhiyun 		}
351*4882a593Smuzhiyun 
352*4882a593Smuzhiyun 		if (signal_pending(current)) {
353*4882a593Smuzhiyun 			if (retv == 0)
354*4882a593Smuzhiyun 				retv = -EINTR;
355*4882a593Smuzhiyun 
356*4882a593Smuzhiyun 			break;
357*4882a593Smuzhiyun 		}
358*4882a593Smuzhiyun 
359*4882a593Smuzhiyun 		if (copy_size > 0) {
360*4882a593Smuzhiyun 			/* incomplete write -> check error ! */
361*4882a593Smuzhiyun 			int error;
362*4882a593Smuzhiyun 
363*4882a593Smuzhiyun 			parport_negotiate(lp_table[minor].dev->port,
364*4882a593Smuzhiyun 					  IEEE1284_MODE_COMPAT);
365*4882a593Smuzhiyun 			lp_table[minor].current_mode = IEEE1284_MODE_COMPAT;
366*4882a593Smuzhiyun 
367*4882a593Smuzhiyun 			error = lp_wait_ready(minor, nonblock);
368*4882a593Smuzhiyun 
369*4882a593Smuzhiyun 			if (error) {
370*4882a593Smuzhiyun 				if (retv == 0)
371*4882a593Smuzhiyun 					retv = error;
372*4882a593Smuzhiyun 				break;
373*4882a593Smuzhiyun 			} else if (nonblock) {
374*4882a593Smuzhiyun 				if (retv == 0)
375*4882a593Smuzhiyun 					retv = -EAGAIN;
376*4882a593Smuzhiyun 				break;
377*4882a593Smuzhiyun 			}
378*4882a593Smuzhiyun 
379*4882a593Smuzhiyun 			parport_yield_blocking(lp_table[minor].dev);
380*4882a593Smuzhiyun 			lp_table[minor].current_mode
381*4882a593Smuzhiyun 			  = lp_negotiate(port,
382*4882a593Smuzhiyun 					 lp_table[minor].best_mode);
383*4882a593Smuzhiyun 
384*4882a593Smuzhiyun 		} else if (need_resched())
385*4882a593Smuzhiyun 			schedule();
386*4882a593Smuzhiyun 
387*4882a593Smuzhiyun 		if (count) {
388*4882a593Smuzhiyun 			copy_size = count;
389*4882a593Smuzhiyun 			if (copy_size > LP_BUFFER_SIZE)
390*4882a593Smuzhiyun 				copy_size = LP_BUFFER_SIZE;
391*4882a593Smuzhiyun 
392*4882a593Smuzhiyun 			if (copy_from_user(kbuf, buf, copy_size)) {
393*4882a593Smuzhiyun 				if (retv == 0)
394*4882a593Smuzhiyun 					retv = -EFAULT;
395*4882a593Smuzhiyun 				break;
396*4882a593Smuzhiyun 			}
397*4882a593Smuzhiyun 		}
398*4882a593Smuzhiyun 	} while (count > 0);
399*4882a593Smuzhiyun 
400*4882a593Smuzhiyun 	if (test_and_clear_bit(LP_PREEMPT_REQUEST,
401*4882a593Smuzhiyun 			       &lp_table[minor].bits)) {
402*4882a593Smuzhiyun 		printk(KERN_INFO "lp%d releasing parport\n", minor);
403*4882a593Smuzhiyun 		parport_negotiate(lp_table[minor].dev->port,
404*4882a593Smuzhiyun 				  IEEE1284_MODE_COMPAT);
405*4882a593Smuzhiyun 		lp_table[minor].current_mode = IEEE1284_MODE_COMPAT;
406*4882a593Smuzhiyun 		lp_release_parport(&lp_table[minor]);
407*4882a593Smuzhiyun 	}
408*4882a593Smuzhiyun out_unlock:
409*4882a593Smuzhiyun 	mutex_unlock(&lp_table[minor].port_mutex);
410*4882a593Smuzhiyun 
411*4882a593Smuzhiyun 	return retv;
412*4882a593Smuzhiyun }
413*4882a593Smuzhiyun 
414*4882a593Smuzhiyun #ifdef CONFIG_PARPORT_1284
415*4882a593Smuzhiyun 
416*4882a593Smuzhiyun /* Status readback conforming to ieee1284 */
lp_read(struct file * file,char __user * buf,size_t count,loff_t * ppos)417*4882a593Smuzhiyun static ssize_t lp_read(struct file *file, char __user *buf,
418*4882a593Smuzhiyun 		       size_t count, loff_t *ppos)
419*4882a593Smuzhiyun {
420*4882a593Smuzhiyun 	DEFINE_WAIT(wait);
421*4882a593Smuzhiyun 	unsigned int minor=iminor(file_inode(file));
422*4882a593Smuzhiyun 	struct parport *port = lp_table[minor].dev->port;
423*4882a593Smuzhiyun 	ssize_t retval = 0;
424*4882a593Smuzhiyun 	char *kbuf = lp_table[minor].lp_buffer;
425*4882a593Smuzhiyun 	int nonblock = ((file->f_flags & O_NONBLOCK) ||
426*4882a593Smuzhiyun 			(LP_F(minor) & LP_ABORT));
427*4882a593Smuzhiyun 
428*4882a593Smuzhiyun 	if (count > LP_BUFFER_SIZE)
429*4882a593Smuzhiyun 		count = LP_BUFFER_SIZE;
430*4882a593Smuzhiyun 
431*4882a593Smuzhiyun 	if (mutex_lock_interruptible(&lp_table[minor].port_mutex))
432*4882a593Smuzhiyun 		return -EINTR;
433*4882a593Smuzhiyun 
434*4882a593Smuzhiyun 	lp_claim_parport_or_block(&lp_table[minor]);
435*4882a593Smuzhiyun 
436*4882a593Smuzhiyun 	parport_set_timeout(lp_table[minor].dev,
437*4882a593Smuzhiyun 			    (nonblock ? PARPORT_INACTIVITY_O_NONBLOCK
438*4882a593Smuzhiyun 			     : lp_table[minor].timeout));
439*4882a593Smuzhiyun 
440*4882a593Smuzhiyun 	parport_negotiate(lp_table[minor].dev->port, IEEE1284_MODE_COMPAT);
441*4882a593Smuzhiyun 	if (parport_negotiate(lp_table[minor].dev->port,
442*4882a593Smuzhiyun 			      IEEE1284_MODE_NIBBLE)) {
443*4882a593Smuzhiyun 		retval = -EIO;
444*4882a593Smuzhiyun 		goto out;
445*4882a593Smuzhiyun 	}
446*4882a593Smuzhiyun 
447*4882a593Smuzhiyun 	while (retval == 0) {
448*4882a593Smuzhiyun 		retval = parport_read(port, kbuf, count);
449*4882a593Smuzhiyun 
450*4882a593Smuzhiyun 		if (retval > 0)
451*4882a593Smuzhiyun 			break;
452*4882a593Smuzhiyun 
453*4882a593Smuzhiyun 		if (nonblock) {
454*4882a593Smuzhiyun 			retval = -EAGAIN;
455*4882a593Smuzhiyun 			break;
456*4882a593Smuzhiyun 		}
457*4882a593Smuzhiyun 
458*4882a593Smuzhiyun 		/* Wait for data. */
459*4882a593Smuzhiyun 
460*4882a593Smuzhiyun 		if (lp_table[minor].dev->port->irq == PARPORT_IRQ_NONE) {
461*4882a593Smuzhiyun 			parport_negotiate(lp_table[minor].dev->port,
462*4882a593Smuzhiyun 					  IEEE1284_MODE_COMPAT);
463*4882a593Smuzhiyun 			lp_error(minor);
464*4882a593Smuzhiyun 			if (parport_negotiate(lp_table[minor].dev->port,
465*4882a593Smuzhiyun 					      IEEE1284_MODE_NIBBLE)) {
466*4882a593Smuzhiyun 				retval = -EIO;
467*4882a593Smuzhiyun 				goto out;
468*4882a593Smuzhiyun 			}
469*4882a593Smuzhiyun 		} else {
470*4882a593Smuzhiyun 			prepare_to_wait(&lp_table[minor].waitq, &wait, TASK_INTERRUPTIBLE);
471*4882a593Smuzhiyun 			schedule_timeout(LP_TIMEOUT_POLLED);
472*4882a593Smuzhiyun 			finish_wait(&lp_table[minor].waitq, &wait);
473*4882a593Smuzhiyun 		}
474*4882a593Smuzhiyun 
475*4882a593Smuzhiyun 		if (signal_pending(current)) {
476*4882a593Smuzhiyun 			retval = -ERESTARTSYS;
477*4882a593Smuzhiyun 			break;
478*4882a593Smuzhiyun 		}
479*4882a593Smuzhiyun 
480*4882a593Smuzhiyun 		cond_resched();
481*4882a593Smuzhiyun 	}
482*4882a593Smuzhiyun 	parport_negotiate(lp_table[minor].dev->port, IEEE1284_MODE_COMPAT);
483*4882a593Smuzhiyun  out:
484*4882a593Smuzhiyun 	lp_release_parport(&lp_table[minor]);
485*4882a593Smuzhiyun 
486*4882a593Smuzhiyun 	if (retval > 0 && copy_to_user(buf, kbuf, retval))
487*4882a593Smuzhiyun 		retval = -EFAULT;
488*4882a593Smuzhiyun 
489*4882a593Smuzhiyun 	mutex_unlock(&lp_table[minor].port_mutex);
490*4882a593Smuzhiyun 
491*4882a593Smuzhiyun 	return retval;
492*4882a593Smuzhiyun }
493*4882a593Smuzhiyun 
494*4882a593Smuzhiyun #endif /* IEEE 1284 support */
495*4882a593Smuzhiyun 
lp_open(struct inode * inode,struct file * file)496*4882a593Smuzhiyun static int lp_open(struct inode *inode, struct file *file)
497*4882a593Smuzhiyun {
498*4882a593Smuzhiyun 	unsigned int minor = iminor(inode);
499*4882a593Smuzhiyun 	int ret = 0;
500*4882a593Smuzhiyun 
501*4882a593Smuzhiyun 	mutex_lock(&lp_mutex);
502*4882a593Smuzhiyun 	if (minor >= LP_NO) {
503*4882a593Smuzhiyun 		ret = -ENXIO;
504*4882a593Smuzhiyun 		goto out;
505*4882a593Smuzhiyun 	}
506*4882a593Smuzhiyun 	if ((LP_F(minor) & LP_EXIST) == 0) {
507*4882a593Smuzhiyun 		ret = -ENXIO;
508*4882a593Smuzhiyun 		goto out;
509*4882a593Smuzhiyun 	}
510*4882a593Smuzhiyun 	if (test_and_set_bit(LP_BUSY_BIT_POS, &LP_F(minor))) {
511*4882a593Smuzhiyun 		ret = -EBUSY;
512*4882a593Smuzhiyun 		goto out;
513*4882a593Smuzhiyun 	}
514*4882a593Smuzhiyun 	/* If ABORTOPEN is set and the printer is offline or out of paper,
515*4882a593Smuzhiyun 	   we may still want to open it to perform ioctl()s.  Therefore we
516*4882a593Smuzhiyun 	   have commandeered O_NONBLOCK, even though it is being used in
517*4882a593Smuzhiyun 	   a non-standard manner.  This is strictly a Linux hack, and
518*4882a593Smuzhiyun 	   should most likely only ever be used by the tunelp application. */
519*4882a593Smuzhiyun 	if ((LP_F(minor) & LP_ABORTOPEN) && !(file->f_flags & O_NONBLOCK)) {
520*4882a593Smuzhiyun 		int status;
521*4882a593Smuzhiyun 		lp_claim_parport_or_block(&lp_table[minor]);
522*4882a593Smuzhiyun 		status = r_str(minor);
523*4882a593Smuzhiyun 		lp_release_parport(&lp_table[minor]);
524*4882a593Smuzhiyun 		if (status & LP_POUTPA) {
525*4882a593Smuzhiyun 			printk(KERN_INFO "lp%d out of paper\n", minor);
526*4882a593Smuzhiyun 			LP_F(minor) &= ~LP_BUSY;
527*4882a593Smuzhiyun 			ret = -ENOSPC;
528*4882a593Smuzhiyun 			goto out;
529*4882a593Smuzhiyun 		} else if (!(status & LP_PSELECD)) {
530*4882a593Smuzhiyun 			printk(KERN_INFO "lp%d off-line\n", minor);
531*4882a593Smuzhiyun 			LP_F(minor) &= ~LP_BUSY;
532*4882a593Smuzhiyun 			ret = -EIO;
533*4882a593Smuzhiyun 			goto out;
534*4882a593Smuzhiyun 		} else if (!(status & LP_PERRORP)) {
535*4882a593Smuzhiyun 			printk(KERN_ERR "lp%d printer error\n", minor);
536*4882a593Smuzhiyun 			LP_F(minor) &= ~LP_BUSY;
537*4882a593Smuzhiyun 			ret = -EIO;
538*4882a593Smuzhiyun 			goto out;
539*4882a593Smuzhiyun 		}
540*4882a593Smuzhiyun 	}
541*4882a593Smuzhiyun 	lp_table[minor].lp_buffer = kmalloc(LP_BUFFER_SIZE, GFP_KERNEL);
542*4882a593Smuzhiyun 	if (!lp_table[minor].lp_buffer) {
543*4882a593Smuzhiyun 		LP_F(minor) &= ~LP_BUSY;
544*4882a593Smuzhiyun 		ret = -ENOMEM;
545*4882a593Smuzhiyun 		goto out;
546*4882a593Smuzhiyun 	}
547*4882a593Smuzhiyun 	/* Determine if the peripheral supports ECP mode */
548*4882a593Smuzhiyun 	lp_claim_parport_or_block(&lp_table[minor]);
549*4882a593Smuzhiyun 	if ( (lp_table[minor].dev->port->modes & PARPORT_MODE_ECP) &&
550*4882a593Smuzhiyun 	     !parport_negotiate(lp_table[minor].dev->port,
551*4882a593Smuzhiyun 				 IEEE1284_MODE_ECP)) {
552*4882a593Smuzhiyun 		printk(KERN_INFO "lp%d: ECP mode\n", minor);
553*4882a593Smuzhiyun 		lp_table[minor].best_mode = IEEE1284_MODE_ECP;
554*4882a593Smuzhiyun 	} else {
555*4882a593Smuzhiyun 		lp_table[minor].best_mode = IEEE1284_MODE_COMPAT;
556*4882a593Smuzhiyun 	}
557*4882a593Smuzhiyun 	/* Leave peripheral in compatibility mode */
558*4882a593Smuzhiyun 	parport_negotiate(lp_table[minor].dev->port, IEEE1284_MODE_COMPAT);
559*4882a593Smuzhiyun 	lp_release_parport(&lp_table[minor]);
560*4882a593Smuzhiyun 	lp_table[minor].current_mode = IEEE1284_MODE_COMPAT;
561*4882a593Smuzhiyun out:
562*4882a593Smuzhiyun 	mutex_unlock(&lp_mutex);
563*4882a593Smuzhiyun 	return ret;
564*4882a593Smuzhiyun }
565*4882a593Smuzhiyun 
lp_release(struct inode * inode,struct file * file)566*4882a593Smuzhiyun static int lp_release(struct inode *inode, struct file *file)
567*4882a593Smuzhiyun {
568*4882a593Smuzhiyun 	unsigned int minor = iminor(inode);
569*4882a593Smuzhiyun 
570*4882a593Smuzhiyun 	lp_claim_parport_or_block(&lp_table[minor]);
571*4882a593Smuzhiyun 	parport_negotiate(lp_table[minor].dev->port, IEEE1284_MODE_COMPAT);
572*4882a593Smuzhiyun 	lp_table[minor].current_mode = IEEE1284_MODE_COMPAT;
573*4882a593Smuzhiyun 	lp_release_parport(&lp_table[minor]);
574*4882a593Smuzhiyun 	kfree(lp_table[minor].lp_buffer);
575*4882a593Smuzhiyun 	lp_table[minor].lp_buffer = NULL;
576*4882a593Smuzhiyun 	LP_F(minor) &= ~LP_BUSY;
577*4882a593Smuzhiyun 	return 0;
578*4882a593Smuzhiyun }
579*4882a593Smuzhiyun 
lp_do_ioctl(unsigned int minor,unsigned int cmd,unsigned long arg,void __user * argp)580*4882a593Smuzhiyun static int lp_do_ioctl(unsigned int minor, unsigned int cmd,
581*4882a593Smuzhiyun 	unsigned long arg, void __user *argp)
582*4882a593Smuzhiyun {
583*4882a593Smuzhiyun 	int status;
584*4882a593Smuzhiyun 	int retval = 0;
585*4882a593Smuzhiyun 
586*4882a593Smuzhiyun #ifdef LP_DEBUG
587*4882a593Smuzhiyun 	printk(KERN_DEBUG "lp%d ioctl, cmd: 0x%x, arg: 0x%lx\n", minor, cmd, arg);
588*4882a593Smuzhiyun #endif
589*4882a593Smuzhiyun 	if (minor >= LP_NO)
590*4882a593Smuzhiyun 		return -ENODEV;
591*4882a593Smuzhiyun 	if ((LP_F(minor) & LP_EXIST) == 0)
592*4882a593Smuzhiyun 		return -ENODEV;
593*4882a593Smuzhiyun 	switch ( cmd ) {
594*4882a593Smuzhiyun 		case LPTIME:
595*4882a593Smuzhiyun 			if (arg > UINT_MAX / HZ)
596*4882a593Smuzhiyun 				return -EINVAL;
597*4882a593Smuzhiyun 			LP_TIME(minor) = arg * HZ/100;
598*4882a593Smuzhiyun 			break;
599*4882a593Smuzhiyun 		case LPCHAR:
600*4882a593Smuzhiyun 			LP_CHAR(minor) = arg;
601*4882a593Smuzhiyun 			break;
602*4882a593Smuzhiyun 		case LPABORT:
603*4882a593Smuzhiyun 			if (arg)
604*4882a593Smuzhiyun 				LP_F(minor) |= LP_ABORT;
605*4882a593Smuzhiyun 			else
606*4882a593Smuzhiyun 				LP_F(minor) &= ~LP_ABORT;
607*4882a593Smuzhiyun 			break;
608*4882a593Smuzhiyun 		case LPABORTOPEN:
609*4882a593Smuzhiyun 			if (arg)
610*4882a593Smuzhiyun 				LP_F(minor) |= LP_ABORTOPEN;
611*4882a593Smuzhiyun 			else
612*4882a593Smuzhiyun 				LP_F(minor) &= ~LP_ABORTOPEN;
613*4882a593Smuzhiyun 			break;
614*4882a593Smuzhiyun 		case LPCAREFUL:
615*4882a593Smuzhiyun 			if (arg)
616*4882a593Smuzhiyun 				LP_F(minor) |= LP_CAREFUL;
617*4882a593Smuzhiyun 			else
618*4882a593Smuzhiyun 				LP_F(minor) &= ~LP_CAREFUL;
619*4882a593Smuzhiyun 			break;
620*4882a593Smuzhiyun 		case LPWAIT:
621*4882a593Smuzhiyun 			LP_WAIT(minor) = arg;
622*4882a593Smuzhiyun 			break;
623*4882a593Smuzhiyun 		case LPSETIRQ:
624*4882a593Smuzhiyun 			return -EINVAL;
625*4882a593Smuzhiyun 			break;
626*4882a593Smuzhiyun 		case LPGETIRQ:
627*4882a593Smuzhiyun 			if (copy_to_user(argp, &LP_IRQ(minor),
628*4882a593Smuzhiyun 					sizeof(int)))
629*4882a593Smuzhiyun 				return -EFAULT;
630*4882a593Smuzhiyun 			break;
631*4882a593Smuzhiyun 		case LPGETSTATUS:
632*4882a593Smuzhiyun 			if (mutex_lock_interruptible(&lp_table[minor].port_mutex))
633*4882a593Smuzhiyun 				return -EINTR;
634*4882a593Smuzhiyun 			lp_claim_parport_or_block(&lp_table[minor]);
635*4882a593Smuzhiyun 			status = r_str(minor);
636*4882a593Smuzhiyun 			lp_release_parport(&lp_table[minor]);
637*4882a593Smuzhiyun 			mutex_unlock(&lp_table[minor].port_mutex);
638*4882a593Smuzhiyun 
639*4882a593Smuzhiyun 			if (copy_to_user(argp, &status, sizeof(int)))
640*4882a593Smuzhiyun 				return -EFAULT;
641*4882a593Smuzhiyun 			break;
642*4882a593Smuzhiyun 		case LPRESET:
643*4882a593Smuzhiyun 			lp_reset(minor);
644*4882a593Smuzhiyun 			break;
645*4882a593Smuzhiyun #ifdef LP_STATS
646*4882a593Smuzhiyun 		case LPGETSTATS:
647*4882a593Smuzhiyun 			if (copy_to_user(argp, &LP_STAT(minor),
648*4882a593Smuzhiyun 					sizeof(struct lp_stats)))
649*4882a593Smuzhiyun 				return -EFAULT;
650*4882a593Smuzhiyun 			if (capable(CAP_SYS_ADMIN))
651*4882a593Smuzhiyun 				memset(&LP_STAT(minor), 0,
652*4882a593Smuzhiyun 						sizeof(struct lp_stats));
653*4882a593Smuzhiyun 			break;
654*4882a593Smuzhiyun #endif
655*4882a593Smuzhiyun 		case LPGETFLAGS:
656*4882a593Smuzhiyun 			status = LP_F(minor);
657*4882a593Smuzhiyun 			if (copy_to_user(argp, &status, sizeof(int)))
658*4882a593Smuzhiyun 				return -EFAULT;
659*4882a593Smuzhiyun 			break;
660*4882a593Smuzhiyun 
661*4882a593Smuzhiyun 		default:
662*4882a593Smuzhiyun 			retval = -EINVAL;
663*4882a593Smuzhiyun 	}
664*4882a593Smuzhiyun 	return retval;
665*4882a593Smuzhiyun }
666*4882a593Smuzhiyun 
lp_set_timeout(unsigned int minor,s64 tv_sec,long tv_usec)667*4882a593Smuzhiyun static int lp_set_timeout(unsigned int minor, s64 tv_sec, long tv_usec)
668*4882a593Smuzhiyun {
669*4882a593Smuzhiyun 	long to_jiffies;
670*4882a593Smuzhiyun 
671*4882a593Smuzhiyun 	/* Convert to jiffies, place in lp_table */
672*4882a593Smuzhiyun 	if (tv_sec < 0 || tv_usec < 0)
673*4882a593Smuzhiyun 		return -EINVAL;
674*4882a593Smuzhiyun 
675*4882a593Smuzhiyun 	/*
676*4882a593Smuzhiyun 	 * we used to not check, so let's not make this fatal,
677*4882a593Smuzhiyun 	 * but deal with user space passing a 32-bit tv_nsec in
678*4882a593Smuzhiyun 	 * a 64-bit field, capping the timeout to 1 second
679*4882a593Smuzhiyun 	 * worth of microseconds, and capping the total at
680*4882a593Smuzhiyun 	 * MAX_JIFFY_OFFSET.
681*4882a593Smuzhiyun 	 */
682*4882a593Smuzhiyun 	if (tv_usec > 999999)
683*4882a593Smuzhiyun 		tv_usec = 999999;
684*4882a593Smuzhiyun 
685*4882a593Smuzhiyun 	if (tv_sec >= MAX_SEC_IN_JIFFIES - 1) {
686*4882a593Smuzhiyun 		to_jiffies = MAX_JIFFY_OFFSET;
687*4882a593Smuzhiyun 	} else {
688*4882a593Smuzhiyun 		to_jiffies = DIV_ROUND_UP(tv_usec, 1000000/HZ);
689*4882a593Smuzhiyun 		to_jiffies += tv_sec * (long) HZ;
690*4882a593Smuzhiyun 	}
691*4882a593Smuzhiyun 
692*4882a593Smuzhiyun 	if (to_jiffies <= 0) {
693*4882a593Smuzhiyun 		return -EINVAL;
694*4882a593Smuzhiyun 	}
695*4882a593Smuzhiyun 	lp_table[minor].timeout = to_jiffies;
696*4882a593Smuzhiyun 	return 0;
697*4882a593Smuzhiyun }
698*4882a593Smuzhiyun 
lp_set_timeout32(unsigned int minor,void __user * arg)699*4882a593Smuzhiyun static int lp_set_timeout32(unsigned int minor, void __user *arg)
700*4882a593Smuzhiyun {
701*4882a593Smuzhiyun 	s32 karg[2];
702*4882a593Smuzhiyun 
703*4882a593Smuzhiyun 	if (copy_from_user(karg, arg, sizeof(karg)))
704*4882a593Smuzhiyun 		return -EFAULT;
705*4882a593Smuzhiyun 
706*4882a593Smuzhiyun 	return lp_set_timeout(minor, karg[0], karg[1]);
707*4882a593Smuzhiyun }
708*4882a593Smuzhiyun 
lp_set_timeout64(unsigned int minor,void __user * arg)709*4882a593Smuzhiyun static int lp_set_timeout64(unsigned int minor, void __user *arg)
710*4882a593Smuzhiyun {
711*4882a593Smuzhiyun 	s64 karg[2];
712*4882a593Smuzhiyun 
713*4882a593Smuzhiyun 	if (copy_from_user(karg, arg, sizeof(karg)))
714*4882a593Smuzhiyun 		return -EFAULT;
715*4882a593Smuzhiyun 
716*4882a593Smuzhiyun 	/* sparc64 suseconds_t is 32-bit only */
717*4882a593Smuzhiyun 	if (IS_ENABLED(CONFIG_SPARC64) && !in_compat_syscall())
718*4882a593Smuzhiyun 		karg[1] >>= 32;
719*4882a593Smuzhiyun 
720*4882a593Smuzhiyun 	return lp_set_timeout(minor, karg[0], karg[1]);
721*4882a593Smuzhiyun }
722*4882a593Smuzhiyun 
lp_ioctl(struct file * file,unsigned int cmd,unsigned long arg)723*4882a593Smuzhiyun static long lp_ioctl(struct file *file, unsigned int cmd,
724*4882a593Smuzhiyun 			unsigned long arg)
725*4882a593Smuzhiyun {
726*4882a593Smuzhiyun 	unsigned int minor;
727*4882a593Smuzhiyun 	int ret;
728*4882a593Smuzhiyun 
729*4882a593Smuzhiyun 	minor = iminor(file_inode(file));
730*4882a593Smuzhiyun 	mutex_lock(&lp_mutex);
731*4882a593Smuzhiyun 	switch (cmd) {
732*4882a593Smuzhiyun 	case LPSETTIMEOUT_OLD:
733*4882a593Smuzhiyun 		if (BITS_PER_LONG == 32) {
734*4882a593Smuzhiyun 			ret = lp_set_timeout32(minor, (void __user *)arg);
735*4882a593Smuzhiyun 			break;
736*4882a593Smuzhiyun 		}
737*4882a593Smuzhiyun 		fallthrough;	/* for 64-bit */
738*4882a593Smuzhiyun 	case LPSETTIMEOUT_NEW:
739*4882a593Smuzhiyun 		ret = lp_set_timeout64(minor, (void __user *)arg);
740*4882a593Smuzhiyun 		break;
741*4882a593Smuzhiyun 	default:
742*4882a593Smuzhiyun 		ret = lp_do_ioctl(minor, cmd, arg, (void __user *)arg);
743*4882a593Smuzhiyun 		break;
744*4882a593Smuzhiyun 	}
745*4882a593Smuzhiyun 	mutex_unlock(&lp_mutex);
746*4882a593Smuzhiyun 
747*4882a593Smuzhiyun 	return ret;
748*4882a593Smuzhiyun }
749*4882a593Smuzhiyun 
750*4882a593Smuzhiyun #ifdef CONFIG_COMPAT
lp_compat_ioctl(struct file * file,unsigned int cmd,unsigned long arg)751*4882a593Smuzhiyun static long lp_compat_ioctl(struct file *file, unsigned int cmd,
752*4882a593Smuzhiyun 			unsigned long arg)
753*4882a593Smuzhiyun {
754*4882a593Smuzhiyun 	unsigned int minor;
755*4882a593Smuzhiyun 	int ret;
756*4882a593Smuzhiyun 
757*4882a593Smuzhiyun 	minor = iminor(file_inode(file));
758*4882a593Smuzhiyun 	mutex_lock(&lp_mutex);
759*4882a593Smuzhiyun 	switch (cmd) {
760*4882a593Smuzhiyun 	case LPSETTIMEOUT_OLD:
761*4882a593Smuzhiyun 		if (!COMPAT_USE_64BIT_TIME) {
762*4882a593Smuzhiyun 			ret = lp_set_timeout32(minor, (void __user *)arg);
763*4882a593Smuzhiyun 			break;
764*4882a593Smuzhiyun 		}
765*4882a593Smuzhiyun 		fallthrough;	/* for x32 mode */
766*4882a593Smuzhiyun 	case LPSETTIMEOUT_NEW:
767*4882a593Smuzhiyun 		ret = lp_set_timeout64(minor, (void __user *)arg);
768*4882a593Smuzhiyun 		break;
769*4882a593Smuzhiyun #ifdef LP_STATS
770*4882a593Smuzhiyun 	case LPGETSTATS:
771*4882a593Smuzhiyun 		/* FIXME: add an implementation if you set LP_STATS */
772*4882a593Smuzhiyun 		ret = -EINVAL;
773*4882a593Smuzhiyun 		break;
774*4882a593Smuzhiyun #endif
775*4882a593Smuzhiyun 	default:
776*4882a593Smuzhiyun 		ret = lp_do_ioctl(minor, cmd, arg, compat_ptr(arg));
777*4882a593Smuzhiyun 		break;
778*4882a593Smuzhiyun 	}
779*4882a593Smuzhiyun 	mutex_unlock(&lp_mutex);
780*4882a593Smuzhiyun 
781*4882a593Smuzhiyun 	return ret;
782*4882a593Smuzhiyun }
783*4882a593Smuzhiyun #endif
784*4882a593Smuzhiyun 
785*4882a593Smuzhiyun static const struct file_operations lp_fops = {
786*4882a593Smuzhiyun 	.owner		= THIS_MODULE,
787*4882a593Smuzhiyun 	.write		= lp_write,
788*4882a593Smuzhiyun 	.unlocked_ioctl	= lp_ioctl,
789*4882a593Smuzhiyun #ifdef CONFIG_COMPAT
790*4882a593Smuzhiyun 	.compat_ioctl	= lp_compat_ioctl,
791*4882a593Smuzhiyun #endif
792*4882a593Smuzhiyun 	.open		= lp_open,
793*4882a593Smuzhiyun 	.release	= lp_release,
794*4882a593Smuzhiyun #ifdef CONFIG_PARPORT_1284
795*4882a593Smuzhiyun 	.read		= lp_read,
796*4882a593Smuzhiyun #endif
797*4882a593Smuzhiyun 	.llseek		= noop_llseek,
798*4882a593Smuzhiyun };
799*4882a593Smuzhiyun 
800*4882a593Smuzhiyun /* --- support for console on the line printer ----------------- */
801*4882a593Smuzhiyun 
802*4882a593Smuzhiyun #ifdef CONFIG_LP_CONSOLE
803*4882a593Smuzhiyun 
804*4882a593Smuzhiyun #define CONSOLE_LP 0
805*4882a593Smuzhiyun 
806*4882a593Smuzhiyun /* If the printer is out of paper, we can either lose the messages or
807*4882a593Smuzhiyun  * stall until the printer is happy again.  Define CONSOLE_LP_STRICT
808*4882a593Smuzhiyun  * non-zero to get the latter behaviour. */
809*4882a593Smuzhiyun #define CONSOLE_LP_STRICT 1
810*4882a593Smuzhiyun 
811*4882a593Smuzhiyun /* The console must be locked when we get here. */
812*4882a593Smuzhiyun 
lp_console_write(struct console * co,const char * s,unsigned count)813*4882a593Smuzhiyun static void lp_console_write(struct console *co, const char *s,
814*4882a593Smuzhiyun 			     unsigned count)
815*4882a593Smuzhiyun {
816*4882a593Smuzhiyun 	struct pardevice *dev = lp_table[CONSOLE_LP].dev;
817*4882a593Smuzhiyun 	struct parport *port = dev->port;
818*4882a593Smuzhiyun 	ssize_t written;
819*4882a593Smuzhiyun 
820*4882a593Smuzhiyun 	if (parport_claim(dev))
821*4882a593Smuzhiyun 		/* Nothing we can do. */
822*4882a593Smuzhiyun 		return;
823*4882a593Smuzhiyun 
824*4882a593Smuzhiyun 	parport_set_timeout(dev, 0);
825*4882a593Smuzhiyun 
826*4882a593Smuzhiyun 	/* Go to compatibility mode. */
827*4882a593Smuzhiyun 	parport_negotiate(port, IEEE1284_MODE_COMPAT);
828*4882a593Smuzhiyun 
829*4882a593Smuzhiyun 	do {
830*4882a593Smuzhiyun 		/* Write the data, converting LF->CRLF as we go. */
831*4882a593Smuzhiyun 		ssize_t canwrite = count;
832*4882a593Smuzhiyun 		char *lf = memchr(s, '\n', count);
833*4882a593Smuzhiyun 		if (lf)
834*4882a593Smuzhiyun 			canwrite = lf - s;
835*4882a593Smuzhiyun 
836*4882a593Smuzhiyun 		if (canwrite > 0) {
837*4882a593Smuzhiyun 			written = parport_write(port, s, canwrite);
838*4882a593Smuzhiyun 
839*4882a593Smuzhiyun 			if (written <= 0)
840*4882a593Smuzhiyun 				continue;
841*4882a593Smuzhiyun 
842*4882a593Smuzhiyun 			s += written;
843*4882a593Smuzhiyun 			count -= written;
844*4882a593Smuzhiyun 			canwrite -= written;
845*4882a593Smuzhiyun 		}
846*4882a593Smuzhiyun 
847*4882a593Smuzhiyun 		if (lf && canwrite <= 0) {
848*4882a593Smuzhiyun 			const char *crlf = "\r\n";
849*4882a593Smuzhiyun 			int i = 2;
850*4882a593Smuzhiyun 
851*4882a593Smuzhiyun 			/* Dodge the original '\n', and put '\r\n' instead. */
852*4882a593Smuzhiyun 			s++;
853*4882a593Smuzhiyun 			count--;
854*4882a593Smuzhiyun 			do {
855*4882a593Smuzhiyun 				written = parport_write(port, crlf, i);
856*4882a593Smuzhiyun 				if (written > 0) {
857*4882a593Smuzhiyun 					i -= written;
858*4882a593Smuzhiyun 					crlf += written;
859*4882a593Smuzhiyun 				}
860*4882a593Smuzhiyun 			} while (i > 0 && (CONSOLE_LP_STRICT || written > 0));
861*4882a593Smuzhiyun 		}
862*4882a593Smuzhiyun 	} while (count > 0 && (CONSOLE_LP_STRICT || written > 0));
863*4882a593Smuzhiyun 
864*4882a593Smuzhiyun 	parport_release(dev);
865*4882a593Smuzhiyun }
866*4882a593Smuzhiyun 
867*4882a593Smuzhiyun static struct console lpcons = {
868*4882a593Smuzhiyun 	.name		= "lp",
869*4882a593Smuzhiyun 	.write		= lp_console_write,
870*4882a593Smuzhiyun 	.flags		= CON_PRINTBUFFER,
871*4882a593Smuzhiyun };
872*4882a593Smuzhiyun 
873*4882a593Smuzhiyun #endif /* console on line printer */
874*4882a593Smuzhiyun 
875*4882a593Smuzhiyun /* --- initialisation code ------------------------------------- */
876*4882a593Smuzhiyun 
877*4882a593Smuzhiyun static int parport_nr[LP_NO] = { [0 ... LP_NO-1] = LP_PARPORT_UNSPEC };
878*4882a593Smuzhiyun static char *parport[LP_NO];
879*4882a593Smuzhiyun static bool reset;
880*4882a593Smuzhiyun 
881*4882a593Smuzhiyun module_param_array(parport, charp, NULL, 0);
882*4882a593Smuzhiyun module_param(reset, bool, 0);
883*4882a593Smuzhiyun 
884*4882a593Smuzhiyun #ifndef MODULE
lp_setup(char * str)885*4882a593Smuzhiyun static int __init lp_setup(char *str)
886*4882a593Smuzhiyun {
887*4882a593Smuzhiyun 	static int parport_ptr;
888*4882a593Smuzhiyun 	int x;
889*4882a593Smuzhiyun 
890*4882a593Smuzhiyun 	if (get_option(&str, &x)) {
891*4882a593Smuzhiyun 		if (x == 0) {
892*4882a593Smuzhiyun 			/* disable driver on "lp=" or "lp=0" */
893*4882a593Smuzhiyun 			parport_nr[0] = LP_PARPORT_OFF;
894*4882a593Smuzhiyun 		} else {
895*4882a593Smuzhiyun 			printk(KERN_WARNING "warning: 'lp=0x%x' is deprecated, ignored\n", x);
896*4882a593Smuzhiyun 			return 0;
897*4882a593Smuzhiyun 		}
898*4882a593Smuzhiyun 	} else if (!strncmp(str, "parport", 7)) {
899*4882a593Smuzhiyun 		int n = simple_strtoul(str+7, NULL, 10);
900*4882a593Smuzhiyun 		if (parport_ptr < LP_NO)
901*4882a593Smuzhiyun 			parport_nr[parport_ptr++] = n;
902*4882a593Smuzhiyun 		else
903*4882a593Smuzhiyun 			printk(KERN_INFO "lp: too many ports, %s ignored.\n",
904*4882a593Smuzhiyun 			       str);
905*4882a593Smuzhiyun 	} else if (!strcmp(str, "auto")) {
906*4882a593Smuzhiyun 		parport_nr[0] = LP_PARPORT_AUTO;
907*4882a593Smuzhiyun 	} else if (!strcmp(str, "none")) {
908*4882a593Smuzhiyun 		if (parport_ptr < LP_NO)
909*4882a593Smuzhiyun 			parport_nr[parport_ptr++] = LP_PARPORT_NONE;
910*4882a593Smuzhiyun 		else
911*4882a593Smuzhiyun 			printk(KERN_INFO "lp: too many ports, %s ignored.\n",
912*4882a593Smuzhiyun 			       str);
913*4882a593Smuzhiyun 	} else if (!strcmp(str, "reset")) {
914*4882a593Smuzhiyun 		reset = true;
915*4882a593Smuzhiyun 	}
916*4882a593Smuzhiyun 	return 1;
917*4882a593Smuzhiyun }
918*4882a593Smuzhiyun #endif
919*4882a593Smuzhiyun 
lp_register(int nr,struct parport * port)920*4882a593Smuzhiyun static int lp_register(int nr, struct parport *port)
921*4882a593Smuzhiyun {
922*4882a593Smuzhiyun 	struct pardev_cb ppdev_cb;
923*4882a593Smuzhiyun 
924*4882a593Smuzhiyun 	memset(&ppdev_cb, 0, sizeof(ppdev_cb));
925*4882a593Smuzhiyun 	ppdev_cb.preempt = lp_preempt;
926*4882a593Smuzhiyun 	ppdev_cb.private = &lp_table[nr];
927*4882a593Smuzhiyun 	lp_table[nr].dev = parport_register_dev_model(port, "lp",
928*4882a593Smuzhiyun 						      &ppdev_cb, nr);
929*4882a593Smuzhiyun 	if (lp_table[nr].dev == NULL)
930*4882a593Smuzhiyun 		return 1;
931*4882a593Smuzhiyun 	lp_table[nr].flags |= LP_EXIST;
932*4882a593Smuzhiyun 
933*4882a593Smuzhiyun 	if (reset)
934*4882a593Smuzhiyun 		lp_reset(nr);
935*4882a593Smuzhiyun 
936*4882a593Smuzhiyun 	device_create(lp_class, port->dev, MKDEV(LP_MAJOR, nr), NULL,
937*4882a593Smuzhiyun 		      "lp%d", nr);
938*4882a593Smuzhiyun 
939*4882a593Smuzhiyun 	printk(KERN_INFO "lp%d: using %s (%s).\n", nr, port->name,
940*4882a593Smuzhiyun 	       (port->irq == PARPORT_IRQ_NONE)?"polling":"interrupt-driven");
941*4882a593Smuzhiyun 
942*4882a593Smuzhiyun #ifdef CONFIG_LP_CONSOLE
943*4882a593Smuzhiyun 	if (!nr) {
944*4882a593Smuzhiyun 		if (port->modes & PARPORT_MODE_SAFEININT) {
945*4882a593Smuzhiyun 			register_console(&lpcons);
946*4882a593Smuzhiyun 			console_registered = port;
947*4882a593Smuzhiyun 			printk(KERN_INFO "lp%d: console ready\n", CONSOLE_LP);
948*4882a593Smuzhiyun 		} else
949*4882a593Smuzhiyun 			printk(KERN_ERR "lp%d: cannot run console on %s\n",
950*4882a593Smuzhiyun 			       CONSOLE_LP, port->name);
951*4882a593Smuzhiyun 	}
952*4882a593Smuzhiyun #endif
953*4882a593Smuzhiyun 	port_num[nr] = port->number;
954*4882a593Smuzhiyun 
955*4882a593Smuzhiyun 	return 0;
956*4882a593Smuzhiyun }
957*4882a593Smuzhiyun 
lp_attach(struct parport * port)958*4882a593Smuzhiyun static void lp_attach(struct parport *port)
959*4882a593Smuzhiyun {
960*4882a593Smuzhiyun 	unsigned int i;
961*4882a593Smuzhiyun 
962*4882a593Smuzhiyun 	switch (parport_nr[0]) {
963*4882a593Smuzhiyun 	case LP_PARPORT_UNSPEC:
964*4882a593Smuzhiyun 	case LP_PARPORT_AUTO:
965*4882a593Smuzhiyun 		if (parport_nr[0] == LP_PARPORT_AUTO &&
966*4882a593Smuzhiyun 		    port->probe_info[0].class != PARPORT_CLASS_PRINTER)
967*4882a593Smuzhiyun 			return;
968*4882a593Smuzhiyun 		if (lp_count == LP_NO) {
969*4882a593Smuzhiyun 			printk(KERN_INFO "lp: ignoring parallel port (max. %d)\n",LP_NO);
970*4882a593Smuzhiyun 			return;
971*4882a593Smuzhiyun 		}
972*4882a593Smuzhiyun 		for (i = 0; i < LP_NO; i++)
973*4882a593Smuzhiyun 			if (port_num[i] == -1)
974*4882a593Smuzhiyun 				break;
975*4882a593Smuzhiyun 
976*4882a593Smuzhiyun 		if (!lp_register(i, port))
977*4882a593Smuzhiyun 			lp_count++;
978*4882a593Smuzhiyun 		break;
979*4882a593Smuzhiyun 
980*4882a593Smuzhiyun 	default:
981*4882a593Smuzhiyun 		for (i = 0; i < LP_NO; i++) {
982*4882a593Smuzhiyun 			if (port->number == parport_nr[i]) {
983*4882a593Smuzhiyun 				if (!lp_register(i, port))
984*4882a593Smuzhiyun 					lp_count++;
985*4882a593Smuzhiyun 				break;
986*4882a593Smuzhiyun 			}
987*4882a593Smuzhiyun 		}
988*4882a593Smuzhiyun 		break;
989*4882a593Smuzhiyun 	}
990*4882a593Smuzhiyun }
991*4882a593Smuzhiyun 
lp_detach(struct parport * port)992*4882a593Smuzhiyun static void lp_detach(struct parport *port)
993*4882a593Smuzhiyun {
994*4882a593Smuzhiyun 	int n;
995*4882a593Smuzhiyun 
996*4882a593Smuzhiyun 	/* Write this some day. */
997*4882a593Smuzhiyun #ifdef CONFIG_LP_CONSOLE
998*4882a593Smuzhiyun 	if (console_registered == port) {
999*4882a593Smuzhiyun 		unregister_console(&lpcons);
1000*4882a593Smuzhiyun 		console_registered = NULL;
1001*4882a593Smuzhiyun 	}
1002*4882a593Smuzhiyun #endif /* CONFIG_LP_CONSOLE */
1003*4882a593Smuzhiyun 
1004*4882a593Smuzhiyun 	for (n = 0; n < LP_NO; n++) {
1005*4882a593Smuzhiyun 		if (port_num[n] == port->number) {
1006*4882a593Smuzhiyun 			port_num[n] = -1;
1007*4882a593Smuzhiyun 			lp_count--;
1008*4882a593Smuzhiyun 			device_destroy(lp_class, MKDEV(LP_MAJOR, n));
1009*4882a593Smuzhiyun 			parport_unregister_device(lp_table[n].dev);
1010*4882a593Smuzhiyun 		}
1011*4882a593Smuzhiyun 	}
1012*4882a593Smuzhiyun }
1013*4882a593Smuzhiyun 
1014*4882a593Smuzhiyun static struct parport_driver lp_driver = {
1015*4882a593Smuzhiyun 	.name = "lp",
1016*4882a593Smuzhiyun 	.match_port = lp_attach,
1017*4882a593Smuzhiyun 	.detach = lp_detach,
1018*4882a593Smuzhiyun 	.devmodel = true,
1019*4882a593Smuzhiyun };
1020*4882a593Smuzhiyun 
lp_init(void)1021*4882a593Smuzhiyun static int __init lp_init(void)
1022*4882a593Smuzhiyun {
1023*4882a593Smuzhiyun 	int i, err = 0;
1024*4882a593Smuzhiyun 
1025*4882a593Smuzhiyun 	if (parport_nr[0] == LP_PARPORT_OFF)
1026*4882a593Smuzhiyun 		return 0;
1027*4882a593Smuzhiyun 
1028*4882a593Smuzhiyun 	for (i = 0; i < LP_NO; i++) {
1029*4882a593Smuzhiyun 		lp_table[i].dev = NULL;
1030*4882a593Smuzhiyun 		lp_table[i].flags = 0;
1031*4882a593Smuzhiyun 		lp_table[i].chars = LP_INIT_CHAR;
1032*4882a593Smuzhiyun 		lp_table[i].time = LP_INIT_TIME;
1033*4882a593Smuzhiyun 		lp_table[i].wait = LP_INIT_WAIT;
1034*4882a593Smuzhiyun 		lp_table[i].lp_buffer = NULL;
1035*4882a593Smuzhiyun #ifdef LP_STATS
1036*4882a593Smuzhiyun 		lp_table[i].lastcall = 0;
1037*4882a593Smuzhiyun 		lp_table[i].runchars = 0;
1038*4882a593Smuzhiyun 		memset(&lp_table[i].stats, 0, sizeof(struct lp_stats));
1039*4882a593Smuzhiyun #endif
1040*4882a593Smuzhiyun 		lp_table[i].last_error = 0;
1041*4882a593Smuzhiyun 		init_waitqueue_head(&lp_table[i].waitq);
1042*4882a593Smuzhiyun 		init_waitqueue_head(&lp_table[i].dataq);
1043*4882a593Smuzhiyun 		mutex_init(&lp_table[i].port_mutex);
1044*4882a593Smuzhiyun 		lp_table[i].timeout = 10 * HZ;
1045*4882a593Smuzhiyun 		port_num[i] = -1;
1046*4882a593Smuzhiyun 	}
1047*4882a593Smuzhiyun 
1048*4882a593Smuzhiyun 	if (register_chrdev(LP_MAJOR, "lp", &lp_fops)) {
1049*4882a593Smuzhiyun 		printk(KERN_ERR "lp: unable to get major %d\n", LP_MAJOR);
1050*4882a593Smuzhiyun 		return -EIO;
1051*4882a593Smuzhiyun 	}
1052*4882a593Smuzhiyun 
1053*4882a593Smuzhiyun 	lp_class = class_create(THIS_MODULE, "printer");
1054*4882a593Smuzhiyun 	if (IS_ERR(lp_class)) {
1055*4882a593Smuzhiyun 		err = PTR_ERR(lp_class);
1056*4882a593Smuzhiyun 		goto out_reg;
1057*4882a593Smuzhiyun 	}
1058*4882a593Smuzhiyun 
1059*4882a593Smuzhiyun 	if (parport_register_driver(&lp_driver)) {
1060*4882a593Smuzhiyun 		printk(KERN_ERR "lp: unable to register with parport\n");
1061*4882a593Smuzhiyun 		err = -EIO;
1062*4882a593Smuzhiyun 		goto out_class;
1063*4882a593Smuzhiyun 	}
1064*4882a593Smuzhiyun 
1065*4882a593Smuzhiyun 	if (!lp_count) {
1066*4882a593Smuzhiyun 		printk(KERN_INFO "lp: driver loaded but no devices found\n");
1067*4882a593Smuzhiyun #ifndef CONFIG_PARPORT_1284
1068*4882a593Smuzhiyun 		if (parport_nr[0] == LP_PARPORT_AUTO)
1069*4882a593Smuzhiyun 			printk(KERN_INFO "lp: (is IEEE 1284 support enabled?)\n");
1070*4882a593Smuzhiyun #endif
1071*4882a593Smuzhiyun 	}
1072*4882a593Smuzhiyun 
1073*4882a593Smuzhiyun 	return 0;
1074*4882a593Smuzhiyun 
1075*4882a593Smuzhiyun out_class:
1076*4882a593Smuzhiyun 	class_destroy(lp_class);
1077*4882a593Smuzhiyun out_reg:
1078*4882a593Smuzhiyun 	unregister_chrdev(LP_MAJOR, "lp");
1079*4882a593Smuzhiyun 	return err;
1080*4882a593Smuzhiyun }
1081*4882a593Smuzhiyun 
lp_init_module(void)1082*4882a593Smuzhiyun static int __init lp_init_module(void)
1083*4882a593Smuzhiyun {
1084*4882a593Smuzhiyun 	if (parport[0]) {
1085*4882a593Smuzhiyun 		/* The user gave some parameters.  Let's see what they were.  */
1086*4882a593Smuzhiyun 		if (!strncmp(parport[0], "auto", 4))
1087*4882a593Smuzhiyun 			parport_nr[0] = LP_PARPORT_AUTO;
1088*4882a593Smuzhiyun 		else {
1089*4882a593Smuzhiyun 			int n;
1090*4882a593Smuzhiyun 			for (n = 0; n < LP_NO && parport[n]; n++) {
1091*4882a593Smuzhiyun 				if (!strncmp(parport[n], "none", 4))
1092*4882a593Smuzhiyun 					parport_nr[n] = LP_PARPORT_NONE;
1093*4882a593Smuzhiyun 				else {
1094*4882a593Smuzhiyun 					char *ep;
1095*4882a593Smuzhiyun 					unsigned long r = simple_strtoul(parport[n], &ep, 0);
1096*4882a593Smuzhiyun 					if (ep != parport[n])
1097*4882a593Smuzhiyun 						parport_nr[n] = r;
1098*4882a593Smuzhiyun 					else {
1099*4882a593Smuzhiyun 						printk(KERN_ERR "lp: bad port specifier `%s'\n", parport[n]);
1100*4882a593Smuzhiyun 						return -ENODEV;
1101*4882a593Smuzhiyun 					}
1102*4882a593Smuzhiyun 				}
1103*4882a593Smuzhiyun 			}
1104*4882a593Smuzhiyun 		}
1105*4882a593Smuzhiyun 	}
1106*4882a593Smuzhiyun 
1107*4882a593Smuzhiyun 	return lp_init();
1108*4882a593Smuzhiyun }
1109*4882a593Smuzhiyun 
lp_cleanup_module(void)1110*4882a593Smuzhiyun static void lp_cleanup_module(void)
1111*4882a593Smuzhiyun {
1112*4882a593Smuzhiyun 	parport_unregister_driver(&lp_driver);
1113*4882a593Smuzhiyun 
1114*4882a593Smuzhiyun #ifdef CONFIG_LP_CONSOLE
1115*4882a593Smuzhiyun 	unregister_console(&lpcons);
1116*4882a593Smuzhiyun #endif
1117*4882a593Smuzhiyun 
1118*4882a593Smuzhiyun 	unregister_chrdev(LP_MAJOR, "lp");
1119*4882a593Smuzhiyun 	class_destroy(lp_class);
1120*4882a593Smuzhiyun }
1121*4882a593Smuzhiyun 
1122*4882a593Smuzhiyun __setup("lp=", lp_setup);
1123*4882a593Smuzhiyun module_init(lp_init_module);
1124*4882a593Smuzhiyun module_exit(lp_cleanup_module);
1125*4882a593Smuzhiyun 
1126*4882a593Smuzhiyun MODULE_ALIAS_CHARDEV_MAJOR(LP_MAJOR);
1127*4882a593Smuzhiyun MODULE_LICENSE("GPL");
1128