2 * Copyright (c) 1998, 1999 Nicolas Souchu
5 * Redistribution and use in source and binary forms, with or without
6 * modification, are permitted provided that the following conditions
8 * 1. Redistributions of source code must retain the above copyright
9 * notice, this list of conditions and the following disclaimer.
10 * 2. Redistributions in binary form must reproduce the above copyright
11 * notice, this list of conditions and the following disclaimer in the
12 * documentation and/or other materials provided with the distribution.
14 * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND
15 * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
16 * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
17 * ARE DISCLAIMED. IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE
18 * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
19 * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
20 * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
21 * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
22 * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
23 * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
26 * $FreeBSD: src/sys/dev/ppbus/ppb_msq.c,v 1.9.2.1 2000/05/24 00:20:57 n_hibma Exp $
29 #include <machine/stdarg.h>
31 #include <sys/param.h>
32 #include <sys/systm.h>
35 #include <dev/ppbus/ppbconf.h>
36 #include <dev/ppbus/ppb_msq.h>
40 /* msq index (see PPB_MAX_XFER)
41 * These are device modes
43 #define COMPAT_MSQ 0x0
44 #define NIBBLE_MSQ 0x1
51 * Device mode to submsq conversion
53 static struct ppb_xfer *
54 mode2xfer(device_t bus, struct ppb_device *ppbdev, int opcode)
57 struct ppb_xfer *table;
61 table = ppbdev->get_xfer;
65 table = ppbdev->put_xfer;
69 panic("%s: unknown opcode (%d)", __FUNCTION__, opcode);
72 /* retrieve the device operating mode */
73 switch (ppb_get_mode(bus)) {
84 switch ((epp = ppb_get_epp_protocol(bus))) {
92 panic("%s: unknown EPP protocol (0x%x)!", __FUNCTION__,
100 panic("%s: unknown mode (%d)", __FUNCTION__, ppbdev->mode);
103 return (&table[index]);
109 * Initialize device dependent submicrosequence of the current mode
113 ppb_MS_init(device_t bus, device_t dev, struct ppb_microseq *loop, int opcode)
115 struct ppb_device *ppbdev = (struct ppb_device *)device_get_ivars(dev);
116 struct ppb_xfer *xfer = mode2xfer(bus, ppbdev, opcode);
126 * Execute any microsequence opcode - expensive
130 ppb_MS_exec(device_t bus, device_t dev, int opcode, union ppb_insarg param1,
131 union ppb_insarg param2, union ppb_insarg param3, int *ret)
133 struct ppb_microseq msq[] = {
134 { MS_UNKNOWN, { { MS_UNKNOWN }, { MS_UNKNOWN }, { MS_UNKNOWN } } },
138 /* initialize the corresponding microseq */
139 msq[0].opcode = opcode;
140 msq[0].arg[0] = param1;
141 msq[0].arg[1] = param2;
142 msq[0].arg[2] = param3;
144 /* execute the microseq */
145 return (ppb_MS_microseq(bus, dev, msq, ret));
151 * Execute a microseq loop
155 ppb_MS_loop(device_t bus, device_t dev, struct ppb_microseq *prolog,
156 struct ppb_microseq *body, struct ppb_microseq *epilog,
159 struct ppb_microseq loop_microseq[] = {
160 MS_CALL(0), /* execute prolog */
162 MS_SET(MS_UNKNOWN), /* set size of transfer */
164 MS_CALL(0), /* execute body */
165 MS_DBRA(-1 /* loop: */),
167 MS_CALL(0), /* execute epilog */
171 /* initialize the structure */
172 loop_microseq[0].arg[0].p = (void *)prolog;
173 loop_microseq[1].arg[0].i = iter;
174 loop_microseq[2].arg[0].p = (void *)body;
175 loop_microseq[4].arg[0].p = (void *)epilog;
177 /* execute the loop */
178 return (ppb_MS_microseq(bus, dev, loop_microseq, ret));
184 * Initialize a microsequence - see macros in ppb_msq.h
188 ppb_MS_init_msq(struct ppb_microseq *msq, int nbparam, ...)
191 int param, ins, arg, type;
194 va_start(p_list, nbparam);
196 for (i=0; i<nbparam; i++) {
197 /* retrieve the parameter descriptor */
198 param = va_arg(p_list, int);
202 type = MS_TYP(param);
204 /* check the instruction position */
205 if (arg >= PPB_MS_MAXARGS)
206 panic("%s: parameter out of range (0x%x)!",
207 __FUNCTION__, param);
210 printf("%s: param = %d, ins = %d, arg = %d, type = %d\n",
211 __FUNCTION__, param, ins, arg, type);
214 /* properly cast the parameter */
217 msq[ins].arg[arg].i = va_arg(p_list, int);
221 msq[ins].arg[arg].i = (int)va_arg(p_list, char);
225 msq[ins].arg[arg].p = va_arg(p_list, void *);
229 msq[ins].arg[arg].f = va_arg(p_list, void *);
233 panic("%s: unknown parameter (0x%x)!", __FUNCTION__,
244 * Interprete a microsequence. Some microinstructions are executed at adapter
245 * level to avoid function call overhead between ppbus and the adapter
248 ppb_MS_microseq(device_t bus, device_t dev, struct ppb_microseq *msq, int *ret)
250 struct ppb_data *ppb = (struct ppb_data *)device_get_softc(bus);
251 struct ppb_device *ppbdev = (struct ppb_device *)device_get_ivars(dev);
253 struct ppb_microseq *mi; /* current microinstruction */
256 struct ppb_xfer *xfer;
258 /* microsequence executed to initialize the transfer */
259 struct ppb_microseq initxfer[] = {
260 MS_PTR(MS_UNKNOWN), /* set ptr to buffer */
261 MS_SET(MS_UNKNOWN), /* set transfer size */
265 if (ppb->ppb_owner != dev)
268 #define INCR_PC (mi ++)
272 switch (mi->opcode) {
276 /* attempt to choose the best mode for the device */
277 xfer = mode2xfer(bus, ppbdev, mi->opcode);
279 /* figure out if we should use ieee1284 code */
281 if (mi->opcode == MS_OP_PUT) {
282 if ((error = PPBUS_WRITE(
283 device_get_parent(bus),
284 (char *)mi->arg[0].p,
291 panic("%s: IEEE1284 read not supported", __FUNCTION__);
294 /* XXX should use ppb_MS_init_msq() */
295 initxfer[0].arg[0].p = mi->arg[0].p;
296 initxfer[1].arg[0].i = mi->arg[1].i;
298 /* initialize transfer */
299 ppb_MS_microseq(bus, dev, initxfer, &error);
304 /* the xfer microsequence should not contain any
305 * MS_OP_PUT or MS_OP_GET!
307 ppb_MS_microseq(bus, dev, xfer->loop, &error);
317 *ret = mi->arg[0].i; /* return code */
322 /* executing microinstructions at ppc level is
323 * faster. This is the default if the microinstr
326 if ((error = PPBUS_EXEC_MICROSEQ(
327 device_get_parent(bus), &mi)))