156 lines
3.6 KiB
C
156 lines
3.6 KiB
C
/*-
|
|
* 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: ppb_1284.c,v 1.1 1997/08/16 14:05:32 msmith Exp $
|
|
*
|
|
*/
|
|
#include <sys/param.h>
|
|
#include <sys/systm.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);
|
|
}
|