diff options
Diffstat (limited to 'sys/dev/ppbus/ppb_1284.c')
-rw-r--r-- | sys/dev/ppbus/ppb_1284.c | 163 |
1 files changed, 163 insertions, 0 deletions
diff --git a/sys/dev/ppbus/ppb_1284.c b/sys/dev/ppbus/ppb_1284.c new file mode 100644 index 0000000..5fef52a --- /dev/null +++ b/sys/dev/ppbus/ppb_1284.c @@ -0,0 +1,163 @@ +/*- + * Copyright (c) 1997 Nicolas Souchu + * All rights reserved. + * + * Redistribution and use in source and binary forms, with or without + * modification, are permitted provided that the following conditions + * are met: + * 1. Redistributions of source code must retain the above copyright + * notice, this list of conditions and the following disclaimer. + * 2. Redistributions in binary form must reproduce the above copyright + * notice, this list of conditions and the following disclaimer in the + * documentation and/or other materials provided with the distribution. + * + * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND + * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE + * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE + * ARE DISCLAIMED. IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE + * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL + * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS + * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) + * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT + * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY + * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF + * SUCH DAMAGE. + * + * $Id$ + * + */ +#include <sys/param.h> +#include <sys/systm.h> +#include <sys/errno.h> +#include <sys/conf.h> +#include <sys/proc.h> +#include <sys/buf.h> +#include <sys/kernel.h> +#include <sys/malloc.h> +#include <sys/uio.h> +#include <sys/syslog.h> + +#include <machine/clock.h> + +#include <dev/ppbus/ppbconf.h> +#include <dev/ppbus/ppb_1284.h> + +/* + * nibble_1284_wait() + * + * Wait for the peripherial up to 40ms + */ +int +nibble_1284_wait(struct ppb_device *dev, char mask, char status) +{ + int i; + + return (ppb_poll_device(dev, 4, mask, status, PPB_NOINTR)); +} + +#define nibble2char(s) (((s & ~nACK) >> 3) | (~s & nBUSY) >> 4) + +/* + * nibble_1284_inbyte() + * + * Read data in NIBBLE mode + */ +int +nibble_1284_inbyte(struct ppb_device *dev, char *buffer) +{ + char nibble[2], r; + int i, error; + + r = ppb_rctr(dev); + + for (i = 0; i < 2; i++) { + /* ready to take data (nAUTO low) */ + ppb_wctr(dev, r | AUTOFEED); + + if ((error = nibble_1284_wait(dev, nACK, 0))) { + ppb_wctr(dev, r); + return (error); + } + + /* read nibble */ + nibble[i] = ppb_rstr(dev); + +#ifdef DEBUG_1284 + printf("nibble_1284_inbyte: nibble[%d]=0x%x\n", i, nibble[i]); +#endif + + /* ack, not ready for another nibble */ + ppb_wctr(dev, r & ~AUTOFEED); + + /* wait ack from peripherial */ + if ((error = nibble_1284_wait(dev, nACK, nACK))) { + ppb_wctr(dev, r); + return (error); + } + } + + *buffer = ((nibble2char(nibble[1]) << 4) & 0xf0) | + (nibble2char(nibble[0]) & 0x0f); + +#ifdef DEBUG_1284 + printf("nibble_1284_inbyte: byte=0x%x\n", *buffer); +#endif + + return (0); +} + +/* + * nibble_1284_sync() + */ +void +nibble_1284_sync(struct ppb_device *dev) +{ + char ctr; + + ctr = ppb_rctr(dev); + + ppb_wctr(dev, (ctr & ~AUTOFEED) | SELECTIN); + if (nibble_1284_wait(dev, nACK, 0)) + return; + + ppb_wctr(dev, ctr | AUTOFEED); + nibble_1284_wait(dev, nACK, nACK); + + ppb_wctr(dev, (ctr & ~AUTOFEED) | SELECTIN); + + return; +} + +/* + * nibble_1284_mode() + * + * Normal nibble mode or request device id mode (see ppb_1284.h) + */ +int +nibble_1284_mode(struct ppb_device *dev, int mode) +{ + char ctrl; + int error; + + ctrl = ppb_rctr(dev); + + ppb_wdtr(dev, mode); + DELAY(5); + + ppb_wctr(dev, (ctrl & ~SELECTIN) | AUTOFEED); + if ((error = nibble_1284_wait(dev, nACK | ERROR | SELECT | nFAULT, + ERROR | SELECT | nFAULT))) { + ppb_wctr(dev, ctrl); + return (error); + } + + ppb_wctr(dev, ppb_rctr(dev) | STROBE); + DELAY(5); + + ppb_wctr(dev, ppb_rctr(dev) & ~STROBE); + DELAY(5); + + ppb_wctr(dev, ppb_rctr(dev) & ~AUTOFEED); + + return (0); +} |