summaryrefslogtreecommitdiffstats
path: root/sys/dev/ppbus/vpoio.c
diff options
context:
space:
mode:
authormsmith <msmith@FreeBSD.org>1998-08-03 19:14:33 +0000
committermsmith <msmith@FreeBSD.org>1998-08-03 19:14:33 +0000
commit2fdb23234a18b64b994328bb4be606a420e3b56d (patch)
treef8a4d5d9ba99cb367e9263ec96d08ecb8919f529 /sys/dev/ppbus/vpoio.c
parentcfef94c8ca2347c78a745676fe6061eb1f172be7 (diff)
downloadFreeBSD-src-2fdb23234a18b64b994328bb4be606a420e3b56d.zip
FreeBSD-src-2fdb23234a18b64b994328bb4be606a420e3b56d.tar.gz
Major ppbus updates from the author.
- ppbus now supports PLIP via the if_plip driver - ieee1284 infrastructure added, including parallel-port PnP - port microsequencer added, for scripting the sort of port I/O that is common with parallel devices without endless calls up and down through the driver structure. - improved bus ownership behaviour among the ppbus-using drivers. - improved I/O chipset feature detection The vpo driver is now implemented using the microsequencer, leading to some performance improvements as well as providing an extensive example of its use. Reviewed by: msmith Submitted by: Nicolas Souchu <Nicolas.Souchu@prism.uvsq.fr>
Diffstat (limited to 'sys/dev/ppbus/vpoio.c')
-rw-r--r--sys/dev/ppbus/vpoio.c771
1 files changed, 771 insertions, 0 deletions
diff --git a/sys/dev/ppbus/vpoio.c b/sys/dev/ppbus/vpoio.c
new file mode 100644
index 0000000..c853846
--- /dev/null
+++ b/sys/dev/ppbus/vpoio.c
@@ -0,0 +1,771 @@
+/*-
+ * Copyright (c) 1998 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: vpoio.c,v 1.1.2.4 1998/06/16 23:35:52 son Exp $
+ *
+ */
+
+#ifdef KERNEL
+#include <sys/param.h>
+#include <sys/systm.h>
+#include <sys/malloc.h>
+#include <sys/buf.h>
+
+#include <machine/clock.h>
+
+#endif /* KERNEL */
+
+#ifdef KERNEL
+#include <sys/kernel.h>
+#endif /*KERNEL */
+
+#include <dev/ppbus/ppbconf.h>
+#include <dev/ppbus/ppb_msq.h>
+#include <dev/ppbus/vpoio.h>
+
+/*
+ * The driver pools the drive. We may add a timeout queue to avoid
+ * active polling on nACK. I've tried this but it leads to unreliable
+ * transfers
+ */
+#define VP0_SELTMO 5000 /* select timeout */
+#define VP0_FAST_SPINTMO 500000 /* wait status timeout */
+#define VP0_LOW_SPINTMO 5000000 /* wait status timeout */
+
+/*
+ * Actually, VP0 timings are more accurate (about few 16MHZ cycles),
+ * but succeeding in respecting such timings leads to architecture
+ * dependent considerations.
+ */
+#define VP0_PULSE 1
+
+#define VP0_SECTOR_SIZE 512
+#define VP0_BUFFER_SIZE 0x12000
+
+#define n(flags) (~(flags) & (flags))
+
+/*
+ * VP0 connections.
+ */
+#define H_AUTO n(AUTOFEED)
+#define H_nAUTO AUTOFEED
+#define H_STROBE n(STROBE)
+#define H_nSTROBE STROBE
+#define H_BSY n(nBUSY)
+#define H_nBSY nBUSY
+#define H_SEL SELECT
+#define H_nSEL n(SELECT)
+#define H_ERR ERROR
+#define H_nERR n(ERROR)
+#define H_ACK nACK
+#define H_nACK n(nACK)
+#define H_FLT nFAULT
+#define H_nFLT n(nFAULT)
+#define H_SELIN n(SELECTIN)
+#define H_nSELIN SELECTIN
+#define H_INIT nINIT
+#define H_nINIT n(nINIT)
+
+/*
+ * Microcode to execute very fast I/O sequences at the lowest bus level.
+ */
+
+#define trig_d_pulse MS_TRIG(MS_REG_CTR,5,(int)d_pulse)
+char d_pulse[] = {
+ H_AUTO | H_nSELIN | H_INIT | H_STROBE, 0,
+ H_nAUTO | H_nSELIN | H_INIT | H_STROBE, VP0_PULSE,
+ H_AUTO | H_nSELIN | H_INIT | H_STROBE, 0,
+ H_AUTO | H_SELIN | H_INIT | H_STROBE, VP0_PULSE,
+ H_AUTO | H_nSELIN | H_INIT | H_STROBE, VP0_PULSE
+};
+
+#define trig_c_pulse MS_TRIG(MS_REG_CTR,5,(int)c_pulse)
+char c_pulse[] = {
+ H_AUTO | H_nSELIN | H_INIT | H_STROBE, 0,
+ H_AUTO | H_SELIN | H_INIT | H_STROBE, 0,
+ H_nAUTO | H_SELIN | H_INIT | H_STROBE, VP0_PULSE,
+ H_AUTO | H_SELIN | H_INIT | H_STROBE, 0,
+ H_AUTO | H_nSELIN | H_INIT | H_STROBE, VP0_PULSE
+};
+
+struct ppb_microseq disconnect_microseq[] = {
+ MS_DASS(0x0), trig_d_pulse, MS_DASS(0x3c), trig_d_pulse,
+ MS_DASS(0x20), trig_d_pulse, MS_DASS(0xf), trig_d_pulse, MS_RET(0)
+};
+
+struct ppb_microseq connect_epp_microseq[] = {
+ MS_DASS(0x0), trig_c_pulse, MS_DASS(0x3c), trig_c_pulse,
+ MS_DASS(0x20), trig_c_pulse, MS_DASS(0xcf), trig_c_pulse, MS_RET(0)
+};
+
+struct ppb_microseq connect_spp_microseq[] = {
+ MS_DASS(0x0), trig_c_pulse, MS_DASS(0x3c), trig_c_pulse,
+ MS_DASS(0x20), trig_c_pulse, MS_DASS(0x8f), trig_c_pulse, MS_RET(0)
+};
+
+/*
+ * nibble_inbyte_hook()
+ *
+ * Formats high and low nibble into a character
+ */
+static int
+nibble_inbyte_hook (void *p, char *ptr)
+{
+ struct vpo_nibble *s = (struct vpo_nibble *)p;
+
+ /* increment the buffer pointer */
+ *ptr++ = ((s->l >> 4) & 0x0f) + (s->h & 0xf0);
+
+ return (0);
+}
+
+/*
+ * Macro used to initialize each vpoio_data structure during
+ * low level attachment
+ */
+#define INIT_NIBBLE_INBYTE_SUBMICROSEQ(vpo) { \
+ (vpo)->vpo_nibble_inbyte_msq[2].arg[2].p = \
+ (void *)&(vpo)->vpo_nibble.h; \
+ (vpo)->vpo_nibble_inbyte_msq[4].arg[2].p = \
+ (void *)&(vpo)->vpo_nibble.l; \
+ (vpo)->vpo_nibble_inbyte_msq[5].arg[0].f = \
+ nibble_inbyte_hook; \
+ (vpo)->vpo_nibble_inbyte_msq[5].arg[1].p = \
+ (void *)&(vpo)->vpo_nibble; \
+}
+
+/*
+ * This is the sub-microseqence for MS_GET in NIBBLE mode
+ * Retrieve the two nibbles and call the C function to generate the character
+ * and store it in the buffer (see nibble_inbyte_hook())
+ */
+struct ppb_microseq nibble_inbyte_submicroseq[] = {
+
+/* loop: */
+ MS_CASS( H_AUTO | H_SELIN | H_INIT | H_STROBE),
+ MS_DELAY(VP0_PULSE),
+ MS_RFETCH(MS_REG_STR, MS_FETCH_ALL, MS_UNKNOWN /* high nibble */),
+ MS_CASS(H_nAUTO | H_SELIN | H_INIT | H_STROBE),
+ MS_RFETCH(MS_REG_STR, MS_FETCH_ALL, MS_UNKNOWN /* low nibble */),
+
+ /* do a C call to format the received nibbles */
+ MS_C_CALL(MS_UNKNOWN /* C hook */, MS_UNKNOWN /* param */),
+ MS_DBRA(-6 /* loop */),
+
+ MS_CASS(H_AUTO | H_nSELIN | H_INIT | H_STROBE),
+ MS_RET(0)
+};
+
+/*
+ * This is the sub-microseqence for MS_GET in PS2 mode
+ */
+struct ppb_microseq ps2_inbyte_submicroseq[] = {
+ MS_CASS(PCD | H_AUTO | H_SELIN | H_INIT | H_nSTROBE),
+
+/* loop: */
+ MS_RFETCH_P(1, MS_REG_DTR, MS_FETCH_ALL),
+ MS_CASS(PCD | H_nAUTO | H_SELIN | H_INIT | H_nSTROBE),
+ MS_CASS(PCD | H_AUTO | H_SELIN | H_INIT | H_nSTROBE),
+ MS_DBRA(-3 /* loop */),
+
+ MS_CASS(H_AUTO | H_nSELIN | H_INIT | H_STROBE),
+ MS_RET(0)
+};
+
+/*
+ * This is the sub-microsequence for MS_PUT in both NIBBLE and PS2 modes
+ */
+struct ppb_microseq spp_outbyte_submicroseq[] = {
+
+/* loop: */
+ MS_RASSERT_P(1, MS_REG_DTR),
+ MS_CASS(H_nAUTO | H_nSELIN | H_INIT | H_STROBE),
+ MS_CASS( H_AUTO | H_nSELIN | H_INIT | H_STROBE),
+ MS_DELAY(VP0_PULSE),
+ MS_DBRA(-4 /* loop */),
+
+ /* return from the put call */
+ MS_RET(0)
+};
+
+/* EPP 1.7 microsequences, ptr and len set at runtime */
+struct ppb_microseq epp17_outstr_body[] = {
+ MS_CASS(H_AUTO | H_SELIN | H_INIT | H_STROBE),
+
+/* loop: */
+ MS_RASSERT_P(1, MS_REG_EPP),
+ MS_BRSET(TIMEOUT, 4 /* error */), /* EPP timeout? */
+ MS_DBRA(-2 /* loop */),
+
+ MS_CASS(H_AUTO | H_nSELIN | H_INIT | H_STROBE),
+ MS_RET(0),
+/* error: */
+ MS_CASS(H_AUTO | H_nSELIN | H_INIT | H_STROBE),
+ MS_RET(1)
+};
+
+struct ppb_microseq epp17_instr_body[] = {
+ MS_CASS(PCD | H_AUTO | H_SELIN | H_INIT | H_STROBE),
+
+/* loop: */
+ MS_RFETCH_P(1, MS_REG_EPP, MS_FETCH_ALL),
+ MS_BRSET(TIMEOUT, 4 /* error */), /* EPP timeout? */
+ MS_DBRA(-2 /* loop */),
+
+ MS_CASS(PCD | H_AUTO | H_nSELIN | H_INIT | H_STROBE),
+ MS_RET(0),
+/* error: */
+ MS_CASS(PCD | H_AUTO | H_nSELIN | H_INIT | H_STROBE),
+ MS_RET(1)
+};
+
+static int
+vpoio_disconnect(struct vpoio_data *vpo)
+{
+ int ret;
+
+ ppb_MS_microseq(&vpo->vpo_dev, disconnect_microseq, &ret);
+ return (ppb_release_bus(&vpo->vpo_dev));
+}
+
+/*
+ * how : PPB_WAIT or PPB_DONTWAIT
+ */
+static int
+vpoio_connect(struct vpoio_data *vpo, int how)
+{
+ int error;
+ int ret;
+
+ if ((error = ppb_request_bus(&vpo->vpo_dev, how)))
+ return error;
+
+ if (PPB_IN_EPP_MODE(&vpo->vpo_dev))
+ ppb_MS_microseq(&vpo->vpo_dev, connect_epp_microseq, &ret);
+ else
+ ppb_MS_microseq(&vpo->vpo_dev, connect_spp_microseq, &ret);
+
+ return (0);
+}
+
+/*
+ * vpoio_in_disk_mode()
+ *
+ * Check if we are in disk mode
+ *
+ * XXX should be ported to microseq with MS_ASSERT()
+ */
+static int
+vpoio_in_disk_mode(struct vpoio_data *vpo)
+{
+
+ /* first, set H_AUTO high */
+ ppb_wctr(&vpo->vpo_dev, H_AUTO | H_nSELIN | H_INIT | H_STROBE);
+
+ /* when H_AUTO is set low, H_FLT should be high */
+ ppb_wctr(&vpo->vpo_dev, H_nAUTO | H_nSELIN | H_INIT | H_STROBE);
+ if ((ppb_rstr(&vpo->vpo_dev) & H_FLT) == 0)
+ return (0);
+
+ /* when H_AUTO is set high, H_FLT should be low */
+ ppb_wctr(&vpo->vpo_dev, H_AUTO | H_nSELIN | H_INIT | H_STROBE);
+ if ((ppb_rstr(&vpo->vpo_dev) & H_FLT) != 0)
+ return (0);
+
+ return (1);
+}
+
+/*
+ * vpoio_reset()
+ *
+ * SCSI reset signal, the drive must be in disk mode
+ *
+ * XXX should be ported to microseq with MS_TRIG()
+ */
+static void
+vpoio_reset (struct vpoio_data *vpo)
+{
+
+ /*
+ * SCSI reset signal.
+ */
+ ppb_wdtr(&vpo->vpo_dev, (1 << VP0_INITIATOR));
+ ppb_wctr(&vpo->vpo_dev, H_AUTO | H_nSELIN | H_nINIT | H_STROBE);
+ DELAY(25);
+ ppb_wctr(&vpo->vpo_dev, H_AUTO | H_nSELIN | H_INIT | H_STROBE);
+
+ return;
+}
+
+/*
+ * vpoio_detect()
+ *
+ * Detect and initialise the VP0 adapter.
+ */
+int
+vpoio_detect(struct vpoio_data *vpo)
+{
+
+ vpoio_disconnect(vpo);
+ vpoio_connect(vpo, PPB_DONTWAIT);
+
+ if (!vpoio_in_disk_mode(vpo)) {
+ vpoio_disconnect(vpo);
+ return (VP0_EINITFAILED);
+ }
+
+ /* send SCSI reset signal */
+ vpoio_reset(vpo);
+
+ vpoio_disconnect(vpo);
+
+ if (vpoio_in_disk_mode(vpo))
+ return (VP0_EINITFAILED);
+
+ return (0);
+}
+
+/*
+ * vpoio_outstr()
+ */
+static int
+vpoio_outstr(struct vpoio_data *vpo, char *buffer, int size)
+{
+
+ int error = 0;
+
+ ppb_MS_exec(&vpo->vpo_dev, MS_OP_PUT, buffer, size, MS_UNKNOWN, &error);
+
+#if 0
+ /* XXX EPP 1.9 not implemented with microsequences */
+ else {
+
+ ppb_reset_epp_timeout(&vpo->vpo_dev);
+ ppb_wctr(&vpo->vpo_dev,
+ H_AUTO | H_SELIN | H_INIT | H_STROBE);
+
+ if (((long) buffer | size) & 0x03)
+ ppb_outsb_epp(&vpo->vpo_dev,
+ buffer, size);
+ else
+ ppb_outsl_epp(&vpo->vpo_dev,
+ buffer, size/4);
+
+ if ((ppb_rstr(&vpo->vpo_dev) & TIMEOUT)) {
+ error = VP0_EPPDATA_TIMEOUT;
+ goto error;
+ }
+
+ ppb_wctr(&vpo->vpo_dev,
+ H_AUTO | H_nSELIN | H_INIT | H_STROBE);
+ }
+ /* ppb_ecp_sync(&vpo->vpo_dev); */
+#endif
+
+ return (error);
+}
+
+/*
+ * vpoio_instr()
+ */
+static int
+vpoio_instr(struct vpoio_data *vpo, char *buffer, int size)
+{
+
+ register int k;
+ int error = 0;
+ int r, mode, epp;
+
+ ppb_MS_exec(&vpo->vpo_dev, MS_OP_GET, buffer, size, MS_UNKNOWN, &error);
+
+#if 0
+ /* XXX EPP 1.9 not implemented with microsequences */
+ else {
+
+ ppb_reset_epp_timeout(&vpo->vpo_dev);
+ ppb_wctr(&vpo->vpo_dev, PCD |
+ H_AUTO | H_SELIN | H_INIT | H_STROBE);
+
+ if (((long) buffer | size) & 0x03)
+ ppb_insb_epp(&vpo->vpo_dev,
+ buffer, size);
+ else
+ ppb_insl_epp(&vpo->vpo_dev,
+ buffer, size/4);
+
+ if ((ppb_rstr(&vpo->vpo_dev) & TIMEOUT)) {
+ error = VP0_EPPDATA_TIMEOUT;
+ goto error;
+ }
+
+ ppb_wctr(&vpo->vpo_dev, PCD |
+ H_AUTO | H_nSELIN | H_INIT | H_STROBE);
+ }
+ /* ppb_ecp_sync(&vpo->vpo_dev); */
+#endif
+
+ return (error);
+}
+
+static char
+vpoio_select(struct vpoio_data *vpo, int initiator, int target)
+{
+ register int k;
+ int ret;
+
+ struct ppb_microseq select_microseq[] = {
+
+ /* parameter list
+ */
+ #define SELECT_TARGET MS_PARAM(0, 1, MS_TYP_INT)
+ #define SELECT_INITIATOR MS_PARAM(3, 1, MS_TYP_INT)
+
+ /* send the select command to the drive */
+ MS_DASS(MS_UNKNOWN),
+ MS_CASS(H_nAUTO | H_nSELIN | H_INIT | H_STROBE),
+ MS_CASS( H_AUTO | H_nSELIN | H_INIT | H_STROBE),
+ MS_DASS(MS_UNKNOWN),
+ MS_CASS( H_AUTO | H_nSELIN | H_nINIT | H_STROBE),
+
+ /* now, wait until the drive is ready */
+ MS_SET(VP0_SELTMO),
+/* loop: */ MS_BRSET(H_ACK, 3 /* ready */),
+ MS_DBRA(-1 /* loop */),
+/* error: */ MS_RET(1),
+/* ready: */ MS_RET(0)
+ };
+
+ /* initialize the select microsequence */
+ ppb_MS_init_msq(select_microseq, 2,
+ SELECT_TARGET, 1 << target,
+ SELECT_INITIATOR, 1 << initiator);
+
+ ppb_MS_microseq(&vpo->vpo_dev, select_microseq, &ret);
+
+ if (ret)
+ return (VP0_ESELECT_TIMEOUT);
+
+ return (0);
+}
+
+/*
+ * vpoio_wait()
+ *
+ * H_SELIN must be low.
+ *
+ * XXX should be ported to microseq
+ */
+static char
+vpoio_wait(struct vpoio_data *vpo, int tmo)
+{
+
+ register int k;
+ register char r;
+
+#if 0 /* broken */
+ if (ppb_poll_device(&vpo->vpo_dev, 150, nBUSY, nBUSY, PPB_INTR))
+ return (0);
+
+ return (ppb_rstr(&vpo->vpo_dev) & 0xf0);
+#endif
+
+ /* XXX should be ported to microseq */
+ k = 0;
+ while (!((r = ppb_rstr(&vpo->vpo_dev)) & nBUSY) && (k++ < tmo))
+ ;
+
+ /*
+ * Return some status information.
+ * Semantics : 0xc0 = ZIP wants more data
+ * 0xd0 = ZIP wants to send more data
+ * 0xe0 = ZIP wants command
+ * 0xf0 = end of transfer, ZIP is sending status
+ */
+ if (k < tmo)
+ return (r & 0xf0);
+
+ return (0); /* command timed out */
+}
+
+/*
+ * vpoio_probe()
+ *
+ * Low level probe of vpo device
+ *
+ */
+struct ppb_device *
+vpoio_probe(struct ppb_data *ppb, struct vpoio_data *vpo)
+{
+
+ /* ppbus dependent initialisation */
+ vpo->vpo_dev.id_unit = vpo->vpo_unit;
+ vpo->vpo_dev.name = "vpo";
+ vpo->vpo_dev.ppb = ppb;
+
+ /* now, try to initialise the drive */
+ if (vpoio_detect(vpo)) {
+ return (NULL);
+ }
+
+ return (&vpo->vpo_dev);
+}
+
+/*
+ * vpoio_attach()
+ *
+ * Low level attachment of vpo device
+ *
+ */
+int
+vpoio_attach(struct vpoio_data *vpo)
+{
+ int epp;
+
+ /*
+ * Report ourselves
+ */
+ printf("vpo%d: <Iomega VPI0 Parallel to SCSI adapter> on ppbus %d\n",
+ vpo->vpo_dev.id_unit, vpo->vpo_dev.ppb->ppb_link->adapter_unit);
+
+ /*
+ * Initialize microsequence code
+ */
+ vpo->vpo_nibble_inbyte_msq = (struct ppb_microseq *)malloc(
+ sizeof(nibble_inbyte_submicroseq), M_DEVBUF, M_NOWAIT);
+
+ if (!vpo->vpo_nibble_inbyte_msq)
+ return (0);
+
+ bcopy((void *)nibble_inbyte_submicroseq,
+ (void *)vpo->vpo_nibble_inbyte_msq,
+ sizeof(nibble_inbyte_submicroseq));
+
+ INIT_NIBBLE_INBYTE_SUBMICROSEQ(vpo);
+
+ /*
+ * Initialize mode dependent in/out microsequences
+ */
+ ppb_request_bus(&vpo->vpo_dev, PPB_WAIT);
+
+ /* enter NIBBLE mode to configure submsq */
+ if (ppb_set_mode(&vpo->vpo_dev, PPB_NIBBLE) != -1) {
+
+ ppb_MS_GET_init(&vpo->vpo_dev, vpo->vpo_nibble_inbyte_msq);
+
+ ppb_MS_PUT_init(&vpo->vpo_dev, spp_outbyte_submicroseq);
+ }
+
+ /* enter PS2 mode to configure submsq */
+ if (ppb_set_mode(&vpo->vpo_dev, PPB_PS2) != -1) {
+
+ ppb_MS_GET_init(&vpo->vpo_dev, ps2_inbyte_submicroseq);
+
+ ppb_MS_PUT_init(&vpo->vpo_dev, spp_outbyte_submicroseq);
+ }
+
+ epp = ppb_get_epp_protocol(&vpo->vpo_dev);
+
+ /* enter EPP mode to configure submsq */
+ if (ppb_set_mode(&vpo->vpo_dev, PPB_EPP) != -1) {
+
+ switch (epp) {
+ case EPP_1_9:
+ /* XXX EPP 1.9 support should be improved */
+ case EPP_1_7:
+ ppb_MS_GET_init(&vpo->vpo_dev, epp17_instr_body);
+
+ ppb_MS_PUT_init(&vpo->vpo_dev, epp17_outstr_body);
+ break;
+ default:
+ panic("%s: unknown EPP protocol (0x%x)", __FUNCTION__,
+ epp);
+ }
+ }
+
+ /* try to enter EPP or PS/2 mode, NIBBLE otherwise */
+ if (ppb_set_mode(&vpo->vpo_dev, PPB_EPP) != -1) {
+ switch (epp) {
+ case EPP_1_9:
+ printf("vpo%d: EPP 1.9 mode\n", vpo->vpo_unit);
+ break;
+ case EPP_1_7:
+ printf("vpo%d: EPP 1.7 mode\n", vpo->vpo_unit);
+ break;
+ default:
+ panic("%s: unknown EPP protocol (0x%x)", __FUNCTION__,
+ epp);
+ }
+ } else if (ppb_set_mode(&vpo->vpo_dev, PPB_PS2) != -1)
+ printf("vpo%d: PS2 mode\n", vpo->vpo_unit);
+
+ else if (ppb_set_mode(&vpo->vpo_dev, PPB_NIBBLE) != -1)
+ printf("vpo%d: NIBBLE mode\n", vpo->vpo_unit);
+
+ else {
+ printf("vpo%d: can't enter NIBBLE, PS2 or EPP mode\n",
+ vpo->vpo_unit);
+
+ ppb_release_bus(&vpo->vpo_dev);
+
+ free(vpo->vpo_nibble_inbyte_msq, M_DEVBUF);
+ return (0);
+ }
+
+ ppb_release_bus(&vpo->vpo_dev);
+
+ return (1);
+}
+
+/*
+ * vpoio_reset_bus()
+ *
+ */
+int
+vpoio_reset_bus(struct vpoio_data *vpo)
+{
+ /* first, connect to the drive */
+ if (vpoio_connect(vpo, PPB_WAIT|PPB_INTR) ||
+ (vpoio_in_disk_mode(vpo) == 0)) {
+
+ /* release ppbus */
+ vpoio_disconnect(vpo);
+ return (1);
+ }
+
+ /* reset the SCSI bus */
+ vpoio_reset(vpo);
+
+ /* then disconnect */
+ vpoio_disconnect(vpo);
+
+ return (0);
+}
+
+/*
+ * vpoio_do_scsi()
+ *
+ * Send an SCSI command
+ *
+ */
+int
+vpoio_do_scsi(struct vpoio_data *vpo, int host, int target, char *command,
+ int clen, char *buffer, int blen, int *result, int *count,
+ int *ret)
+{
+
+ register char r;
+ char l, h = 0;
+ int len, error = 0;
+ register int k;
+
+ /*
+ * enter disk state, allocate the ppbus
+ *
+ * XXX
+ * Should we allow this call to be interruptible?
+ * The only way to report the interruption is to return
+ * EIO do upper SCSI code :^(
+ */
+ if ((error = vpoio_connect(vpo, PPB_WAIT|PPB_INTR)))
+ return (error);
+
+ if (!vpoio_in_disk_mode(vpo)) {
+ *ret = VP0_ECONNECT; goto error;
+ }
+
+ if ((*ret = vpoio_select(vpo,host,target)))
+ goto error;
+
+ /*
+ * Send the command ...
+ *
+ * set H_SELIN low for vpoio_wait().
+ */
+ ppb_wctr(&vpo->vpo_dev, H_AUTO | H_nSELIN | H_INIT | H_STROBE);
+
+ for (k = 0; k < clen; k++) {
+ if (vpoio_wait(vpo, VP0_FAST_SPINTMO) != (char)0xe0) {
+ *ret = VP0_ECMD_TIMEOUT;
+ goto error;
+ }
+ if (vpoio_outstr(vpo, &command[k], 1)) {
+ *ret = VP0_EPPDATA_TIMEOUT;
+ goto error;
+ }
+ }
+
+ /*
+ * Completion ...
+ */
+
+ *count = 0;
+ for (;;) {
+
+ if (!(r = vpoio_wait(vpo, VP0_LOW_SPINTMO))) {
+ *ret = VP0_ESTATUS_TIMEOUT; goto error;
+ }
+
+ /* stop when the ZIP wants to send status */
+ if (r == (char)0xf0)
+ break;
+
+ if (*count >= blen) {
+ *ret = VP0_EDATA_OVERFLOW;
+ goto error;
+ }
+ len = (((blen - *count) >= VP0_SECTOR_SIZE)) ?
+ VP0_SECTOR_SIZE : 1;
+
+ /* ZIP wants to send data? */
+ if (r == (char)0xc0)
+ error = vpoio_outstr(vpo, &buffer[*count], len);
+ else
+ error = vpoio_instr(vpo, &buffer[*count], len);
+
+ if (error) {
+ *ret = error;
+ goto error;
+ }
+
+ *count += len;
+ }
+
+ if (vpoio_instr(vpo, &l, 1)) {
+ *ret = VP0_EOTHER; goto error;
+ }
+
+ /* check if the ZIP wants to send more status */
+ if (vpoio_wait(vpo, VP0_FAST_SPINTMO) == (char)0xf0)
+ if (vpoio_instr(vpo, &h, 1)) {
+ *ret = VP0_EOTHER+2; goto error;
+ }
+
+ *result = ((int) h << 8) | ((int) l & 0xff);
+
+error:
+ /* return to printer state, release the ppbus */
+ vpoio_disconnect(vpo);
+ return (0);
+}
OpenPOWER on IntegriCloud