Home | History | Annotate | Line # | Download | only in ppbus
ppbus_base.c revision 1.3
      1  1.3     bjh21 /* $NetBSD: ppbus_base.c,v 1.3 2004/01/22 01:13:21 bjh21 Exp $ */
      2  1.2     bjh21 
      3  1.1  jdolecek /*-
      4  1.1  jdolecek  * Copyright (c) 1997, 1998, 1999 Nicolas Souchu
      5  1.1  jdolecek  * All rights reserved.
      6  1.1  jdolecek  *
      7  1.1  jdolecek  * Redistribution and use in source and binary forms, with or without
      8  1.1  jdolecek  * modification, are permitted provided that the following conditions
      9  1.1  jdolecek  * are met:
     10  1.1  jdolecek  * 1. Redistributions of source code must retain the above copyright
     11  1.1  jdolecek  *    notice, this list of conditions and the following disclaimer.
     12  1.1  jdolecek  * 2. Redistributions in binary form must reproduce the above copyright
     13  1.1  jdolecek  *    notice, this list of conditions and the following disclaimer in the
     14  1.1  jdolecek  *    documentation and/or other materials provided with the distribution.
     15  1.1  jdolecek  *
     16  1.1  jdolecek  * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND
     17  1.1  jdolecek  * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
     18  1.1  jdolecek  * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
     19  1.1  jdolecek  * ARE DISCLAIMED.  IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE
     20  1.1  jdolecek  * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
     21  1.1  jdolecek  * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
     22  1.1  jdolecek  * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
     23  1.1  jdolecek  * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
     24  1.1  jdolecek  * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
     25  1.1  jdolecek  * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
     26  1.1  jdolecek  * SUCH DAMAGE.
     27  1.1  jdolecek  *
     28  1.1  jdolecek  * $FreeBSD: src/sys/dev/ppbus/ppb_base.c,v 1.10.2.1 2000/08/01 23:26:26 n_hibma Exp $
     29  1.1  jdolecek  *
     30  1.1  jdolecek  */
     31  1.1  jdolecek #include "opt_ppbus_1284.h"
     32  1.1  jdolecek #include "opt_ppbus.h"
     33  1.1  jdolecek 
     34  1.1  jdolecek #include <sys/param.h>
     35  1.1  jdolecek #include <sys/kernel.h>
     36  1.3     bjh21 #include <sys/malloc.h>
     37  1.1  jdolecek #include <sys/proc.h>
     38  1.1  jdolecek #include <sys/lock.h>
     39  1.1  jdolecek #include <sys/systm.h>
     40  1.1  jdolecek 
     41  1.1  jdolecek #include <dev/ppbus/ppbus_1284.h>
     42  1.1  jdolecek #include <dev/ppbus/ppbus_conf.h>
     43  1.1  jdolecek #include <dev/ppbus/ppbus_base.h>
     44  1.1  jdolecek #include <dev/ppbus/ppbus_device.h>
     45  1.1  jdolecek #include <dev/ppbus/ppbus_io.h>
     46  1.1  jdolecek #include <dev/ppbus/ppbus_var.h>
     47  1.1  jdolecek 
     48  1.1  jdolecek /* Utility functions */
     49  1.1  jdolecek static char * search_token(char *, int, char *);
     50  1.1  jdolecek 
     51  1.1  jdolecek 
     52  1.1  jdolecek /* Perform general ppbus I/O request */
     53  1.1  jdolecek int
     54  1.1  jdolecek ppbus_io(struct device * dev, int iop, u_char * addr, int cnt, u_char byte)
     55  1.1  jdolecek {
     56  1.1  jdolecek 	struct ppbus_softc * bus = (struct ppbus_softc *) dev;
     57  1.1  jdolecek 	return (bus->ppbus_io(dev->dv_parent, iop, addr, cnt, byte));
     58  1.1  jdolecek }
     59  1.1  jdolecek 
     60  1.1  jdolecek /* Execute microsequence */
     61  1.1  jdolecek int
     62  1.1  jdolecek ppbus_exec_microseq(struct device * dev, struct ppbus_microseq ** sequence)
     63  1.1  jdolecek {
     64  1.1  jdolecek 	struct ppbus_softc * bus = (struct ppbus_softc *) dev;
     65  1.1  jdolecek 	return (bus->ppbus_exec_microseq(dev->dv_parent, sequence));
     66  1.1  jdolecek }
     67  1.1  jdolecek 
     68  1.1  jdolecek /* Read instance variables of ppbus */
     69  1.1  jdolecek int
     70  1.1  jdolecek ppbus_read_ivar(struct device * dev, int index, unsigned int * val)
     71  1.1  jdolecek 
     72  1.1  jdolecek {
     73  1.1  jdolecek 	struct ppbus_softc * bus = (struct ppbus_softc *) dev;
     74  1.1  jdolecek 
     75  1.1  jdolecek 	switch (index) {
     76  1.1  jdolecek 	case PPBUS_IVAR_INTR:
     77  1.1  jdolecek 	case PPBUS_IVAR_EPP_PROTO:
     78  1.1  jdolecek 	case PPBUS_IVAR_DMA:
     79  1.1  jdolecek 		return (bus->ppbus_read_ivar(dev->dv_parent, index, val));
     80  1.1  jdolecek 
     81  1.1  jdolecek 	case PPBUS_IVAR_IEEE:
     82  1.1  jdolecek 		*val = (bus->sc_use_ieee == PPBUS_ENABLE_IEEE) ? 1 : 0;
     83  1.1  jdolecek 		break;
     84  1.1  jdolecek 
     85  1.1  jdolecek 	default:
     86  1.1  jdolecek 		return (ENOENT);
     87  1.1  jdolecek 	}
     88  1.1  jdolecek 
     89  1.1  jdolecek 	return 0;
     90  1.1  jdolecek }
     91  1.1  jdolecek 
     92  1.1  jdolecek /* Write an instance variable */
     93  1.1  jdolecek int
     94  1.1  jdolecek ppbus_write_ivar(struct device * dev, int index, unsigned int * val)
     95  1.1  jdolecek {
     96  1.1  jdolecek 	struct ppbus_softc * bus = (struct ppbus_softc *) dev;
     97  1.1  jdolecek 
     98  1.1  jdolecek 	switch (index) {
     99  1.1  jdolecek 	case PPBUS_IVAR_INTR:
    100  1.1  jdolecek 	case PPBUS_IVAR_EPP_PROTO:
    101  1.1  jdolecek 	case PPBUS_IVAR_DMA:
    102  1.1  jdolecek 		return (bus->ppbus_write_ivar(dev->dv_parent, index, val));
    103  1.1  jdolecek 
    104  1.1  jdolecek 	case PPBUS_IVAR_IEEE:
    105  1.1  jdolecek 		bus->sc_use_ieee = ((*val != 0) ? PPBUS_ENABLE_IEEE :
    106  1.1  jdolecek 			PPBUS_DISABLE_IEEE);
    107  1.1  jdolecek 		break;
    108  1.1  jdolecek 
    109  1.1  jdolecek 	default:
    110  1.1  jdolecek 		return (ENOENT);
    111  1.1  jdolecek 	}
    112  1.1  jdolecek 
    113  1.1  jdolecek 	return 0;
    114  1.1  jdolecek }
    115  1.1  jdolecek 
    116  1.1  jdolecek /* Polls the bus for a max of 10-milliseconds */
    117  1.1  jdolecek int
    118  1.1  jdolecek ppbus_poll_bus(struct device * dev, int max, char mask, char status,
    119  1.1  jdolecek 	int how)
    120  1.1  jdolecek {
    121  1.1  jdolecek 	int i, j, error;
    122  1.1  jdolecek 	char r;
    123  1.1  jdolecek 
    124  1.1  jdolecek 	/* try at least up to 10ms */
    125  1.1  jdolecek 	for (j = 0; j < ((how & PPBUS_POLL) ? max : 1); j++) {
    126  1.1  jdolecek 		for (i = 0; i < 10000; i++) {
    127  1.1  jdolecek 			r = ppbus_rstr(dev);
    128  1.1  jdolecek 			DELAY(1);
    129  1.1  jdolecek 			if ((r & mask) == status)
    130  1.1  jdolecek 				return (0);
    131  1.1  jdolecek 		}
    132  1.1  jdolecek 	}
    133  1.1  jdolecek 
    134  1.1  jdolecek 	if (!(how & PPBUS_POLL)) {
    135  1.1  jdolecek 	   for (i = 0; max == PPBUS_FOREVER || i < max-1; i++) {
    136  1.1  jdolecek 		if ((ppbus_rstr(dev) & mask) == status)
    137  1.1  jdolecek 			return (0);
    138  1.1  jdolecek 
    139  1.1  jdolecek 		switch (how) {
    140  1.1  jdolecek 		case PPBUS_NOINTR:
    141  1.1  jdolecek 			/* wait 10 ms */
    142  1.1  jdolecek 			tsleep((caddr_t)dev, PPBUSPRI, "ppbuspoll", hz/100);
    143  1.1  jdolecek 			break;
    144  1.1  jdolecek 
    145  1.1  jdolecek 		case PPBUS_INTR:
    146  1.1  jdolecek 		default:
    147  1.1  jdolecek 			/* wait 10 ms */
    148  1.1  jdolecek 			if (((error = tsleep((caddr_t)dev, PPBUSPRI | PCATCH,
    149  1.1  jdolecek 			    "ppbuspoll", hz/100)) != EWOULDBLOCK) != 0) {
    150  1.1  jdolecek 				return (error);
    151  1.1  jdolecek 			}
    152  1.1  jdolecek 			break;
    153  1.1  jdolecek 		}
    154  1.1  jdolecek 	   }
    155  1.1  jdolecek 	}
    156  1.1  jdolecek 
    157  1.1  jdolecek 	return (EWOULDBLOCK);
    158  1.1  jdolecek }
    159  1.1  jdolecek 
    160  1.1  jdolecek /* Get operating mode of the chipset */
    161  1.1  jdolecek int
    162  1.1  jdolecek ppbus_get_mode(struct device * dev)
    163  1.1  jdolecek {
    164  1.1  jdolecek 	struct ppbus_softc * bus = (struct ppbus_softc *) dev;
    165  1.1  jdolecek 
    166  1.1  jdolecek 	return (bus->sc_mode);
    167  1.1  jdolecek }
    168  1.1  jdolecek 
    169  1.1  jdolecek /* Set the operating mode of the chipset, return 0 on success. */
    170  1.1  jdolecek int
    171  1.1  jdolecek ppbus_set_mode(struct device * dev, int mode, int options)
    172  1.1  jdolecek {
    173  1.1  jdolecek 	struct ppbus_softc * bus = (struct ppbus_softc *) dev;
    174  1.1  jdolecek 	int error = 0;
    175  1.1  jdolecek 
    176  1.1  jdolecek 	/* If no mode change, do nothing */
    177  1.1  jdolecek 	if(bus->sc_mode == mode)
    178  1.1  jdolecek 		return error;
    179  1.1  jdolecek 
    180  1.1  jdolecek 	/* Do necessary negociations */
    181  1.1  jdolecek 	if(bus->sc_use_ieee == PPBUS_ENABLE_IEEE) {
    182  1.1  jdolecek 		/* Cannot negociate standard mode */
    183  1.1  jdolecek 		if(!(mode & (PPBUS_FAST | PPBUS_COMPATIBLE))) {
    184  1.1  jdolecek  			error = ppbus_1284_negociate(dev, mode, options);
    185  1.1  jdolecek 		}
    186  1.1  jdolecek 		/* Termination is unnecessary for standard<->fast */
    187  1.1  jdolecek 		else if(!(bus->sc_mode & (PPBUS_FAST | PPBUS_COMPATIBLE))) {
    188  1.1  jdolecek 			ppbus_1284_terminate(dev);
    189  1.1  jdolecek 		}
    190  1.1  jdolecek 	}
    191  1.1  jdolecek 
    192  1.1  jdolecek 	if(!error) {
    193  1.1  jdolecek 		/* Set mode and update mode of ppbus to actual mode */
    194  1.1  jdolecek 		error = bus->ppbus_setmode(dev->dv_parent, mode);
    195  1.1  jdolecek 		bus->sc_mode = bus->ppbus_getmode(dev->dv_parent);
    196  1.1  jdolecek 	}
    197  1.1  jdolecek 
    198  1.1  jdolecek 	/* Update host state if necessary */
    199  1.1  jdolecek 	if(!(error) && (bus->sc_use_ieee == PPBUS_ENABLE_IEEE)) {
    200  1.1  jdolecek 		switch(mode) {
    201  1.1  jdolecek 		case PPBUS_COMPATIBLE:
    202  1.1  jdolecek 		case PPBUS_FAST:
    203  1.1  jdolecek 		case PPBUS_EPP:
    204  1.1  jdolecek 		case PPBUS_ECP:
    205  1.1  jdolecek 			ppbus_1284_set_state(dev, PPBUS_FORWARD_IDLE);
    206  1.1  jdolecek 			break;
    207  1.1  jdolecek 
    208  1.1  jdolecek 		case PPBUS_NIBBLE:
    209  1.1  jdolecek 		case PPBUS_PS2:
    210  1.1  jdolecek 			ppbus_1284_set_state(dev, PPBUS_REVERSE_IDLE);
    211  1.1  jdolecek 			break;
    212  1.1  jdolecek 		}
    213  1.1  jdolecek 	}
    214  1.1  jdolecek 
    215  1.1  jdolecek 	return error;
    216  1.1  jdolecek }
    217  1.1  jdolecek 
    218  1.1  jdolecek /* Write charaters to the port */
    219  1.1  jdolecek int
    220  1.1  jdolecek ppbus_write(struct device * dev, char * buf, int len, int how, size_t * cnt)
    221  1.1  jdolecek {
    222  1.1  jdolecek 	struct ppbus_softc * bus = (struct ppbus_softc *) dev;
    223  1.1  jdolecek 
    224  1.1  jdolecek 	if(bus->sc_use_ieee == PPBUS_ENABLE_IEEE) {
    225  1.1  jdolecek 		if(bus->sc_1284_state != PPBUS_FORWARD_IDLE) {
    226  1.1  jdolecek 			printf("%s(%s): bus not in forward idle mode.\n",
    227  1.1  jdolecek 				__func__, dev->dv_xname);
    228  1.1  jdolecek 			return ENODEV;
    229  1.1  jdolecek 		}
    230  1.1  jdolecek 	}
    231  1.1  jdolecek 
    232  1.1  jdolecek 	return (bus->ppbus_write(bus->sc_dev.dv_parent, buf, len, how, cnt));
    233  1.1  jdolecek }
    234  1.1  jdolecek 
    235  1.1  jdolecek /* Read charaters from the port */
    236  1.1  jdolecek int
    237  1.1  jdolecek ppbus_read(struct device * dev, char * buf, int len, int how, size_t * cnt)
    238  1.1  jdolecek {
    239  1.1  jdolecek 	struct ppbus_softc * bus = (struct ppbus_softc *) dev;
    240  1.1  jdolecek 
    241  1.1  jdolecek 	if(bus->sc_use_ieee == PPBUS_ENABLE_IEEE) {
    242  1.1  jdolecek 		if(bus->sc_1284_state != PPBUS_REVERSE_IDLE) {
    243  1.1  jdolecek 			printf("%s(%s): bus not in reverse idle mode.\n",
    244  1.1  jdolecek 				__func__, dev->dv_xname);
    245  1.1  jdolecek 			return ENODEV;
    246  1.1  jdolecek 		}
    247  1.1  jdolecek 	}
    248  1.1  jdolecek 
    249  1.1  jdolecek 	return (bus->ppbus_read(dev->dv_parent, buf, len, how, cnt));
    250  1.1  jdolecek }
    251  1.1  jdolecek 
    252  1.1  jdolecek /* Reset the EPP timeout bit in the status register */
    253  1.1  jdolecek int
    254  1.1  jdolecek ppbus_reset_epp_timeout(struct device * dev)
    255  1.1  jdolecek {
    256  1.1  jdolecek 	struct ppbus_softc * bus = (struct ppbus_softc *) dev;
    257  1.1  jdolecek 
    258  1.1  jdolecek 	if(bus->sc_capabilities & PPBUS_HAS_EPP) {
    259  1.1  jdolecek 		bus->ppbus_reset_epp_timeout(dev->dv_parent);
    260  1.1  jdolecek 		return 0;
    261  1.1  jdolecek 	}
    262  1.1  jdolecek 	else {
    263  1.1  jdolecek 		return ENODEV;
    264  1.1  jdolecek 	}
    265  1.1  jdolecek }
    266  1.1  jdolecek 
    267  1.1  jdolecek /* Wait for the ECP FIFO to be empty */
    268  1.1  jdolecek int
    269  1.1  jdolecek ppbus_ecp_sync(struct device * dev)
    270  1.1  jdolecek {
    271  1.1  jdolecek 	struct ppbus_softc * bus = (struct ppbus_softc *) dev;
    272  1.1  jdolecek 
    273  1.1  jdolecek 	if(bus->sc_capabilities & PPBUS_HAS_ECP) {
    274  1.1  jdolecek 		bus->ppbus_ecp_sync(dev->dv_parent);
    275  1.1  jdolecek 		return 0;
    276  1.1  jdolecek 	}
    277  1.1  jdolecek 	else {
    278  1.1  jdolecek 		return ENODEV;
    279  1.1  jdolecek 	}
    280  1.1  jdolecek }
    281  1.1  jdolecek 
    282  1.1  jdolecek /* Allocate DMA for use with ppbus */
    283  1.1  jdolecek int
    284  1.1  jdolecek ppbus_dma_malloc(struct device * dev, caddr_t * buf, bus_addr_t * addr,
    285  1.1  jdolecek 	bus_size_t size)
    286  1.1  jdolecek {
    287  1.1  jdolecek 	struct ppbus_softc * ppbus = (struct ppbus_softc *) dev;
    288  1.1  jdolecek 
    289  1.1  jdolecek 	if(ppbus->sc_capabilities & PPBUS_HAS_DMA)
    290  1.1  jdolecek 		return (ppbus->ppbus_dma_malloc(dev->dv_parent, buf, addr,
    291  1.1  jdolecek 			size));
    292  1.1  jdolecek 	else
    293  1.1  jdolecek 		return ENODEV;
    294  1.1  jdolecek }
    295  1.1  jdolecek 
    296  1.1  jdolecek /* Free memory allocated with ppbus_dma_malloc() */
    297  1.1  jdolecek int
    298  1.1  jdolecek ppbus_dma_free(struct device * dev, caddr_t * buf, bus_addr_t * addr,
    299  1.1  jdolecek 	bus_size_t size)
    300  1.1  jdolecek {
    301  1.1  jdolecek 	struct ppbus_softc * ppbus = (struct ppbus_softc *) dev;
    302  1.1  jdolecek 
    303  1.1  jdolecek 	if(ppbus->sc_capabilities & PPBUS_HAS_DMA) {
    304  1.1  jdolecek 		ppbus->ppbus_dma_free(dev->dv_parent, buf, addr, size);
    305  1.1  jdolecek 		return 0;
    306  1.1  jdolecek 	}
    307  1.1  jdolecek 	else {
    308  1.1  jdolecek 		return ENODEV;
    309  1.1  jdolecek 	}
    310  1.1  jdolecek }
    311  1.1  jdolecek 
    312  1.1  jdolecek /* Install a handler to be called by hardware interrupt handler */
    313  1.1  jdolecek int ppbus_add_handler(struct device * dev, void (*func)(void *), void * arg)
    314  1.1  jdolecek {
    315  1.1  jdolecek 	struct ppbus_softc * bus = (struct ppbus_softc *) dev;
    316  1.1  jdolecek 
    317  1.1  jdolecek 	if(bus->sc_capabilities & PPBUS_HAS_INTR)
    318  1.1  jdolecek 		return bus->ppbus_add_handler(dev->dv_parent, func, arg);
    319  1.1  jdolecek 	else
    320  1.1  jdolecek 		return ENODEV;
    321  1.1  jdolecek }
    322  1.1  jdolecek 
    323  1.1  jdolecek /* Remove a handler registered with ppbus_add_handler() */
    324  1.1  jdolecek int ppbus_remove_handler(struct device * dev, void (*func)(void *))
    325  1.1  jdolecek {
    326  1.1  jdolecek 	struct ppbus_softc * bus = (struct ppbus_softc *) dev;
    327  1.1  jdolecek 
    328  1.1  jdolecek 	if(bus->sc_capabilities & PPBUS_HAS_INTR)
    329  1.1  jdolecek 		return bus->ppbus_remove_handler(dev->dv_parent, func);
    330  1.1  jdolecek 	else
    331  1.1  jdolecek 		return ENODEV;
    332  1.1  jdolecek }
    333  1.1  jdolecek 
    334  1.1  jdolecek /*
    335  1.1  jdolecek  * ppbus_get_status()
    336  1.1  jdolecek  *
    337  1.1  jdolecek  * Read the status register and update the status info
    338  1.1  jdolecek  */
    339  1.1  jdolecek int
    340  1.1  jdolecek ppbus_get_status(struct device * dev, struct ppbus_status * status)
    341  1.1  jdolecek {
    342  1.1  jdolecek 	register char r = status->status = ppbus_rstr(dev);
    343  1.1  jdolecek 
    344  1.1  jdolecek 	status->timeout	= r & TIMEOUT;
    345  1.1  jdolecek 	status->error	= !(r & nFAULT);
    346  1.1  jdolecek 	status->select	= r & SELECT;
    347  1.1  jdolecek 	status->paper_end = r & PERROR;
    348  1.1  jdolecek 	status->ack	= !(r & nACK);
    349  1.1  jdolecek 	status->busy	= !(r & nBUSY);
    350  1.1  jdolecek 
    351  1.1  jdolecek 	return (0);
    352  1.1  jdolecek }
    353  1.1  jdolecek 
    354  1.1  jdolecek /* Allocate the device to perform transfers */
    355  1.1  jdolecek int
    356  1.1  jdolecek ppbus_request_bus(struct device * dev, struct device * busdev, int how,
    357  1.1  jdolecek 	unsigned int timeout)
    358  1.1  jdolecek {
    359  1.1  jdolecek 	struct ppbus_softc * bus = (struct ppbus_softc *) dev;
    360  1.1  jdolecek 	unsigned int counter = timeout;
    361  1.1  jdolecek 	int priority = PPBUSPRI;
    362  1.1  jdolecek 	int error;
    363  1.1  jdolecek 
    364  1.1  jdolecek 	if(how & PPBUS_INTR)
    365  1.1  jdolecek 		priority |= PCATCH;
    366  1.1  jdolecek 
    367  1.1  jdolecek 	/* Loop until lock acquired (if PPBUS_WAIT) or an error occurs */
    368  1.1  jdolecek 	for(;;) {
    369  1.1  jdolecek 		error = lockmgr(&(bus->sc_lock), LK_EXCLUSIVE | LK_RECURSEFAIL,
    370  1.1  jdolecek 			NULL);
    371  1.1  jdolecek 		if(!error)
    372  1.1  jdolecek 			break;
    373  1.1  jdolecek 
    374  1.1  jdolecek 		if(how & PPBUS_WAIT) {
    375  1.1  jdolecek 			error = ltsleep(bus, priority, __func__, hz/2, NULL);
    376  1.1  jdolecek 			counter -= (hz/2);
    377  1.1  jdolecek 			if(!(error))
    378  1.1  jdolecek 				continue;
    379  1.1  jdolecek 			else if(error != EWOULDBLOCK)
    380  1.1  jdolecek 				goto end;
    381  1.1  jdolecek 			if(counter == 0) {
    382  1.1  jdolecek 				error = ETIMEDOUT;
    383  1.1  jdolecek 				goto end;
    384  1.1  jdolecek 			}
    385  1.1  jdolecek 		}
    386  1.1  jdolecek 		else {
    387  1.1  jdolecek 			goto end;
    388  1.1  jdolecek 		}
    389  1.1  jdolecek 	}
    390  1.1  jdolecek 
    391  1.1  jdolecek 	/* Set bus owner or return error if bus is taken */
    392  1.1  jdolecek 	if(bus->ppbus_owner == NULL) {
    393  1.1  jdolecek 		bus->ppbus_owner = busdev;
    394  1.1  jdolecek 		error = 0;
    395  1.1  jdolecek 	}
    396  1.1  jdolecek 	else {
    397  1.1  jdolecek 		error = EBUSY;
    398  1.1  jdolecek 	}
    399  1.1  jdolecek 
    400  1.1  jdolecek 	/* Release lock */
    401  1.1  jdolecek 	lockmgr(&(bus->sc_lock), LK_RELEASE, NULL);
    402  1.1  jdolecek 
    403  1.1  jdolecek end:
    404  1.1  jdolecek 	return error;
    405  1.1  jdolecek }
    406  1.1  jdolecek 
    407  1.1  jdolecek /* Release the device allocated with ppbus_request_bus() */
    408  1.1  jdolecek int
    409  1.1  jdolecek ppbus_release_bus(struct device * dev, struct device * busdev, int how,
    410  1.1  jdolecek 	unsigned int timeout)
    411  1.1  jdolecek {
    412  1.1  jdolecek 	struct ppbus_softc * bus = (struct ppbus_softc *) dev;
    413  1.1  jdolecek 	unsigned int counter = timeout;
    414  1.1  jdolecek 	int priority = PPBUSPRI;
    415  1.1  jdolecek 	int error;
    416  1.1  jdolecek 
    417  1.1  jdolecek 	if(how & PPBUS_INTR)
    418  1.1  jdolecek 		priority |= PCATCH;
    419  1.1  jdolecek 
    420  1.1  jdolecek 	/* Loop until lock acquired (if PPBUS_WAIT) or an error occurs */
    421  1.1  jdolecek 	for(;;) {
    422  1.1  jdolecek 		error = lockmgr(&(bus->sc_lock), LK_EXCLUSIVE | LK_RECURSEFAIL,
    423  1.1  jdolecek 			NULL);
    424  1.1  jdolecek 		if(!error)
    425  1.1  jdolecek 			break;
    426  1.1  jdolecek 
    427  1.1  jdolecek 		if(how & PPBUS_WAIT) {
    428  1.1  jdolecek 			error = ltsleep(bus, priority, __func__, hz/2, NULL);
    429  1.1  jdolecek 			counter -= (hz/2);
    430  1.1  jdolecek 			if(!(error))
    431  1.1  jdolecek 				continue;
    432  1.1  jdolecek 			else if(error != EWOULDBLOCK)
    433  1.1  jdolecek 				goto end;
    434  1.1  jdolecek 			if(counter == 0) {
    435  1.1  jdolecek 				error = ETIMEDOUT;
    436  1.1  jdolecek 				goto end;
    437  1.1  jdolecek 			}
    438  1.1  jdolecek 		}
    439  1.1  jdolecek 		else {
    440  1.1  jdolecek 			goto end;
    441  1.1  jdolecek 		}
    442  1.1  jdolecek 	}
    443  1.1  jdolecek 
    444  1.1  jdolecek 	/* If the device is the owner, release bus */
    445  1.1  jdolecek 	if(bus->ppbus_owner != busdev) {
    446  1.1  jdolecek 		error = EINVAL;
    447  1.1  jdolecek 	}
    448  1.1  jdolecek 	else {
    449  1.1  jdolecek 		bus->ppbus_owner = NULL;
    450  1.1  jdolecek 		error = 0;
    451  1.1  jdolecek 	}
    452  1.1  jdolecek 
    453  1.1  jdolecek 	/* Release lock */
    454  1.1  jdolecek 	lockmgr(&(bus->sc_lock), LK_RELEASE, NULL);
    455  1.1  jdolecek 
    456  1.1  jdolecek end:
    457  1.1  jdolecek 	return error;
    458  1.1  jdolecek }
    459  1.1  jdolecek 
    460  1.1  jdolecek 
    461  1.1  jdolecek /* IEEE 1284-based probes */
    462  1.1  jdolecek 
    463  1.1  jdolecek #ifndef DONTPROBE_1284
    464  1.1  jdolecek 
    465  1.1  jdolecek static char *pnp_tokens[] = {
    466  1.1  jdolecek 	"PRINTER", "MODEM", "NET", "HDC", "PCMCIA", "MEDIA",
    467  1.1  jdolecek 	"FDC", "PORTS", "SCANNER", "DIGICAM", "", NULL };
    468  1.1  jdolecek 
    469  1.1  jdolecek /* ??? */
    470  1.1  jdolecek #if 0
    471  1.1  jdolecek static char *pnp_classes[] = {
    472  1.1  jdolecek 	"printer", "modem", "network device",
    473  1.1  jdolecek 	"hard disk", "PCMCIA", "multimedia device",
    474  1.1  jdolecek 	"floppy disk", "ports", "scanner",
    475  1.1  jdolecek 	"digital camera", "unknown device", NULL };
    476  1.1  jdolecek #endif
    477  1.1  jdolecek 
    478  1.1  jdolecek /*
    479  1.1  jdolecek  * Search the first occurence of a token within a string
    480  1.1  jdolecek  * XXX should use strxxx() calls
    481  1.1  jdolecek  */
    482  1.1  jdolecek static char *
    483  1.1  jdolecek search_token(char *str, int slen, char *token)
    484  1.1  jdolecek {
    485  1.1  jdolecek 	char *p;
    486  1.1  jdolecek 	int tlen, i, j;
    487  1.1  jdolecek 
    488  1.1  jdolecek #define UNKNOWN_LENGTH  -1
    489  1.1  jdolecek 
    490  1.1  jdolecek 	if (slen == UNKNOWN_LENGTH)
    491  1.1  jdolecek 	       /* get string's length */
    492  1.1  jdolecek 	       for (slen = 0, p = str; *p != '\0'; p++)
    493  1.1  jdolecek 		       slen ++;
    494  1.1  jdolecek 
    495  1.1  jdolecek        /* get token's length */
    496  1.1  jdolecek        for (tlen = 0, p = token; *p != '\0'; p++)
    497  1.1  jdolecek 	       tlen ++;
    498  1.1  jdolecek 
    499  1.1  jdolecek        if (tlen == 0)
    500  1.1  jdolecek 	       return (str);
    501  1.1  jdolecek 
    502  1.1  jdolecek        for (i = 0; i <= slen-tlen; i++) {
    503  1.1  jdolecek 	       for (j = 0; j < tlen; j++)
    504  1.1  jdolecek 		       if (str[i+j] != token[j])
    505  1.1  jdolecek 			       break;
    506  1.1  jdolecek 	       if (j == tlen)
    507  1.1  jdolecek 		       return (&str[i]);
    508  1.1  jdolecek        }
    509  1.1  jdolecek 
    510  1.1  jdolecek 	return (NULL);
    511  1.1  jdolecek }
    512  1.1  jdolecek 
    513  1.1  jdolecek /* Stores the class ID of the peripherial in soft config data */
    514  1.1  jdolecek void
    515  1.1  jdolecek ppbus_pnp_detect(struct device * dev)
    516  1.1  jdolecek {
    517  1.1  jdolecek 	struct ppbus_softc * bus = (struct ppbus_softc *) dev;
    518  1.1  jdolecek 	int i;
    519  1.1  jdolecek 	int error;
    520  1.1  jdolecek 	size_t len = 0;
    521  1.1  jdolecek 	size_t str_sz = 0;
    522  1.1  jdolecek 	char * str = NULL;
    523  1.1  jdolecek 	char * class = NULL;
    524  1.1  jdolecek 	char * token;
    525  1.1  jdolecek 
    526  1.1  jdolecek #ifdef PPBUS_VERBOSE
    527  1.1  jdolecek 	printf("%s: Probing for PnP devices.\n", dev->dv_xname);
    528  1.1  jdolecek #endif
    529  1.1  jdolecek 
    530  1.1  jdolecek 	error = ppbus_1284_read_id(dev, PPBUS_NIBBLE, &str, &str_sz, &len);
    531  1.1  jdolecek 	if(str_sz != len) {
    532  1.1  jdolecek #ifdef DEBUG_1284
    533  1.1  jdolecek 		printf("%s(%s): device returned less characters than expected "
    534  1.1  jdolecek 			"in device ID.\n", __func__, dev->dv_xname);
    535  1.1  jdolecek #endif
    536  1.1  jdolecek 	}
    537  1.1  jdolecek 	if(error) {
    538  1.1  jdolecek 		printf("%s: Error getting device ID (errno = %d)\n",
    539  1.1  jdolecek 			dev->dv_xname, error);
    540  1.1  jdolecek 		goto end_detect;
    541  1.1  jdolecek 	}
    542  1.1  jdolecek 
    543  1.1  jdolecek #ifdef DEBUG_1284
    544  1.1  jdolecek 	printf("%s: <PnP> %d characters: ", dev->dv_xname, len);
    545  1.1  jdolecek 	for (i = 0; i < len; i++)
    546  1.1  jdolecek 		printf("%c(0x%x) ", str[i], str[i]);
    547  1.1  jdolecek 	printf("\n");
    548  1.1  jdolecek #endif
    549  1.1  jdolecek 
    550  1.1  jdolecek 	/* replace ';' characters by '\0' */
    551  1.1  jdolecek 	for (i = 0; i < len; i++)
    552  1.1  jdolecek 		if(str[i] == ';') str[i] = '\0';
    553  1.1  jdolecek 		/* str[i] = (str[i] == ';') ? '\0' : str[i]; */
    554  1.1  jdolecek 
    555  1.1  jdolecek 	if ((token = search_token(str, len, "MFG")) != NULL ||
    556  1.1  jdolecek 		(token = search_token(str, len, "MANUFACTURER")) != NULL)
    557  1.1  jdolecek 		printf("%s: <%s", dev->dv_xname,
    558  1.1  jdolecek 			search_token(token, UNKNOWN_LENGTH, ":") + 1);
    559  1.1  jdolecek 	else
    560  1.1  jdolecek 		printf("%s: <unknown", dev->dv_xname);
    561  1.1  jdolecek 
    562  1.1  jdolecek 	if ((token = search_token(str, len, "MDL")) != NULL ||
    563  1.1  jdolecek 		(token = search_token(str, len, "MODEL")) != NULL)
    564  1.1  jdolecek 		printf(" %s",
    565  1.1  jdolecek 			search_token(token, UNKNOWN_LENGTH, ":") + 1);
    566  1.1  jdolecek 
    567  1.1  jdolecek 	if ((token = search_token(str, len, "REV")) != NULL)
    568  1.1  jdolecek 		printf(".%s",
    569  1.1  jdolecek 			search_token(token, UNKNOWN_LENGTH, ":") + 1);
    570  1.1  jdolecek 
    571  1.1  jdolecek 	printf(">");
    572  1.1  jdolecek 
    573  1.1  jdolecek 	if ((token = search_token(str, len, "CLS")) != NULL) {
    574  1.1  jdolecek 		class = search_token(token, UNKNOWN_LENGTH, ":") + 1;
    575  1.1  jdolecek 		printf(" %s", class);
    576  1.1  jdolecek 	}
    577  1.1  jdolecek 
    578  1.1  jdolecek 	if ((token = search_token(str, len, "CMD")) != NULL ||
    579  1.1  jdolecek 		(token = search_token(str, len, "COMMAND")) != NULL)
    580  1.1  jdolecek 		printf(" %s",
    581  1.1  jdolecek 			search_token(token, UNKNOWN_LENGTH, ":") + 1);
    582  1.1  jdolecek 
    583  1.1  jdolecek 	printf("\n");
    584  1.1  jdolecek 
    585  1.1  jdolecek 	if (class) {
    586  1.1  jdolecek 		/* identify class ident */
    587  1.1  jdolecek 		for (i = 0; pnp_tokens[i] != NULL; i++) {
    588  1.1  jdolecek 			if (search_token(class, len, pnp_tokens[i]) != NULL) {
    589  1.1  jdolecek 				bus->sc_class_id = i;
    590  1.1  jdolecek 				goto end_detect;
    591  1.1  jdolecek 			}
    592  1.1  jdolecek 		}
    593  1.1  jdolecek 	}
    594  1.1  jdolecek 	bus->sc_class_id = PPBUS_PNP_UNKNOWN;
    595  1.1  jdolecek 
    596  1.1  jdolecek end_detect:
    597  1.1  jdolecek 	if(str)
    598  1.1  jdolecek 		free(str, M_DEVBUF);
    599  1.1  jdolecek         return;
    600  1.1  jdolecek }
    601  1.1  jdolecek 
    602  1.1  jdolecek /* Scan the ppbus for IEEE1284 compliant devices */
    603  1.1  jdolecek int
    604  1.1  jdolecek ppbus_scan_bus(struct device * dev)
    605  1.1  jdolecek {
    606  1.1  jdolecek 	struct ppbus_softc * bus = (struct ppbus_softc *) dev;
    607  1.1  jdolecek 	int error;
    608  1.1  jdolecek 
    609  1.1  jdolecek 	/* Try IEEE1284 modes, one device only (no IEEE1284.3 support) */
    610  1.1  jdolecek 
    611  1.1  jdolecek 	error = ppbus_1284_negociate(dev, PPBUS_NIBBLE, 0);
    612  1.1  jdolecek 	if(!(error))
    613  1.1  jdolecek 		printf("/NIBBLE");
    614  1.1  jdolecek 	else if((bus->sc_1284_state == PPBUS_ERROR) && (bus->sc_1284_error ==
    615  1.1  jdolecek 		PPBUS_NOT_IEEE1284))
    616  1.1  jdolecek 		goto end_scan;
    617  1.1  jdolecek 	ppbus_1284_terminate(dev);
    618  1.1  jdolecek 
    619  1.1  jdolecek 	error = ppbus_1284_negociate(dev, PPBUS_PS2, 0);
    620  1.1  jdolecek 	if(!(error))
    621  1.1  jdolecek 		printf("/PS2");
    622  1.1  jdolecek 	ppbus_1284_terminate(dev);
    623  1.1  jdolecek 
    624  1.1  jdolecek 	error = ppbus_1284_negociate(dev, PPBUS_ECP, 0);
    625  1.1  jdolecek 	if(!(error))
    626  1.1  jdolecek 		printf("/ECP");
    627  1.1  jdolecek 	ppbus_1284_terminate(dev);
    628  1.1  jdolecek 
    629  1.1  jdolecek 	error = ppbus_1284_negociate(dev, PPBUS_ECP, PPBUS_USE_RLE);
    630  1.1  jdolecek 	if(!(error))
    631  1.1  jdolecek 		printf("/ECP_RLE");
    632  1.1  jdolecek 	ppbus_1284_terminate(dev);
    633  1.1  jdolecek 
    634  1.1  jdolecek 	error = ppbus_1284_negociate(dev, PPBUS_EPP, 0);
    635  1.1  jdolecek 	if(!(error))
    636  1.1  jdolecek 		printf("/EPP");
    637  1.1  jdolecek 	ppbus_1284_terminate(dev);
    638  1.1  jdolecek 
    639  1.1  jdolecek 	printf("\n");
    640  1.1  jdolecek 
    641  1.1  jdolecek 	return 0;
    642  1.1  jdolecek 
    643  1.1  jdolecek end_scan:
    644  1.1  jdolecek 	return error;
    645  1.1  jdolecek }
    646  1.1  jdolecek 
    647  1.1  jdolecek #endif /* !DONTPROBE_1284 */
    648  1.1  jdolecek 
    649