Current Path : /sys/amd64/compile/hs32/modules/usr/src/sys/modules/s3/@/amd64/compile/hs32/modules/usr/src/sys/modules/usb/usie/@/amd64/compile/hs32/modules/usr/src/sys/modules/i2c/controllers/alpm/@/amd64/compile/hs32/modules/usr/src/sys/modules/usb/umoscom/@/dev/ppbus/ |
FreeBSD hs32.drive.ne.jp 9.1-RELEASE FreeBSD 9.1-RELEASE #1: Wed Jan 14 12:18:08 JST 2015 root@hs32.drive.ne.jp:/sys/amd64/compile/hs32 amd64 |
Current File : //sys/amd64/compile/hs32/modules/usr/src/sys/modules/s3/@/amd64/compile/hs32/modules/usr/src/sys/modules/usb/usie/@/amd64/compile/hs32/modules/usr/src/sys/modules/i2c/controllers/alpm/@/amd64/compile/hs32/modules/usr/src/sys/modules/usb/umoscom/@/dev/ppbus/vpoio.c |
/*- * Copyright (c) 1998, 1999 Nicolas Souchu * Copyright (c) 2000 Alcove - 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. * * */ #include <sys/cdefs.h> __FBSDID("$FreeBSD: release/9.1.0/sys/dev/ppbus/vpoio.c 187576 2009-01-21 23:10:06Z jhb $"); #ifdef _KERNEL #include <sys/param.h> #include <sys/systm.h> #include <sys/module.h> #include <sys/bus.h> #include <sys/malloc.h> #endif #include "opt_vpo.h" #include <dev/ppbus/ppbio.h> #include <dev/ppbus/ppbconf.h> #include <dev/ppbus/ppb_msq.h> #include <dev/ppbus/vpoio.h> #include "ppbus_if.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 PERROR #define H_nERR n(PERROR) #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 WAIT_RET MS_PARAM(4, 2, MS_TYP_PTR) #define WAIT_TMO MS_PARAM(0, 0, MS_TYP_INT) #define DECLARE_WAIT_MICROSEQUENCE \ struct ppb_microseq wait_microseq[] = { \ MS_SET(MS_UNKNOWN), \ /* loop */ \ MS_BRSET(nBUSY, 2 /* ready */), \ MS_DBRA(-2 /* loop */), \ MS_RET(1), /* timed out */ \ /* ready */ \ MS_RFETCH(MS_REG_STR, 0xf0, MS_UNKNOWN), \ MS_RET(0) /* no error */ \ } /* call this macro to initialize connect/disconnect microsequences */ #define INIT_TRIG_MICROSEQ { \ int i; \ for (i=1; i <= 7; i+=2) { \ disconnect_microseq[i].arg[2] = (union ppb_insarg)d_pulse; \ connect_epp_microseq[i].arg[2] = \ connect_spp_microseq[i].arg[2] = (union ppb_insarg)c_pulse; \ } \ } #define trig_d_pulse MS_TRIG(MS_REG_CTR,5,MS_UNKNOWN /* d_pulse */) static 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,MS_UNKNOWN /* c_pulse */) static 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 }; static 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) }; static 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) }; static 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); } #define INB_NIBBLE_H MS_PARAM(2, 2, MS_TYP_PTR) #define INB_NIBBLE_L MS_PARAM(4, 2, MS_TYP_PTR) #define INB_NIBBLE_F MS_PARAM(5, 0, MS_TYP_FUN) #define INB_NIBBLE_P MS_PARAM(5, 1, MS_TYP_PTR) /* * 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()) */ #define DECLARE_NIBBLE_INBYTE_SUBMICROSEQ \ 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(-7 /* 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 */ static 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(-4 /* 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 */ static 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(-5 /* loop */), /* return from the put call */ MS_RET(0) }; /* EPP 1.7 microsequences, ptr and len set at runtime */ static struct ppb_microseq epp17_outstr_body[] = { MS_CASS(H_AUTO | H_SELIN | H_INIT | H_STROBE), /* loop: */ MS_RASSERT_P(1, MS_REG_EPP_D), MS_BRSET(TIMEOUT, 3 /* error */), /* EPP timeout? */ MS_DBRA(-3 /* 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) }; static 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_D, MS_FETCH_ALL), MS_BRSET(TIMEOUT, 3 /* error */), /* EPP timeout? */ MS_DBRA(-3 /* 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 struct ppb_microseq in_disk_mode[] = { MS_CASS( H_AUTO | H_nSELIN | H_INIT | H_STROBE), MS_CASS(H_nAUTO | H_nSELIN | H_INIT | H_STROBE), MS_BRCLEAR(H_FLT, 3 /* error */), MS_CASS( H_AUTO | H_nSELIN | H_INIT | H_STROBE), MS_BRSET(H_FLT, 1 /* error */), MS_RET(1), /* error: */ MS_RET(0) }; static int vpoio_disconnect(struct vpoio_data *vpo) { device_t ppbus = device_get_parent(vpo->vpo_dev); int ret; ppb_MS_microseq(ppbus, vpo->vpo_dev, disconnect_microseq, &ret); return (ppb_release_bus(ppbus, vpo->vpo_dev)); } /* * how : PPB_WAIT or PPB_DONTWAIT */ static int vpoio_connect(struct vpoio_data *vpo, int how) { device_t ppbus = device_get_parent(vpo->vpo_dev); int error; int ret; if ((error = ppb_request_bus(ppbus, vpo->vpo_dev, how))) { #ifdef VP0_DEBUG printf("%s: can't request bus!\n", __func__); #endif return (error); } if (PPB_IN_EPP_MODE(ppbus)) ppb_MS_microseq(ppbus, vpo->vpo_dev, connect_epp_microseq, &ret); else ppb_MS_microseq(ppbus, vpo->vpo_dev, connect_spp_microseq, &ret); return (0); } /* * vpoio_reset() * * SCSI reset signal, the drive must be in disk mode */ static void vpoio_reset(struct vpoio_data *vpo) { device_t ppbus = device_get_parent(vpo->vpo_dev); int ret; struct ppb_microseq reset_microseq[] = { #define INITIATOR MS_PARAM(0, 1, MS_TYP_INT) MS_DASS(MS_UNKNOWN), MS_CASS(H_AUTO | H_nSELIN | H_nINIT | H_STROBE), MS_DELAY(25), MS_CASS(H_AUTO | H_nSELIN | H_INIT | H_STROBE), MS_RET(0) }; ppb_MS_init_msq(reset_microseq, 1, INITIATOR, 1 << VP0_INITIATOR); ppb_MS_microseq(ppbus, vpo->vpo_dev, reset_microseq, &ret); return; } /* * vpoio_in_disk_mode() */ static int vpoio_in_disk_mode(struct vpoio_data *vpo) { device_t ppbus = device_get_parent(vpo->vpo_dev); int ret; ppb_MS_microseq(ppbus, vpo->vpo_dev, in_disk_mode, &ret); return (ret); } /* * vpoio_detect() * * Detect and initialise the VP0 adapter. */ static int vpoio_detect(struct vpoio_data *vpo) { device_t ppbus = device_get_parent(vpo->vpo_dev); int error, ret; /* allocate the bus, then apply microsequences */ if ((error = ppb_request_bus(ppbus, vpo->vpo_dev, PPB_DONTWAIT))) return (error); /* Force disconnection */ ppb_MS_microseq(ppbus, vpo->vpo_dev, disconnect_microseq, &ret); /* Try to enter EPP mode, then connect to the drive in EPP mode */ if (ppb_set_mode(ppbus, PPB_EPP) != -1) { /* call manually the microseq instead of using the appropriate function * since we already requested the ppbus */ ppb_MS_microseq(ppbus, vpo->vpo_dev, connect_epp_microseq, &ret); } /* If EPP mode switch failed or ZIP connection in EPP mode failed, * try to connect in NIBBLE mode */ if (!vpoio_in_disk_mode(vpo)) { /* The interface must be at least PS/2 or NIBBLE capable. * There is no way to know if the ZIP will work with * PS/2 mode since PS/2 and SPP both use the same connect * sequence. One must supress PS/2 with boot flags if * PS/2 mode fails (see ppc(4)). */ if (ppb_set_mode(ppbus, PPB_PS2) != -1) { vpo->vpo_mode_found = VP0_MODE_PS2; } else { if (ppb_set_mode(ppbus, PPB_NIBBLE) == -1) goto error; vpo->vpo_mode_found = VP0_MODE_NIBBLE; } /* Can't know if the interface is capable of PS/2 yet */ ppb_MS_microseq(ppbus, vpo->vpo_dev, connect_spp_microseq, &ret); if (!vpoio_in_disk_mode(vpo)) { vpo->vpo_mode_found = VP0_MODE_UNDEFINED; if (bootverbose) device_printf(vpo->vpo_dev, "can't connect to the drive\n"); /* disconnect and release the bus */ ppb_MS_microseq(ppbus, vpo->vpo_dev, disconnect_microseq, &ret); goto error; } } else { vpo->vpo_mode_found = VP0_MODE_EPP; } /* send SCSI reset signal */ vpoio_reset(vpo); ppb_MS_microseq(ppbus, vpo->vpo_dev, disconnect_microseq, &ret); /* ensure we are disconnected or daisy chained peripheral * may cause serious problem to the disk */ if (vpoio_in_disk_mode(vpo)) { if (bootverbose) device_printf(vpo->vpo_dev, "can't disconnect from the drive\n"); goto error; } ppb_release_bus(ppbus, vpo->vpo_dev); return (0); error: ppb_release_bus(ppbus, vpo->vpo_dev); return (VP0_EINITFAILED); } /* * vpoio_outstr() */ static int vpoio_outstr(struct vpoio_data *vpo, char *buffer, int size) { device_t ppbus = device_get_parent(vpo->vpo_dev); int error = 0; ppb_MS_exec(ppbus, vpo->vpo_dev, MS_OP_PUT, (union ppb_insarg)buffer, (union ppb_insarg)size, (union ppb_insarg)MS_UNKNOWN, &error); ppb_ecp_sync(ppbus); return (error); } /* * vpoio_instr() */ static int vpoio_instr(struct vpoio_data *vpo, char *buffer, int size) { device_t ppbus = device_get_parent(vpo->vpo_dev); int error = 0; ppb_MS_exec(ppbus, vpo->vpo_dev, MS_OP_GET, (union ppb_insarg)buffer, (union ppb_insarg)size, (union ppb_insarg)MS_UNKNOWN, &error); ppb_ecp_sync(ppbus); return (error); } static char vpoio_select(struct vpoio_data *vpo, int initiator, int target) { device_t ppbus = device_get_parent(vpo->vpo_dev); 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, 2 /* ready */), MS_DBRA(-2 /* 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(ppbus, 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) { DECLARE_WAIT_MICROSEQUENCE; device_t ppbus = device_get_parent(vpo->vpo_dev); int ret, err; #if 0 /* broken */ if (ppb_poll_device(ppbus, 150, nBUSY, nBUSY, PPB_INTR)) return (0); return (ppb_rstr(ppbus) & 0xf0); #endif /* * 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 */ ppb_MS_init_msq(wait_microseq, 2, WAIT_RET, (void *)&ret, WAIT_TMO, tmo); ppb_MS_microseq(ppbus, vpo->vpo_dev, wait_microseq, &err); if (err) return (0); /* command timed out */ return(ret); } /* * vpoio_probe() * * Low level probe of vpo device * */ int vpoio_probe(device_t dev, struct vpoio_data *vpo) { int error; /* ppbus dependent initialisation */ vpo->vpo_dev = dev; /* * Initialize microsequence code */ INIT_TRIG_MICROSEQ; /* now, try to initialise the drive */ if ((error = vpoio_detect(vpo))) { return (error); } return (0); } /* * vpoio_attach() * * Low level attachment of vpo device * */ int vpoio_attach(struct vpoio_data *vpo) { DECLARE_NIBBLE_INBYTE_SUBMICROSEQ; device_t ppbus = device_get_parent(vpo->vpo_dev); int error = 0; vpo->vpo_nibble_inbyte_msq = (struct ppb_microseq *)malloc( sizeof(nibble_inbyte_submicroseq), M_DEVBUF, M_NOWAIT); if (!vpo->vpo_nibble_inbyte_msq) return (ENXIO); bcopy((void *)nibble_inbyte_submicroseq, (void *)vpo->vpo_nibble_inbyte_msq, sizeof(nibble_inbyte_submicroseq)); ppb_MS_init_msq(vpo->vpo_nibble_inbyte_msq, 4, INB_NIBBLE_H, (void *)&(vpo)->vpo_nibble.h, INB_NIBBLE_L, (void *)&(vpo)->vpo_nibble.l, INB_NIBBLE_F, nibble_inbyte_hook, INB_NIBBLE_P, (void *)&(vpo)->vpo_nibble); /* * Initialize mode dependent in/out microsequences */ ppb_lock(ppbus); if ((error = ppb_request_bus(ppbus, vpo->vpo_dev, PPB_WAIT))) goto error; /* ppbus sets automatically the last mode entered during detection */ switch (vpo->vpo_mode_found) { case VP0_MODE_EPP: ppb_MS_GET_init(ppbus, vpo->vpo_dev, epp17_instr_body); ppb_MS_PUT_init(ppbus, vpo->vpo_dev, epp17_outstr_body); device_printf(vpo->vpo_dev, "EPP mode\n"); break; case VP0_MODE_PS2: ppb_MS_GET_init(ppbus, vpo->vpo_dev, ps2_inbyte_submicroseq); ppb_MS_PUT_init(ppbus, vpo->vpo_dev, spp_outbyte_submicroseq); device_printf(vpo->vpo_dev, "PS2 mode\n"); break; case VP0_MODE_NIBBLE: ppb_MS_GET_init(ppbus, vpo->vpo_dev, vpo->vpo_nibble_inbyte_msq); ppb_MS_PUT_init(ppbus, vpo->vpo_dev, spp_outbyte_submicroseq); device_printf(vpo->vpo_dev, "NIBBLE mode\n"); break; default: panic("vpo: unknown mode %d", vpo->vpo_mode_found); } ppb_release_bus(ppbus, vpo->vpo_dev); error: ppb_unlock(ppbus); return (error); } /* * 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)) { #ifdef VP0_DEBUG printf("%s: not in disk mode!\n", __func__); #endif /* 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) { device_t ppbus = device_get_parent(vpo->vpo_dev); 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(ppbus, 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; } /* if in EPP mode or writing bytes, try to transfer a sector * otherwise, just send one byte */ if (PPB_IN_EPP_MODE(ppbus) || r == (char)0xc0) len = (((blen - *count) >= VP0_SECTOR_SIZE)) ? VP0_SECTOR_SIZE : 1; else len = 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); }