hifn7751.c revision 136532
1/*	$OpenBSD: hifn7751.c,v 1.120 2002/05/17 00:33:34 deraadt Exp $	*/
2
3/*
4 * Invertex AEON / Hifn 7751 driver
5 * Copyright (c) 1999 Invertex Inc. All rights reserved.
6 * Copyright (c) 1999 Theo de Raadt
7 * Copyright (c) 2000-2001 Network Security Technologies, Inc.
8 *			http://www.netsec.net
9 * Copyright (c) 2003 Hifn Inc.
10 *
11 * This driver is based on a previous driver by Invertex, for which they
12 * requested:  Please send any comments, feedback, bug-fixes, or feature
13 * requests to software@invertex.com.
14 *
15 * Redistribution and use in source and binary forms, with or without
16 * modification, are permitted provided that the following conditions
17 * are met:
18 *
19 * 1. Redistributions of source code must retain the above copyright
20 *   notice, this list of conditions and the following disclaimer.
21 * 2. Redistributions in binary form must reproduce the above copyright
22 *   notice, this list of conditions and the following disclaimer in the
23 *   documentation and/or other materials provided with the distribution.
24 * 3. The name of the author may not be used to endorse or promote products
25 *   derived from this software without specific prior written permission.
26 *
27 * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
28 * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
29 * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
30 * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,
31 * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
32 * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
33 * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
34 * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
35 * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF
36 * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
37 *
38 * Effort sponsored in part by the Defense Advanced Research Projects
39 * Agency (DARPA) and Air Force Research Laboratory, Air Force
40 * Materiel Command, USAF, under agreement number F30602-01-2-0537.
41 */
42
43#include <sys/cdefs.h>
44__FBSDID("$FreeBSD: head/sys/dev/hifn/hifn7751.c 136532 2004-10-15 03:54:56Z sam $");
45
46/*
47 * Driver for various Hifn encryption processors.
48 */
49#include "opt_hifn.h"
50
51#include <sys/param.h>
52#include <sys/systm.h>
53#include <sys/proc.h>
54#include <sys/errno.h>
55#include <sys/malloc.h>
56#include <sys/kernel.h>
57#include <sys/module.h>
58#include <sys/mbuf.h>
59#include <sys/lock.h>
60#include <sys/mutex.h>
61#include <sys/sysctl.h>
62
63#include <vm/vm.h>
64#include <vm/pmap.h>
65
66#include <machine/clock.h>
67#include <machine/bus.h>
68#include <machine/resource.h>
69#include <sys/bus.h>
70#include <sys/rman.h>
71
72#include <opencrypto/cryptodev.h>
73#include <sys/random.h>
74
75#include <dev/pci/pcivar.h>
76#include <dev/pci/pcireg.h>
77
78#ifdef HIFN_RNDTEST
79#include <dev/rndtest/rndtest.h>
80#endif
81#include <dev/hifn/hifn7751reg.h>
82#include <dev/hifn/hifn7751var.h>
83
84/*
85 * Prototypes and count for the pci_device structure
86 */
87static	int hifn_probe(device_t);
88static	int hifn_attach(device_t);
89static	int hifn_detach(device_t);
90static	int hifn_suspend(device_t);
91static	int hifn_resume(device_t);
92static	void hifn_shutdown(device_t);
93
94static device_method_t hifn_methods[] = {
95	/* Device interface */
96	DEVMETHOD(device_probe,		hifn_probe),
97	DEVMETHOD(device_attach,	hifn_attach),
98	DEVMETHOD(device_detach,	hifn_detach),
99	DEVMETHOD(device_suspend,	hifn_suspend),
100	DEVMETHOD(device_resume,	hifn_resume),
101	DEVMETHOD(device_shutdown,	hifn_shutdown),
102
103	/* bus interface */
104	DEVMETHOD(bus_print_child,	bus_generic_print_child),
105	DEVMETHOD(bus_driver_added,	bus_generic_driver_added),
106
107	{ 0, 0 }
108};
109static driver_t hifn_driver = {
110	"hifn",
111	hifn_methods,
112	sizeof (struct hifn_softc)
113};
114static devclass_t hifn_devclass;
115
116DRIVER_MODULE(hifn, pci, hifn_driver, hifn_devclass, 0, 0);
117MODULE_DEPEND(hifn, crypto, 1, 1, 1);
118#ifdef HIFN_RNDTEST
119MODULE_DEPEND(hifn, rndtest, 1, 1, 1);
120#endif
121
122static	void hifn_reset_board(struct hifn_softc *, int);
123static	void hifn_reset_puc(struct hifn_softc *);
124static	void hifn_puc_wait(struct hifn_softc *);
125static	int hifn_enable_crypto(struct hifn_softc *);
126static	void hifn_set_retry(struct hifn_softc *sc);
127static	void hifn_init_dma(struct hifn_softc *);
128static	void hifn_init_pci_registers(struct hifn_softc *);
129static	int hifn_sramsize(struct hifn_softc *);
130static	int hifn_dramsize(struct hifn_softc *);
131static	int hifn_ramtype(struct hifn_softc *);
132static	void hifn_sessions(struct hifn_softc *);
133static	void hifn_intr(void *);
134static	u_int hifn_write_command(struct hifn_command *, u_int8_t *);
135static	u_int32_t hifn_next_signature(u_int32_t a, u_int cnt);
136static	int hifn_newsession(void *, u_int32_t *, struct cryptoini *);
137static	int hifn_freesession(void *, u_int64_t);
138static	int hifn_process(void *, struct cryptop *, int);
139static	void hifn_callback(struct hifn_softc *, struct hifn_command *, u_int8_t *);
140static	int hifn_crypto(struct hifn_softc *, struct hifn_command *, struct cryptop *, int);
141static	int hifn_readramaddr(struct hifn_softc *, int, u_int8_t *);
142static	int hifn_writeramaddr(struct hifn_softc *, int, u_int8_t *);
143static	int hifn_dmamap_load_src(struct hifn_softc *, struct hifn_command *);
144static	int hifn_dmamap_load_dst(struct hifn_softc *, struct hifn_command *);
145static	int hifn_init_pubrng(struct hifn_softc *);
146static	void hifn_rng(void *);
147static	void hifn_tick(void *);
148static	void hifn_abort(struct hifn_softc *);
149static	void hifn_alloc_slot(struct hifn_softc *, int *, int *, int *, int *);
150
151static	void hifn_write_reg_0(struct hifn_softc *, bus_size_t, u_int32_t);
152static	void hifn_write_reg_1(struct hifn_softc *, bus_size_t, u_int32_t);
153
154static __inline u_int32_t
155READ_REG_0(struct hifn_softc *sc, bus_size_t reg)
156{
157    u_int32_t v = bus_space_read_4(sc->sc_st0, sc->sc_sh0, reg);
158    sc->sc_bar0_lastreg = (bus_size_t) -1;
159    return (v);
160}
161#define	WRITE_REG_0(sc, reg, val)	hifn_write_reg_0(sc, reg, val)
162
163static __inline u_int32_t
164READ_REG_1(struct hifn_softc *sc, bus_size_t reg)
165{
166    u_int32_t v = bus_space_read_4(sc->sc_st1, sc->sc_sh1, reg);
167    sc->sc_bar1_lastreg = (bus_size_t) -1;
168    return (v);
169}
170#define	WRITE_REG_1(sc, reg, val)	hifn_write_reg_1(sc, reg, val)
171
172SYSCTL_NODE(_hw, OID_AUTO, hifn, CTLFLAG_RD, 0, "Hifn driver parameters");
173
174#ifdef HIFN_DEBUG
175static	int hifn_debug = 0;
176SYSCTL_INT(_hw_hifn, OID_AUTO, debug, CTLFLAG_RW, &hifn_debug,
177	    0, "control debugging msgs");
178#endif
179
180static	struct hifn_stats hifnstats;
181SYSCTL_STRUCT(_hw_hifn, OID_AUTO, stats, CTLFLAG_RD, &hifnstats,
182	    hifn_stats, "driver statistics");
183static	int hifn_maxbatch = 1;
184SYSCTL_INT(_hw_hifn, OID_AUTO, maxbatch, CTLFLAG_RW, &hifn_maxbatch,
185	    0, "max ops to batch w/o interrupt");
186
187/*
188 * Probe for a supported device.  The PCI vendor and device
189 * IDs are used to detect devices we know how to handle.
190 */
191static int
192hifn_probe(device_t dev)
193{
194	if (pci_get_vendor(dev) == PCI_VENDOR_INVERTEX &&
195	    pci_get_device(dev) == PCI_PRODUCT_INVERTEX_AEON)
196		return (0);
197	if (pci_get_vendor(dev) == PCI_VENDOR_HIFN &&
198	    (pci_get_device(dev) == PCI_PRODUCT_HIFN_7751 ||
199	     pci_get_device(dev) == PCI_PRODUCT_HIFN_7951 ||
200	     pci_get_device(dev) == PCI_PRODUCT_HIFN_7955 ||
201	     pci_get_device(dev) == PCI_PRODUCT_HIFN_7956 ||
202	     pci_get_device(dev) == PCI_PRODUCT_HIFN_7811))
203		return (0);
204	if (pci_get_vendor(dev) == PCI_VENDOR_NETSEC &&
205	    pci_get_device(dev) == PCI_PRODUCT_NETSEC_7751)
206		return (0);
207	return (ENXIO);
208}
209
210static void
211hifn_dmamap_cb(void *arg, bus_dma_segment_t *segs, int nseg, int error)
212{
213	bus_addr_t *paddr = (bus_addr_t*) arg;
214	*paddr = segs->ds_addr;
215}
216
217static const char*
218hifn_partname(struct hifn_softc *sc)
219{
220	/* XXX sprintf numbers when not decoded */
221	switch (pci_get_vendor(sc->sc_dev)) {
222	case PCI_VENDOR_HIFN:
223		switch (pci_get_device(sc->sc_dev)) {
224		case PCI_PRODUCT_HIFN_6500:	return "Hifn 6500";
225		case PCI_PRODUCT_HIFN_7751:	return "Hifn 7751";
226		case PCI_PRODUCT_HIFN_7811:	return "Hifn 7811";
227		case PCI_PRODUCT_HIFN_7951:	return "Hifn 7951";
228		case PCI_PRODUCT_HIFN_7955:	return "Hifn 7955";
229		case PCI_PRODUCT_HIFN_7956:	return "Hifn 7956";
230		}
231		return "Hifn unknown-part";
232	case PCI_VENDOR_INVERTEX:
233		switch (pci_get_device(sc->sc_dev)) {
234		case PCI_PRODUCT_INVERTEX_AEON:	return "Invertex AEON";
235		}
236		return "Invertex unknown-part";
237	case PCI_VENDOR_NETSEC:
238		switch (pci_get_device(sc->sc_dev)) {
239		case PCI_PRODUCT_NETSEC_7751:	return "NetSec 7751";
240		}
241		return "NetSec unknown-part";
242	}
243	return "Unknown-vendor unknown-part";
244}
245
246static void
247default_harvest(struct rndtest_state *rsp, void *buf, u_int count)
248{
249	random_harvest(buf, count, count*NBBY, 0, RANDOM_PURE);
250}
251
252/*
253 * Attach an interface that successfully probed.
254 */
255static int
256hifn_attach(device_t dev)
257{
258	struct hifn_softc *sc = device_get_softc(dev);
259	u_int32_t cmd;
260	caddr_t kva;
261	int rseg, rid;
262	char rbase;
263	u_int16_t ena, rev;
264
265	KASSERT(sc != NULL, ("hifn_attach: null software carrier!"));
266	bzero(sc, sizeof (*sc));
267	sc->sc_dev = dev;
268
269	mtx_init(&sc->sc_mtx, device_get_nameunit(dev), "hifn driver", MTX_DEF);
270
271	/* XXX handle power management */
272
273	/*
274	 * The 7951 and 795x have a random number generator and
275	 * public key support; note this.
276	 */
277	if (pci_get_vendor(dev) == PCI_VENDOR_HIFN &&
278	    (pci_get_device(dev) == PCI_PRODUCT_HIFN_7951 ||
279	     pci_get_device(dev) == PCI_PRODUCT_HIFN_7955 ||
280	     pci_get_device(dev) == PCI_PRODUCT_HIFN_7956))
281		sc->sc_flags = HIFN_HAS_RNG | HIFN_HAS_PUBLIC;
282	/*
283	 * The 7811 has a random number generator and
284	 * we also note it's identity 'cuz of some quirks.
285	 */
286	if (pci_get_vendor(dev) == PCI_VENDOR_HIFN &&
287	    pci_get_device(dev) == PCI_PRODUCT_HIFN_7811)
288		sc->sc_flags |= HIFN_IS_7811 | HIFN_HAS_RNG;
289
290	/*
291	 * The 795x parts support AES.
292	 */
293	if (pci_get_vendor(dev) == PCI_VENDOR_HIFN &&
294	    (pci_get_device(dev) == PCI_PRODUCT_HIFN_7955 ||
295	     pci_get_device(dev) == PCI_PRODUCT_HIFN_7956))
296		sc->sc_flags |= HIFN_IS_7956 | HIFN_HAS_AES;
297
298	/*
299	 * Configure support for memory-mapped access to
300	 * registers and for DMA operations.
301	 */
302#define	PCIM_ENA	(PCIM_CMD_MEMEN|PCIM_CMD_BUSMASTEREN)
303	cmd = pci_read_config(dev, PCIR_COMMAND, 4);
304	cmd |= PCIM_ENA;
305	pci_write_config(dev, PCIR_COMMAND, cmd, 4);
306	cmd = pci_read_config(dev, PCIR_COMMAND, 4);
307	if ((cmd & PCIM_ENA) != PCIM_ENA) {
308		device_printf(dev, "failed to enable %s\n",
309			(cmd & PCIM_ENA) == 0 ?
310				"memory mapping & bus mastering" :
311			(cmd & PCIM_CMD_MEMEN) == 0 ?
312				"memory mapping" : "bus mastering");
313		goto fail_pci;
314	}
315#undef PCIM_ENA
316
317	/*
318	 * Setup PCI resources. Note that we record the bus
319	 * tag and handle for each register mapping, this is
320	 * used by the READ_REG_0, WRITE_REG_0, READ_REG_1,
321	 * and WRITE_REG_1 macros throughout the driver.
322	 */
323	rid = HIFN_BAR0;
324	sc->sc_bar0res = bus_alloc_resource_any(dev, SYS_RES_MEMORY, &rid,
325			 			RF_ACTIVE);
326	if (sc->sc_bar0res == NULL) {
327		device_printf(dev, "cannot map bar%d register space\n", 0);
328		goto fail_pci;
329	}
330	sc->sc_st0 = rman_get_bustag(sc->sc_bar0res);
331	sc->sc_sh0 = rman_get_bushandle(sc->sc_bar0res);
332	sc->sc_bar0_lastreg = (bus_size_t) -1;
333
334	rid = HIFN_BAR1;
335	sc->sc_bar1res = bus_alloc_resource_any(dev, SYS_RES_MEMORY, &rid,
336						RF_ACTIVE);
337	if (sc->sc_bar1res == NULL) {
338		device_printf(dev, "cannot map bar%d register space\n", 1);
339		goto fail_io0;
340	}
341	sc->sc_st1 = rman_get_bustag(sc->sc_bar1res);
342	sc->sc_sh1 = rman_get_bushandle(sc->sc_bar1res);
343	sc->sc_bar1_lastreg = (bus_size_t) -1;
344
345	hifn_set_retry(sc);
346
347	/*
348	 * Setup the area where the Hifn DMA's descriptors
349	 * and associated data structures.
350	 */
351	if (bus_dma_tag_create(NULL,			/* parent */
352			       1, 0,			/* alignment,boundary */
353			       BUS_SPACE_MAXADDR_32BIT,	/* lowaddr */
354			       BUS_SPACE_MAXADDR,	/* highaddr */
355			       NULL, NULL,		/* filter, filterarg */
356			       HIFN_MAX_DMALEN,		/* maxsize */
357			       MAX_SCATTER,		/* nsegments */
358			       HIFN_MAX_SEGLEN,		/* maxsegsize */
359			       BUS_DMA_ALLOCNOW,	/* flags */
360			       NULL,			/* lockfunc */
361			       NULL,			/* lockarg */
362			       &sc->sc_dmat)) {
363		device_printf(dev, "cannot allocate DMA tag\n");
364		goto fail_io1;
365	}
366	if (bus_dmamap_create(sc->sc_dmat, BUS_DMA_NOWAIT, &sc->sc_dmamap)) {
367		device_printf(dev, "cannot create dma map\n");
368		bus_dma_tag_destroy(sc->sc_dmat);
369		goto fail_io1;
370	}
371	if (bus_dmamem_alloc(sc->sc_dmat, (void**) &kva, BUS_DMA_NOWAIT, &sc->sc_dmamap)) {
372		device_printf(dev, "cannot alloc dma buffer\n");
373		bus_dmamap_destroy(sc->sc_dmat, sc->sc_dmamap);
374		bus_dma_tag_destroy(sc->sc_dmat);
375		goto fail_io1;
376	}
377	if (bus_dmamap_load(sc->sc_dmat, sc->sc_dmamap, kva,
378			     sizeof (*sc->sc_dma),
379			     hifn_dmamap_cb, &sc->sc_dma_physaddr,
380			     BUS_DMA_NOWAIT)) {
381		device_printf(dev, "cannot load dma map\n");
382		bus_dmamem_free(sc->sc_dmat, kva, sc->sc_dmamap);
383		bus_dmamap_destroy(sc->sc_dmat, sc->sc_dmamap);
384		bus_dma_tag_destroy(sc->sc_dmat);
385		goto fail_io1;
386	}
387	sc->sc_dma = (struct hifn_dma *)kva;
388	bzero(sc->sc_dma, sizeof(*sc->sc_dma));
389
390	KASSERT(sc->sc_st0 != 0, ("hifn_attach: null bar0 tag!"));
391	KASSERT(sc->sc_sh0 != 0, ("hifn_attach: null bar0 handle!"));
392	KASSERT(sc->sc_st1 != 0, ("hifn_attach: null bar1 tag!"));
393	KASSERT(sc->sc_sh1 != 0, ("hifn_attach: null bar1 handle!"));
394
395	/*
396	 * Reset the board and do the ``secret handshake''
397	 * to enable the crypto support.  Then complete the
398	 * initialization procedure by setting up the interrupt
399	 * and hooking in to the system crypto support so we'll
400	 * get used for system services like the crypto device,
401	 * IPsec, RNG device, etc.
402	 */
403	hifn_reset_board(sc, 0);
404
405	if (hifn_enable_crypto(sc) != 0) {
406		device_printf(dev, "crypto enabling failed\n");
407		goto fail_mem;
408	}
409	hifn_reset_puc(sc);
410
411	hifn_init_dma(sc);
412	hifn_init_pci_registers(sc);
413
414	/* XXX can't dynamically determine ram type for 795x; force dram */
415	if (sc->sc_flags & HIFN_IS_7956)
416		sc->sc_drammodel = 1;
417	else if (hifn_ramtype(sc))
418		goto fail_mem;
419
420	if (sc->sc_drammodel == 0)
421		hifn_sramsize(sc);
422	else
423		hifn_dramsize(sc);
424
425	/*
426	 * Workaround for NetSec 7751 rev A: half ram size because two
427	 * of the address lines were left floating
428	 */
429	if (pci_get_vendor(dev) == PCI_VENDOR_NETSEC &&
430	    pci_get_device(dev) == PCI_PRODUCT_NETSEC_7751 &&
431	    pci_get_revid(dev) == 0x61)	/*XXX???*/
432		sc->sc_ramsize >>= 1;
433
434	/*
435	 * Arrange the interrupt line.
436	 */
437	rid = 0;
438	sc->sc_irq = bus_alloc_resource_any(dev, SYS_RES_IRQ, &rid,
439					    RF_SHAREABLE|RF_ACTIVE);
440	if (sc->sc_irq == NULL) {
441		device_printf(dev, "could not map interrupt\n");
442		goto fail_mem;
443	}
444	/*
445	 * NB: Network code assumes we are blocked with splimp()
446	 *     so make sure the IRQ is marked appropriately.
447	 */
448	if (bus_setup_intr(dev, sc->sc_irq, INTR_TYPE_NET | INTR_MPSAFE,
449			   hifn_intr, sc, &sc->sc_intrhand)) {
450		device_printf(dev, "could not setup interrupt\n");
451		goto fail_intr2;
452	}
453
454	hifn_sessions(sc);
455
456	/*
457	 * NB: Keep only the low 16 bits; this masks the chip id
458	 *     from the 7951.
459	 */
460	rev = READ_REG_1(sc, HIFN_1_REVID) & 0xffff;
461
462	rseg = sc->sc_ramsize / 1024;
463	rbase = 'K';
464	if (sc->sc_ramsize >= (1024 * 1024)) {
465		rbase = 'M';
466		rseg /= 1024;
467	}
468	device_printf(sc->sc_dev, "%s, rev %u, %d%cB %cram\n",
469		hifn_partname(sc), rev,
470		rseg, rbase, sc->sc_drammodel ? 'd' : 's');
471
472	sc->sc_cid = crypto_get_driverid(0);
473	if (sc->sc_cid < 0) {
474		device_printf(dev, "could not get crypto driver id\n");
475		goto fail_intr;
476	}
477
478	WRITE_REG_0(sc, HIFN_0_PUCNFG,
479	    READ_REG_0(sc, HIFN_0_PUCNFG) | HIFN_PUCNFG_CHIPID);
480	ena = READ_REG_0(sc, HIFN_0_PUSTAT) & HIFN_PUSTAT_CHIPENA;
481
482	switch (ena) {
483	case HIFN_PUSTAT_ENA_2:
484		crypto_register(sc->sc_cid, CRYPTO_3DES_CBC, 0, 0,
485		    hifn_newsession, hifn_freesession, hifn_process, sc);
486		crypto_register(sc->sc_cid, CRYPTO_ARC4, 0, 0,
487		    hifn_newsession, hifn_freesession, hifn_process, sc);
488		if (sc->sc_flags & HIFN_HAS_AES)
489			crypto_register(sc->sc_cid, CRYPTO_AES_CBC,  0, 0,
490				hifn_newsession, hifn_freesession,
491				hifn_process, sc);
492		/*FALLTHROUGH*/
493	case HIFN_PUSTAT_ENA_1:
494		crypto_register(sc->sc_cid, CRYPTO_MD5, 0, 0,
495		    hifn_newsession, hifn_freesession, hifn_process, sc);
496		crypto_register(sc->sc_cid, CRYPTO_SHA1, 0, 0,
497		    hifn_newsession, hifn_freesession, hifn_process, sc);
498		crypto_register(sc->sc_cid, CRYPTO_MD5_HMAC, 0, 0,
499		    hifn_newsession, hifn_freesession, hifn_process, sc);
500		crypto_register(sc->sc_cid, CRYPTO_SHA1_HMAC, 0, 0,
501		    hifn_newsession, hifn_freesession, hifn_process, sc);
502		crypto_register(sc->sc_cid, CRYPTO_DES_CBC, 0, 0,
503		    hifn_newsession, hifn_freesession, hifn_process, sc);
504		break;
505	}
506
507	bus_dmamap_sync(sc->sc_dmat, sc->sc_dmamap,
508	    BUS_DMASYNC_PREREAD | BUS_DMASYNC_PREWRITE);
509
510	if (sc->sc_flags & (HIFN_HAS_PUBLIC | HIFN_HAS_RNG))
511		hifn_init_pubrng(sc);
512
513	callout_init(&sc->sc_tickto, CALLOUT_MPSAFE);
514	callout_reset(&sc->sc_tickto, hz, hifn_tick, sc);
515
516	return (0);
517
518fail_intr:
519	bus_teardown_intr(dev, sc->sc_irq, sc->sc_intrhand);
520fail_intr2:
521	/* XXX don't store rid */
522	bus_release_resource(dev, SYS_RES_IRQ, 0, sc->sc_irq);
523fail_mem:
524	bus_dmamap_unload(sc->sc_dmat, sc->sc_dmamap);
525	bus_dmamem_free(sc->sc_dmat, sc->sc_dma, sc->sc_dmamap);
526	bus_dmamap_destroy(sc->sc_dmat, sc->sc_dmamap);
527	bus_dma_tag_destroy(sc->sc_dmat);
528
529	/* Turn off DMA polling */
530	WRITE_REG_1(sc, HIFN_1_DMA_CNFG, HIFN_DMACNFG_MSTRESET |
531	    HIFN_DMACNFG_DMARESET | HIFN_DMACNFG_MODE);
532fail_io1:
533	bus_release_resource(dev, SYS_RES_MEMORY, HIFN_BAR1, sc->sc_bar1res);
534fail_io0:
535	bus_release_resource(dev, SYS_RES_MEMORY, HIFN_BAR0, sc->sc_bar0res);
536fail_pci:
537	mtx_destroy(&sc->sc_mtx);
538	return (ENXIO);
539}
540
541/*
542 * Detach an interface that successfully probed.
543 */
544static int
545hifn_detach(device_t dev)
546{
547	struct hifn_softc *sc = device_get_softc(dev);
548
549	KASSERT(sc != NULL, ("hifn_detach: null software carrier!"));
550
551	/* disable interrupts */
552	WRITE_REG_1(sc, HIFN_1_DMA_IER, 0);
553
554	/*XXX other resources */
555	callout_stop(&sc->sc_tickto);
556	callout_stop(&sc->sc_rngto);
557#ifdef HIFN_RNDTEST
558	if (sc->sc_rndtest)
559		rndtest_detach(sc->sc_rndtest);
560#endif
561
562	/* Turn off DMA polling */
563	WRITE_REG_1(sc, HIFN_1_DMA_CNFG, HIFN_DMACNFG_MSTRESET |
564	    HIFN_DMACNFG_DMARESET | HIFN_DMACNFG_MODE);
565
566	crypto_unregister_all(sc->sc_cid);
567
568	bus_generic_detach(dev);	/*XXX should be no children, right? */
569
570	bus_teardown_intr(dev, sc->sc_irq, sc->sc_intrhand);
571	/* XXX don't store rid */
572	bus_release_resource(dev, SYS_RES_IRQ, 0, sc->sc_irq);
573
574	bus_dmamap_unload(sc->sc_dmat, sc->sc_dmamap);
575	bus_dmamem_free(sc->sc_dmat, sc->sc_dma, sc->sc_dmamap);
576	bus_dmamap_destroy(sc->sc_dmat, sc->sc_dmamap);
577	bus_dma_tag_destroy(sc->sc_dmat);
578
579	bus_release_resource(dev, SYS_RES_MEMORY, HIFN_BAR1, sc->sc_bar1res);
580	bus_release_resource(dev, SYS_RES_MEMORY, HIFN_BAR0, sc->sc_bar0res);
581
582	mtx_destroy(&sc->sc_mtx);
583
584	return (0);
585}
586
587/*
588 * Stop all chip I/O so that the kernel's probe routines don't
589 * get confused by errant DMAs when rebooting.
590 */
591static void
592hifn_shutdown(device_t dev)
593{
594#ifdef notyet
595	hifn_stop(device_get_softc(dev));
596#endif
597}
598
599/*
600 * Device suspend routine.  Stop the interface and save some PCI
601 * settings in case the BIOS doesn't restore them properly on
602 * resume.
603 */
604static int
605hifn_suspend(device_t dev)
606{
607	struct hifn_softc *sc = device_get_softc(dev);
608#ifdef notyet
609	int i;
610
611	hifn_stop(sc);
612	for (i = 0; i < 5; i++)
613		sc->saved_maps[i] = pci_read_config(dev, PCIR_BAR(i), 4);
614	sc->saved_biosaddr = pci_read_config(dev, PCIR_BIOS, 4);
615	sc->saved_intline = pci_read_config(dev, PCIR_INTLINE, 1);
616	sc->saved_cachelnsz = pci_read_config(dev, PCIR_CACHELNSZ, 1);
617	sc->saved_lattimer = pci_read_config(dev, PCIR_LATTIMER, 1);
618#endif
619	sc->sc_suspended = 1;
620
621	return (0);
622}
623
624/*
625 * Device resume routine.  Restore some PCI settings in case the BIOS
626 * doesn't, re-enable busmastering, and restart the interface if
627 * appropriate.
628 */
629static int
630hifn_resume(device_t dev)
631{
632	struct hifn_softc *sc = device_get_softc(dev);
633#ifdef notyet
634	int i;
635
636	/* better way to do this? */
637	for (i = 0; i < 5; i++)
638		pci_write_config(dev, PCIR_BAR(i), sc->saved_maps[i], 4);
639	pci_write_config(dev, PCIR_BIOS, sc->saved_biosaddr, 4);
640	pci_write_config(dev, PCIR_INTLINE, sc->saved_intline, 1);
641	pci_write_config(dev, PCIR_CACHELNSZ, sc->saved_cachelnsz, 1);
642	pci_write_config(dev, PCIR_LATTIMER, sc->saved_lattimer, 1);
643
644	/* reenable busmastering */
645	pci_enable_busmaster(dev);
646	pci_enable_io(dev, HIFN_RES);
647
648        /* reinitialize interface if necessary */
649        if (ifp->if_flags & IFF_UP)
650                rl_init(sc);
651#endif
652	sc->sc_suspended = 0;
653
654	return (0);
655}
656
657static int
658hifn_init_pubrng(struct hifn_softc *sc)
659{
660	u_int32_t r;
661	int i;
662
663#ifdef HIFN_RNDTEST
664	sc->sc_rndtest = rndtest_attach(sc->sc_dev);
665	if (sc->sc_rndtest)
666		sc->sc_harvest = rndtest_harvest;
667	else
668		sc->sc_harvest = default_harvest;
669#else
670	sc->sc_harvest = default_harvest;
671#endif
672	if ((sc->sc_flags & HIFN_IS_7811) == 0) {
673		/* Reset 7951 public key/rng engine */
674		WRITE_REG_1(sc, HIFN_1_PUB_RESET,
675		    READ_REG_1(sc, HIFN_1_PUB_RESET) | HIFN_PUBRST_RESET);
676
677		for (i = 0; i < 100; i++) {
678			DELAY(1000);
679			if ((READ_REG_1(sc, HIFN_1_PUB_RESET) &
680			    HIFN_PUBRST_RESET) == 0)
681				break;
682		}
683
684		if (i == 100) {
685			device_printf(sc->sc_dev, "public key init failed\n");
686			return (1);
687		}
688	}
689
690	/* Enable the rng, if available */
691	if (sc->sc_flags & HIFN_HAS_RNG) {
692		if (sc->sc_flags & HIFN_IS_7811) {
693			r = READ_REG_1(sc, HIFN_1_7811_RNGENA);
694			if (r & HIFN_7811_RNGENA_ENA) {
695				r &= ~HIFN_7811_RNGENA_ENA;
696				WRITE_REG_1(sc, HIFN_1_7811_RNGENA, r);
697			}
698			WRITE_REG_1(sc, HIFN_1_7811_RNGCFG,
699			    HIFN_7811_RNGCFG_DEFL);
700			r |= HIFN_7811_RNGENA_ENA;
701			WRITE_REG_1(sc, HIFN_1_7811_RNGENA, r);
702		} else
703			WRITE_REG_1(sc, HIFN_1_RNG_CONFIG,
704			    READ_REG_1(sc, HIFN_1_RNG_CONFIG) |
705			    HIFN_RNGCFG_ENA);
706
707		sc->sc_rngfirst = 1;
708		if (hz >= 100)
709			sc->sc_rnghz = hz / 100;
710		else
711			sc->sc_rnghz = 1;
712		callout_init(&sc->sc_rngto, CALLOUT_MPSAFE);
713		callout_reset(&sc->sc_rngto, sc->sc_rnghz, hifn_rng, sc);
714	}
715
716	/* Enable public key engine, if available */
717	if (sc->sc_flags & HIFN_HAS_PUBLIC) {
718		WRITE_REG_1(sc, HIFN_1_PUB_IEN, HIFN_PUBIEN_DONE);
719		sc->sc_dmaier |= HIFN_DMAIER_PUBDONE;
720		WRITE_REG_1(sc, HIFN_1_DMA_IER, sc->sc_dmaier);
721	}
722
723	return (0);
724}
725
726static void
727hifn_rng(void *vsc)
728{
729#define	RANDOM_BITS(n)	(n)*sizeof (u_int32_t), (n)*sizeof (u_int32_t)*NBBY, 0
730	struct hifn_softc *sc = vsc;
731	u_int32_t sts, num[2];
732	int i;
733
734	if (sc->sc_flags & HIFN_IS_7811) {
735		for (i = 0; i < 5; i++) {
736			sts = READ_REG_1(sc, HIFN_1_7811_RNGSTS);
737			if (sts & HIFN_7811_RNGSTS_UFL) {
738				device_printf(sc->sc_dev,
739					      "RNG underflow: disabling\n");
740				return;
741			}
742			if ((sts & HIFN_7811_RNGSTS_RDY) == 0)
743				break;
744
745			/*
746			 * There are at least two words in the RNG FIFO
747			 * at this point.
748			 */
749			num[0] = READ_REG_1(sc, HIFN_1_7811_RNGDAT);
750			num[1] = READ_REG_1(sc, HIFN_1_7811_RNGDAT);
751			/* NB: discard first data read */
752			if (sc->sc_rngfirst)
753				sc->sc_rngfirst = 0;
754			else
755				(*sc->sc_harvest)(sc->sc_rndtest,
756					num, sizeof (num));
757		}
758	} else {
759		num[0] = READ_REG_1(sc, HIFN_1_RNG_DATA);
760
761		/* NB: discard first data read */
762		if (sc->sc_rngfirst)
763			sc->sc_rngfirst = 0;
764		else
765			(*sc->sc_harvest)(sc->sc_rndtest,
766				num, sizeof (num[0]));
767	}
768
769	callout_reset(&sc->sc_rngto, sc->sc_rnghz, hifn_rng, sc);
770#undef RANDOM_BITS
771}
772
773static void
774hifn_puc_wait(struct hifn_softc *sc)
775{
776	int i;
777
778	for (i = 5000; i > 0; i--) {
779		DELAY(1);
780		if (!(READ_REG_0(sc, HIFN_0_PUCTRL) & HIFN_PUCTRL_RESET))
781			break;
782	}
783	if (!i)
784		device_printf(sc->sc_dev, "proc unit did not reset\n");
785}
786
787/*
788 * Reset the processing unit.
789 */
790static void
791hifn_reset_puc(struct hifn_softc *sc)
792{
793	/* Reset processing unit */
794	WRITE_REG_0(sc, HIFN_0_PUCTRL, HIFN_PUCTRL_DMAENA);
795	hifn_puc_wait(sc);
796}
797
798/*
799 * Set the Retry and TRDY registers; note that we set them to
800 * zero because the 7811 locks up when forced to retry (section
801 * 3.6 of "Specification Update SU-0014-04".  Not clear if we
802 * should do this for all Hifn parts, but it doesn't seem to hurt.
803 */
804static void
805hifn_set_retry(struct hifn_softc *sc)
806{
807	/* NB: RETRY only responds to 8-bit reads/writes */
808	pci_write_config(sc->sc_dev, HIFN_RETRY_TIMEOUT, 0, 1);
809	pci_write_config(sc->sc_dev, HIFN_TRDY_TIMEOUT, 0, 4);
810}
811
812/*
813 * Resets the board.  Values in the regesters are left as is
814 * from the reset (i.e. initial values are assigned elsewhere).
815 */
816static void
817hifn_reset_board(struct hifn_softc *sc, int full)
818{
819	u_int32_t reg;
820
821	/*
822	 * Set polling in the DMA configuration register to zero.  0x7 avoids
823	 * resetting the board and zeros out the other fields.
824	 */
825	WRITE_REG_1(sc, HIFN_1_DMA_CNFG, HIFN_DMACNFG_MSTRESET |
826	    HIFN_DMACNFG_DMARESET | HIFN_DMACNFG_MODE);
827
828	/*
829	 * Now that polling has been disabled, we have to wait 1 ms
830	 * before resetting the board.
831	 */
832	DELAY(1000);
833
834	/* Reset the DMA unit */
835	if (full) {
836		WRITE_REG_1(sc, HIFN_1_DMA_CNFG, HIFN_DMACNFG_MODE);
837		DELAY(1000);
838	} else {
839		WRITE_REG_1(sc, HIFN_1_DMA_CNFG,
840		    HIFN_DMACNFG_MODE | HIFN_DMACNFG_MSTRESET);
841		hifn_reset_puc(sc);
842	}
843
844	KASSERT(sc->sc_dma != NULL, ("hifn_reset_board: null DMA tag!"));
845	bzero(sc->sc_dma, sizeof(*sc->sc_dma));
846
847	/* Bring dma unit out of reset */
848	WRITE_REG_1(sc, HIFN_1_DMA_CNFG, HIFN_DMACNFG_MSTRESET |
849	    HIFN_DMACNFG_DMARESET | HIFN_DMACNFG_MODE);
850
851	hifn_puc_wait(sc);
852	hifn_set_retry(sc);
853
854	if (sc->sc_flags & HIFN_IS_7811) {
855		for (reg = 0; reg < 1000; reg++) {
856			if (READ_REG_1(sc, HIFN_1_7811_MIPSRST) &
857			    HIFN_MIPSRST_CRAMINIT)
858				break;
859			DELAY(1000);
860		}
861		if (reg == 1000)
862			printf(": cram init timeout\n");
863	}
864}
865
866static u_int32_t
867hifn_next_signature(u_int32_t a, u_int cnt)
868{
869	int i;
870	u_int32_t v;
871
872	for (i = 0; i < cnt; i++) {
873
874		/* get the parity */
875		v = a & 0x80080125;
876		v ^= v >> 16;
877		v ^= v >> 8;
878		v ^= v >> 4;
879		v ^= v >> 2;
880		v ^= v >> 1;
881
882		a = (v & 1) ^ (a << 1);
883	}
884
885	return a;
886}
887
888struct pci2id {
889	u_short		pci_vendor;
890	u_short		pci_prod;
891	char		card_id[13];
892};
893static struct pci2id pci2id[] = {
894	{
895		PCI_VENDOR_HIFN,
896		PCI_PRODUCT_HIFN_7951,
897		{ 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
898		  0x00, 0x00, 0x00, 0x00, 0x00 }
899	}, {
900		PCI_VENDOR_HIFN,
901		PCI_PRODUCT_HIFN_7955,
902		{ 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
903		  0x00, 0x00, 0x00, 0x00, 0x00 }
904	}, {
905		PCI_VENDOR_HIFN,
906		PCI_PRODUCT_HIFN_7956,
907		{ 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
908		  0x00, 0x00, 0x00, 0x00, 0x00 }
909	}, {
910		PCI_VENDOR_NETSEC,
911		PCI_PRODUCT_NETSEC_7751,
912		{ 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
913		  0x00, 0x00, 0x00, 0x00, 0x00 }
914	}, {
915		PCI_VENDOR_INVERTEX,
916		PCI_PRODUCT_INVERTEX_AEON,
917		{ 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
918		  0x00, 0x00, 0x00, 0x00, 0x00 }
919	}, {
920		PCI_VENDOR_HIFN,
921		PCI_PRODUCT_HIFN_7811,
922		{ 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
923		  0x00, 0x00, 0x00, 0x00, 0x00 }
924	}, {
925		/*
926		 * Other vendors share this PCI ID as well, such as
927		 * http://www.powercrypt.com, and obviously they also
928		 * use the same key.
929		 */
930		PCI_VENDOR_HIFN,
931		PCI_PRODUCT_HIFN_7751,
932		{ 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
933		  0x00, 0x00, 0x00, 0x00, 0x00 }
934	},
935};
936
937/*
938 * Checks to see if crypto is already enabled.  If crypto isn't enable,
939 * "hifn_enable_crypto" is called to enable it.  The check is important,
940 * as enabling crypto twice will lock the board.
941 */
942static int
943hifn_enable_crypto(struct hifn_softc *sc)
944{
945	u_int32_t dmacfg, ramcfg, encl, addr, i;
946	char *offtbl = NULL;
947
948	for (i = 0; i < sizeof(pci2id)/sizeof(pci2id[0]); i++) {
949		if (pci2id[i].pci_vendor == pci_get_vendor(sc->sc_dev) &&
950		    pci2id[i].pci_prod == pci_get_device(sc->sc_dev)) {
951			offtbl = pci2id[i].card_id;
952			break;
953		}
954	}
955	if (offtbl == NULL) {
956		device_printf(sc->sc_dev, "Unknown card!\n");
957		return (1);
958	}
959
960	ramcfg = READ_REG_0(sc, HIFN_0_PUCNFG);
961	dmacfg = READ_REG_1(sc, HIFN_1_DMA_CNFG);
962
963	/*
964	 * The RAM config register's encrypt level bit needs to be set before
965	 * every read performed on the encryption level register.
966	 */
967	WRITE_REG_0(sc, HIFN_0_PUCNFG, ramcfg | HIFN_PUCNFG_CHIPID);
968
969	encl = READ_REG_0(sc, HIFN_0_PUSTAT) & HIFN_PUSTAT_CHIPENA;
970
971	/*
972	 * Make sure we don't re-unlock.  Two unlocks kills chip until the
973	 * next reboot.
974	 */
975	if (encl == HIFN_PUSTAT_ENA_1 || encl == HIFN_PUSTAT_ENA_2) {
976#ifdef HIFN_DEBUG
977		if (hifn_debug)
978			device_printf(sc->sc_dev,
979			    "Strong crypto already enabled!\n");
980#endif
981		goto report;
982	}
983
984	if (encl != 0 && encl != HIFN_PUSTAT_ENA_0) {
985#ifdef HIFN_DEBUG
986		if (hifn_debug)
987			device_printf(sc->sc_dev,
988			      "Unknown encryption level 0x%x\n", encl);
989#endif
990		return 1;
991	}
992
993	WRITE_REG_1(sc, HIFN_1_DMA_CNFG, HIFN_DMACNFG_UNLOCK |
994	    HIFN_DMACNFG_MSTRESET | HIFN_DMACNFG_DMARESET | HIFN_DMACNFG_MODE);
995	DELAY(1000);
996	addr = READ_REG_1(sc, HIFN_UNLOCK_SECRET1);
997	DELAY(1000);
998	WRITE_REG_1(sc, HIFN_UNLOCK_SECRET2, 0);
999	DELAY(1000);
1000
1001	for (i = 0; i <= 12; i++) {
1002		addr = hifn_next_signature(addr, offtbl[i] + 0x101);
1003		WRITE_REG_1(sc, HIFN_UNLOCK_SECRET2, addr);
1004
1005		DELAY(1000);
1006	}
1007
1008	WRITE_REG_0(sc, HIFN_0_PUCNFG, ramcfg | HIFN_PUCNFG_CHIPID);
1009	encl = READ_REG_0(sc, HIFN_0_PUSTAT) & HIFN_PUSTAT_CHIPENA;
1010
1011#ifdef HIFN_DEBUG
1012	if (hifn_debug) {
1013		if (encl != HIFN_PUSTAT_ENA_1 && encl != HIFN_PUSTAT_ENA_2)
1014			device_printf(sc->sc_dev, "Engine is permanently "
1015				"locked until next system reset!\n");
1016		else
1017			device_printf(sc->sc_dev, "Engine enabled "
1018				"successfully!\n");
1019	}
1020#endif
1021
1022report:
1023	WRITE_REG_0(sc, HIFN_0_PUCNFG, ramcfg);
1024	WRITE_REG_1(sc, HIFN_1_DMA_CNFG, dmacfg);
1025
1026	switch (encl) {
1027	case HIFN_PUSTAT_ENA_1:
1028	case HIFN_PUSTAT_ENA_2:
1029		break;
1030	case HIFN_PUSTAT_ENA_0:
1031	default:
1032		device_printf(sc->sc_dev, "disabled");
1033		break;
1034	}
1035
1036	return 0;
1037}
1038
1039/*
1040 * Give initial values to the registers listed in the "Register Space"
1041 * section of the HIFN Software Development reference manual.
1042 */
1043static void
1044hifn_init_pci_registers(struct hifn_softc *sc)
1045{
1046	/* write fixed values needed by the Initialization registers */
1047	WRITE_REG_0(sc, HIFN_0_PUCTRL, HIFN_PUCTRL_DMAENA);
1048	WRITE_REG_0(sc, HIFN_0_FIFOCNFG, HIFN_FIFOCNFG_THRESHOLD);
1049	WRITE_REG_0(sc, HIFN_0_PUIER, HIFN_PUIER_DSTOVER);
1050
1051	/* write all 4 ring address registers */
1052	WRITE_REG_1(sc, HIFN_1_DMA_CRAR, sc->sc_dma_physaddr +
1053	    offsetof(struct hifn_dma, cmdr[0]));
1054	WRITE_REG_1(sc, HIFN_1_DMA_SRAR, sc->sc_dma_physaddr +
1055	    offsetof(struct hifn_dma, srcr[0]));
1056	WRITE_REG_1(sc, HIFN_1_DMA_DRAR, sc->sc_dma_physaddr +
1057	    offsetof(struct hifn_dma, dstr[0]));
1058	WRITE_REG_1(sc, HIFN_1_DMA_RRAR, sc->sc_dma_physaddr +
1059	    offsetof(struct hifn_dma, resr[0]));
1060
1061	DELAY(2000);
1062
1063	/* write status register */
1064	WRITE_REG_1(sc, HIFN_1_DMA_CSR,
1065	    HIFN_DMACSR_D_CTRL_DIS | HIFN_DMACSR_R_CTRL_DIS |
1066	    HIFN_DMACSR_S_CTRL_DIS | HIFN_DMACSR_C_CTRL_DIS |
1067	    HIFN_DMACSR_D_ABORT | HIFN_DMACSR_D_DONE | HIFN_DMACSR_D_LAST |
1068	    HIFN_DMACSR_D_WAIT | HIFN_DMACSR_D_OVER |
1069	    HIFN_DMACSR_R_ABORT | HIFN_DMACSR_R_DONE | HIFN_DMACSR_R_LAST |
1070	    HIFN_DMACSR_R_WAIT | HIFN_DMACSR_R_OVER |
1071	    HIFN_DMACSR_S_ABORT | HIFN_DMACSR_S_DONE | HIFN_DMACSR_S_LAST |
1072	    HIFN_DMACSR_S_WAIT |
1073	    HIFN_DMACSR_C_ABORT | HIFN_DMACSR_C_DONE | HIFN_DMACSR_C_LAST |
1074	    HIFN_DMACSR_C_WAIT |
1075	    HIFN_DMACSR_ENGINE |
1076	    ((sc->sc_flags & HIFN_HAS_PUBLIC) ?
1077		HIFN_DMACSR_PUBDONE : 0) |
1078	    ((sc->sc_flags & HIFN_IS_7811) ?
1079		HIFN_DMACSR_ILLW | HIFN_DMACSR_ILLR : 0));
1080
1081	sc->sc_d_busy = sc->sc_r_busy = sc->sc_s_busy = sc->sc_c_busy = 0;
1082	sc->sc_dmaier |= HIFN_DMAIER_R_DONE | HIFN_DMAIER_C_ABORT |
1083	    HIFN_DMAIER_D_OVER | HIFN_DMAIER_R_OVER |
1084	    HIFN_DMAIER_S_ABORT | HIFN_DMAIER_D_ABORT | HIFN_DMAIER_R_ABORT |
1085	    ((sc->sc_flags & HIFN_IS_7811) ?
1086		HIFN_DMAIER_ILLW | HIFN_DMAIER_ILLR : 0);
1087	sc->sc_dmaier &= ~HIFN_DMAIER_C_WAIT;
1088	WRITE_REG_1(sc, HIFN_1_DMA_IER, sc->sc_dmaier);
1089
1090
1091	if (sc->sc_flags & HIFN_IS_7956) {
1092		WRITE_REG_0(sc, HIFN_0_PUCNFG, HIFN_PUCNFG_COMPSING |
1093		    HIFN_PUCNFG_TCALLPHASES |
1094		    HIFN_PUCNFG_TCDRVTOTEM | HIFN_PUCNFG_BUS32);
1095		WRITE_REG_1(sc, HIFN_1_PLL, HIFN_PLL_7956);
1096	} else {
1097		WRITE_REG_0(sc, HIFN_0_PUCNFG, HIFN_PUCNFG_COMPSING |
1098		    HIFN_PUCNFG_DRFR_128 | HIFN_PUCNFG_TCALLPHASES |
1099		    HIFN_PUCNFG_TCDRVTOTEM | HIFN_PUCNFG_BUS32 |
1100		    (sc->sc_drammodel ? HIFN_PUCNFG_DRAM : HIFN_PUCNFG_SRAM));
1101	}
1102
1103	WRITE_REG_0(sc, HIFN_0_PUISR, HIFN_PUISR_DSTOVER);
1104	WRITE_REG_1(sc, HIFN_1_DMA_CNFG, HIFN_DMACNFG_MSTRESET |
1105	    HIFN_DMACNFG_DMARESET | HIFN_DMACNFG_MODE | HIFN_DMACNFG_LAST |
1106	    ((HIFN_POLL_FREQUENCY << 16 ) & HIFN_DMACNFG_POLLFREQ) |
1107	    ((HIFN_POLL_SCALAR << 8) & HIFN_DMACNFG_POLLINVAL));
1108}
1109
1110/*
1111 * The maximum number of sessions supported by the card
1112 * is dependent on the amount of context ram, which
1113 * encryption algorithms are enabled, and how compression
1114 * is configured.  This should be configured before this
1115 * routine is called.
1116 */
1117static void
1118hifn_sessions(struct hifn_softc *sc)
1119{
1120	u_int32_t pucnfg;
1121	int ctxsize;
1122
1123	pucnfg = READ_REG_0(sc, HIFN_0_PUCNFG);
1124
1125	if (pucnfg & HIFN_PUCNFG_COMPSING) {
1126		if (pucnfg & HIFN_PUCNFG_ENCCNFG)
1127			ctxsize = 128;
1128		else
1129			ctxsize = 512;
1130		/*
1131		 * 7955/7956 has internal context memory of 32K
1132		 */
1133		if (sc->sc_flags & HIFN_IS_7956)
1134			sc->sc_maxses = 32768 / ctxsize;
1135		else
1136			sc->sc_maxses = 1 +
1137			    ((sc->sc_ramsize - 32768) / ctxsize);
1138	} else
1139		sc->sc_maxses = sc->sc_ramsize / 16384;
1140
1141	if (sc->sc_maxses > 2048)
1142		sc->sc_maxses = 2048;
1143}
1144
1145/*
1146 * Determine ram type (sram or dram).  Board should be just out of a reset
1147 * state when this is called.
1148 */
1149static int
1150hifn_ramtype(struct hifn_softc *sc)
1151{
1152	u_int8_t data[8], dataexpect[8];
1153	int i;
1154
1155	for (i = 0; i < sizeof(data); i++)
1156		data[i] = dataexpect[i] = 0x55;
1157	if (hifn_writeramaddr(sc, 0, data))
1158		return (-1);
1159	if (hifn_readramaddr(sc, 0, data))
1160		return (-1);
1161	if (bcmp(data, dataexpect, sizeof(data)) != 0) {
1162		sc->sc_drammodel = 1;
1163		return (0);
1164	}
1165
1166	for (i = 0; i < sizeof(data); i++)
1167		data[i] = dataexpect[i] = 0xaa;
1168	if (hifn_writeramaddr(sc, 0, data))
1169		return (-1);
1170	if (hifn_readramaddr(sc, 0, data))
1171		return (-1);
1172	if (bcmp(data, dataexpect, sizeof(data)) != 0) {
1173		sc->sc_drammodel = 1;
1174		return (0);
1175	}
1176
1177	return (0);
1178}
1179
1180#define	HIFN_SRAM_MAX		(32 << 20)
1181#define	HIFN_SRAM_STEP_SIZE	16384
1182#define	HIFN_SRAM_GRANULARITY	(HIFN_SRAM_MAX / HIFN_SRAM_STEP_SIZE)
1183
1184static int
1185hifn_sramsize(struct hifn_softc *sc)
1186{
1187	u_int32_t a;
1188	u_int8_t data[8];
1189	u_int8_t dataexpect[sizeof(data)];
1190	int32_t i;
1191
1192	for (i = 0; i < sizeof(data); i++)
1193		data[i] = dataexpect[i] = i ^ 0x5a;
1194
1195	for (i = HIFN_SRAM_GRANULARITY - 1; i >= 0; i--) {
1196		a = i * HIFN_SRAM_STEP_SIZE;
1197		bcopy(&i, data, sizeof(i));
1198		hifn_writeramaddr(sc, a, data);
1199	}
1200
1201	for (i = 0; i < HIFN_SRAM_GRANULARITY; i++) {
1202		a = i * HIFN_SRAM_STEP_SIZE;
1203		bcopy(&i, dataexpect, sizeof(i));
1204		if (hifn_readramaddr(sc, a, data) < 0)
1205			return (0);
1206		if (bcmp(data, dataexpect, sizeof(data)) != 0)
1207			return (0);
1208		sc->sc_ramsize = a + HIFN_SRAM_STEP_SIZE;
1209	}
1210
1211	return (0);
1212}
1213
1214/*
1215 * XXX For dram boards, one should really try all of the
1216 * HIFN_PUCNFG_DSZ_*'s.  This just assumes that PUCNFG
1217 * is already set up correctly.
1218 */
1219static int
1220hifn_dramsize(struct hifn_softc *sc)
1221{
1222	u_int32_t cnfg;
1223
1224	if (sc->sc_flags & HIFN_IS_7956) {
1225		/*
1226		 * 7955/7956 have a fixed internal ram of only 32K.
1227		 */
1228		sc->sc_ramsize = 32768;
1229	} else {
1230		cnfg = READ_REG_0(sc, HIFN_0_PUCNFG) &
1231		    HIFN_PUCNFG_DRAMMASK;
1232		sc->sc_ramsize = 1 << ((cnfg >> 13) + 18);
1233	}
1234	return (0);
1235}
1236
1237static void
1238hifn_alloc_slot(struct hifn_softc *sc, int *cmdp, int *srcp, int *dstp, int *resp)
1239{
1240	struct hifn_dma *dma = sc->sc_dma;
1241
1242	if (dma->cmdi == HIFN_D_CMD_RSIZE) {
1243		dma->cmdi = 0;
1244		dma->cmdr[HIFN_D_CMD_RSIZE].l = htole32(HIFN_D_VALID |
1245		    HIFN_D_JUMP | HIFN_D_MASKDONEIRQ);
1246		HIFN_CMDR_SYNC(sc, HIFN_D_CMD_RSIZE,
1247		    BUS_DMASYNC_PREWRITE | BUS_DMASYNC_PREREAD);
1248	}
1249	*cmdp = dma->cmdi++;
1250	dma->cmdk = dma->cmdi;
1251
1252	if (dma->srci == HIFN_D_SRC_RSIZE) {
1253		dma->srci = 0;
1254		dma->srcr[HIFN_D_SRC_RSIZE].l = htole32(HIFN_D_VALID |
1255		    HIFN_D_JUMP | HIFN_D_MASKDONEIRQ);
1256		HIFN_SRCR_SYNC(sc, HIFN_D_SRC_RSIZE,
1257		    BUS_DMASYNC_PREWRITE | BUS_DMASYNC_PREREAD);
1258	}
1259	*srcp = dma->srci++;
1260	dma->srck = dma->srci;
1261
1262	if (dma->dsti == HIFN_D_DST_RSIZE) {
1263		dma->dsti = 0;
1264		dma->dstr[HIFN_D_DST_RSIZE].l = htole32(HIFN_D_VALID |
1265		    HIFN_D_JUMP | HIFN_D_MASKDONEIRQ);
1266		HIFN_DSTR_SYNC(sc, HIFN_D_DST_RSIZE,
1267		    BUS_DMASYNC_PREWRITE | BUS_DMASYNC_PREREAD);
1268	}
1269	*dstp = dma->dsti++;
1270	dma->dstk = dma->dsti;
1271
1272	if (dma->resi == HIFN_D_RES_RSIZE) {
1273		dma->resi = 0;
1274		dma->resr[HIFN_D_RES_RSIZE].l = htole32(HIFN_D_VALID |
1275		    HIFN_D_JUMP | HIFN_D_MASKDONEIRQ);
1276		HIFN_RESR_SYNC(sc, HIFN_D_RES_RSIZE,
1277		    BUS_DMASYNC_PREWRITE | BUS_DMASYNC_PREREAD);
1278	}
1279	*resp = dma->resi++;
1280	dma->resk = dma->resi;
1281}
1282
1283static int
1284hifn_writeramaddr(struct hifn_softc *sc, int addr, u_int8_t *data)
1285{
1286	struct hifn_dma *dma = sc->sc_dma;
1287	hifn_base_command_t wc;
1288	const u_int32_t masks = HIFN_D_VALID | HIFN_D_LAST | HIFN_D_MASKDONEIRQ;
1289	int r, cmdi, resi, srci, dsti;
1290
1291	wc.masks = htole16(3 << 13);
1292	wc.session_num = htole16(addr >> 14);
1293	wc.total_source_count = htole16(8);
1294	wc.total_dest_count = htole16(addr & 0x3fff);
1295
1296	hifn_alloc_slot(sc, &cmdi, &srci, &dsti, &resi);
1297
1298	WRITE_REG_1(sc, HIFN_1_DMA_CSR,
1299	    HIFN_DMACSR_C_CTRL_ENA | HIFN_DMACSR_S_CTRL_ENA |
1300	    HIFN_DMACSR_D_CTRL_ENA | HIFN_DMACSR_R_CTRL_ENA);
1301
1302	/* build write command */
1303	bzero(dma->command_bufs[cmdi], HIFN_MAX_COMMAND);
1304	*(hifn_base_command_t *)dma->command_bufs[cmdi] = wc;
1305	bcopy(data, &dma->test_src, sizeof(dma->test_src));
1306
1307	dma->srcr[srci].p = htole32(sc->sc_dma_physaddr
1308	    + offsetof(struct hifn_dma, test_src));
1309	dma->dstr[dsti].p = htole32(sc->sc_dma_physaddr
1310	    + offsetof(struct hifn_dma, test_dst));
1311
1312	dma->cmdr[cmdi].l = htole32(16 | masks);
1313	dma->srcr[srci].l = htole32(8 | masks);
1314	dma->dstr[dsti].l = htole32(4 | masks);
1315	dma->resr[resi].l = htole32(4 | masks);
1316
1317	bus_dmamap_sync(sc->sc_dmat, sc->sc_dmamap,
1318	    BUS_DMASYNC_PREREAD | BUS_DMASYNC_PREWRITE);
1319
1320	for (r = 10000; r >= 0; r--) {
1321		DELAY(10);
1322		bus_dmamap_sync(sc->sc_dmat, sc->sc_dmamap,
1323		    BUS_DMASYNC_POSTREAD | BUS_DMASYNC_POSTWRITE);
1324		if ((dma->resr[resi].l & htole32(HIFN_D_VALID)) == 0)
1325			break;
1326		bus_dmamap_sync(sc->sc_dmat, sc->sc_dmamap,
1327		    BUS_DMASYNC_PREREAD | BUS_DMASYNC_PREWRITE);
1328	}
1329	if (r == 0) {
1330		device_printf(sc->sc_dev, "writeramaddr -- "
1331		    "result[%d](addr %d) still valid\n", resi, addr);
1332		r = -1;
1333		return (-1);
1334	} else
1335		r = 0;
1336
1337	WRITE_REG_1(sc, HIFN_1_DMA_CSR,
1338	    HIFN_DMACSR_C_CTRL_DIS | HIFN_DMACSR_S_CTRL_DIS |
1339	    HIFN_DMACSR_D_CTRL_DIS | HIFN_DMACSR_R_CTRL_DIS);
1340
1341	return (r);
1342}
1343
1344static int
1345hifn_readramaddr(struct hifn_softc *sc, int addr, u_int8_t *data)
1346{
1347	struct hifn_dma *dma = sc->sc_dma;
1348	hifn_base_command_t rc;
1349	const u_int32_t masks = HIFN_D_VALID | HIFN_D_LAST | HIFN_D_MASKDONEIRQ;
1350	int r, cmdi, srci, dsti, resi;
1351
1352	rc.masks = htole16(2 << 13);
1353	rc.session_num = htole16(addr >> 14);
1354	rc.total_source_count = htole16(addr & 0x3fff);
1355	rc.total_dest_count = htole16(8);
1356
1357	hifn_alloc_slot(sc, &cmdi, &srci, &dsti, &resi);
1358
1359	WRITE_REG_1(sc, HIFN_1_DMA_CSR,
1360	    HIFN_DMACSR_C_CTRL_ENA | HIFN_DMACSR_S_CTRL_ENA |
1361	    HIFN_DMACSR_D_CTRL_ENA | HIFN_DMACSR_R_CTRL_ENA);
1362
1363	bzero(dma->command_bufs[cmdi], HIFN_MAX_COMMAND);
1364	*(hifn_base_command_t *)dma->command_bufs[cmdi] = rc;
1365
1366	dma->srcr[srci].p = htole32(sc->sc_dma_physaddr +
1367	    offsetof(struct hifn_dma, test_src));
1368	dma->test_src = 0;
1369	dma->dstr[dsti].p =  htole32(sc->sc_dma_physaddr +
1370	    offsetof(struct hifn_dma, test_dst));
1371	dma->test_dst = 0;
1372	dma->cmdr[cmdi].l = htole32(8 | masks);
1373	dma->srcr[srci].l = htole32(8 | masks);
1374	dma->dstr[dsti].l = htole32(8 | masks);
1375	dma->resr[resi].l = htole32(HIFN_MAX_RESULT | masks);
1376
1377	bus_dmamap_sync(sc->sc_dmat, sc->sc_dmamap,
1378	    BUS_DMASYNC_PREREAD | BUS_DMASYNC_PREWRITE);
1379
1380	for (r = 10000; r >= 0; r--) {
1381		DELAY(10);
1382		bus_dmamap_sync(sc->sc_dmat, sc->sc_dmamap,
1383		    BUS_DMASYNC_POSTREAD | BUS_DMASYNC_POSTWRITE);
1384		if ((dma->resr[resi].l & htole32(HIFN_D_VALID)) == 0)
1385			break;
1386		bus_dmamap_sync(sc->sc_dmat, sc->sc_dmamap,
1387		    BUS_DMASYNC_PREREAD | BUS_DMASYNC_PREWRITE);
1388	}
1389	if (r == 0) {
1390		device_printf(sc->sc_dev, "readramaddr -- "
1391		    "result[%d](addr %d) still valid\n", resi, addr);
1392		r = -1;
1393	} else {
1394		r = 0;
1395		bcopy(&dma->test_dst, data, sizeof(dma->test_dst));
1396	}
1397
1398	WRITE_REG_1(sc, HIFN_1_DMA_CSR,
1399	    HIFN_DMACSR_C_CTRL_DIS | HIFN_DMACSR_S_CTRL_DIS |
1400	    HIFN_DMACSR_D_CTRL_DIS | HIFN_DMACSR_R_CTRL_DIS);
1401
1402	return (r);
1403}
1404
1405/*
1406 * Initialize the descriptor rings.
1407 */
1408static void
1409hifn_init_dma(struct hifn_softc *sc)
1410{
1411	struct hifn_dma *dma = sc->sc_dma;
1412	int i;
1413
1414	hifn_set_retry(sc);
1415
1416	/* initialize static pointer values */
1417	for (i = 0; i < HIFN_D_CMD_RSIZE; i++)
1418		dma->cmdr[i].p = htole32(sc->sc_dma_physaddr +
1419		    offsetof(struct hifn_dma, command_bufs[i][0]));
1420	for (i = 0; i < HIFN_D_RES_RSIZE; i++)
1421		dma->resr[i].p = htole32(sc->sc_dma_physaddr +
1422		    offsetof(struct hifn_dma, result_bufs[i][0]));
1423
1424	dma->cmdr[HIFN_D_CMD_RSIZE].p =
1425	    htole32(sc->sc_dma_physaddr + offsetof(struct hifn_dma, cmdr[0]));
1426	dma->srcr[HIFN_D_SRC_RSIZE].p =
1427	    htole32(sc->sc_dma_physaddr + offsetof(struct hifn_dma, srcr[0]));
1428	dma->dstr[HIFN_D_DST_RSIZE].p =
1429	    htole32(sc->sc_dma_physaddr + offsetof(struct hifn_dma, dstr[0]));
1430	dma->resr[HIFN_D_RES_RSIZE].p =
1431	    htole32(sc->sc_dma_physaddr + offsetof(struct hifn_dma, resr[0]));
1432
1433	dma->cmdu = dma->srcu = dma->dstu = dma->resu = 0;
1434	dma->cmdi = dma->srci = dma->dsti = dma->resi = 0;
1435	dma->cmdk = dma->srck = dma->dstk = dma->resk = 0;
1436}
1437
1438/*
1439 * Writes out the raw command buffer space.  Returns the
1440 * command buffer size.
1441 */
1442static u_int
1443hifn_write_command(struct hifn_command *cmd, u_int8_t *buf)
1444{
1445	u_int8_t *buf_pos;
1446	hifn_base_command_t *base_cmd;
1447	hifn_mac_command_t *mac_cmd;
1448	hifn_crypt_command_t *cry_cmd;
1449	int using_mac, using_crypt, len, ivlen;
1450	u_int32_t dlen, slen;
1451
1452	buf_pos = buf;
1453	using_mac = cmd->base_masks & HIFN_BASE_CMD_MAC;
1454	using_crypt = cmd->base_masks & HIFN_BASE_CMD_CRYPT;
1455
1456	base_cmd = (hifn_base_command_t *)buf_pos;
1457	base_cmd->masks = htole16(cmd->base_masks);
1458	slen = cmd->src_mapsize;
1459	if (cmd->sloplen)
1460		dlen = cmd->dst_mapsize - cmd->sloplen + sizeof(u_int32_t);
1461	else
1462		dlen = cmd->dst_mapsize;
1463	base_cmd->total_source_count = htole16(slen & HIFN_BASE_CMD_LENMASK_LO);
1464	base_cmd->total_dest_count = htole16(dlen & HIFN_BASE_CMD_LENMASK_LO);
1465	dlen >>= 16;
1466	slen >>= 16;
1467	base_cmd->session_num = htole16(
1468	    ((slen << HIFN_BASE_CMD_SRCLEN_S) & HIFN_BASE_CMD_SRCLEN_M) |
1469	    ((dlen << HIFN_BASE_CMD_DSTLEN_S) & HIFN_BASE_CMD_DSTLEN_M));
1470	buf_pos += sizeof(hifn_base_command_t);
1471
1472	if (using_mac) {
1473		mac_cmd = (hifn_mac_command_t *)buf_pos;
1474		dlen = cmd->maccrd->crd_len;
1475		mac_cmd->source_count = htole16(dlen & 0xffff);
1476		dlen >>= 16;
1477		mac_cmd->masks = htole16(cmd->mac_masks |
1478		    ((dlen << HIFN_MAC_CMD_SRCLEN_S) & HIFN_MAC_CMD_SRCLEN_M));
1479		mac_cmd->header_skip = htole16(cmd->maccrd->crd_skip);
1480		mac_cmd->reserved = 0;
1481		buf_pos += sizeof(hifn_mac_command_t);
1482	}
1483
1484	if (using_crypt) {
1485		cry_cmd = (hifn_crypt_command_t *)buf_pos;
1486		dlen = cmd->enccrd->crd_len;
1487		cry_cmd->source_count = htole16(dlen & 0xffff);
1488		dlen >>= 16;
1489		cry_cmd->masks = htole16(cmd->cry_masks |
1490		    ((dlen << HIFN_CRYPT_CMD_SRCLEN_S) & HIFN_CRYPT_CMD_SRCLEN_M));
1491		cry_cmd->header_skip = htole16(cmd->enccrd->crd_skip);
1492		cry_cmd->reserved = 0;
1493		buf_pos += sizeof(hifn_crypt_command_t);
1494	}
1495
1496	if (using_mac && cmd->mac_masks & HIFN_MAC_CMD_NEW_KEY) {
1497		bcopy(cmd->mac, buf_pos, HIFN_MAC_KEY_LENGTH);
1498		buf_pos += HIFN_MAC_KEY_LENGTH;
1499	}
1500
1501	if (using_crypt && cmd->cry_masks & HIFN_CRYPT_CMD_NEW_KEY) {
1502		switch (cmd->cry_masks & HIFN_CRYPT_CMD_ALG_MASK) {
1503		case HIFN_CRYPT_CMD_ALG_3DES:
1504			bcopy(cmd->ck, buf_pos, HIFN_3DES_KEY_LENGTH);
1505			buf_pos += HIFN_3DES_KEY_LENGTH;
1506			break;
1507		case HIFN_CRYPT_CMD_ALG_DES:
1508			bcopy(cmd->ck, buf_pos, HIFN_DES_KEY_LENGTH);
1509			buf_pos += HIFN_DES_KEY_LENGTH;
1510			break;
1511		case HIFN_CRYPT_CMD_ALG_RC4:
1512			len = 256;
1513			do {
1514				int clen;
1515
1516				clen = MIN(cmd->cklen, len);
1517				bcopy(cmd->ck, buf_pos, clen);
1518				len -= clen;
1519				buf_pos += clen;
1520			} while (len > 0);
1521			bzero(buf_pos, 4);
1522			buf_pos += 4;
1523			break;
1524		case HIFN_CRYPT_CMD_ALG_AES:
1525			/*
1526			 * AES keys are variable 128, 192 and
1527			 * 256 bits (16, 24 and 32 bytes).
1528			 */
1529			bcopy(cmd->ck, buf_pos, cmd->cklen);
1530			buf_pos += cmd->cklen;
1531			break;
1532		}
1533	}
1534
1535	if (using_crypt && cmd->cry_masks & HIFN_CRYPT_CMD_NEW_IV) {
1536		switch (cmd->cry_masks & HIFN_CRYPT_CMD_ALG_MASK) {
1537		case HIFN_CRYPT_CMD_ALG_AES:
1538			ivlen = HIFN_AES_IV_LENGTH;
1539			break;
1540		default:
1541			ivlen = HIFN_IV_LENGTH;
1542			break;
1543		}
1544		bcopy(cmd->iv, buf_pos, ivlen);
1545		buf_pos += ivlen;
1546	}
1547
1548	if ((cmd->base_masks & (HIFN_BASE_CMD_MAC|HIFN_BASE_CMD_CRYPT)) == 0) {
1549		bzero(buf_pos, 8);
1550		buf_pos += 8;
1551	}
1552
1553	return (buf_pos - buf);
1554}
1555
1556static int
1557hifn_dmamap_aligned(struct hifn_operand *op)
1558{
1559	int i;
1560
1561	for (i = 0; i < op->nsegs; i++) {
1562		if (op->segs[i].ds_addr & 3)
1563			return (0);
1564		if ((i != (op->nsegs - 1)) && (op->segs[i].ds_len & 3))
1565			return (0);
1566	}
1567	return (1);
1568}
1569
1570static int
1571hifn_dmamap_load_dst(struct hifn_softc *sc, struct hifn_command *cmd)
1572{
1573	struct hifn_dma *dma = sc->sc_dma;
1574	struct hifn_operand *dst = &cmd->dst;
1575	u_int32_t p, l;
1576	int idx, used = 0, i;
1577
1578	idx = dma->dsti;
1579	for (i = 0; i < dst->nsegs - 1; i++) {
1580		dma->dstr[idx].p = htole32(dst->segs[i].ds_addr);
1581		dma->dstr[idx].l = htole32(HIFN_D_VALID |
1582		    HIFN_D_MASKDONEIRQ | dst->segs[i].ds_len);
1583		HIFN_DSTR_SYNC(sc, idx,
1584		    BUS_DMASYNC_PREREAD | BUS_DMASYNC_PREWRITE);
1585		used++;
1586
1587		if (++idx == HIFN_D_DST_RSIZE) {
1588			dma->dstr[idx].l = htole32(HIFN_D_VALID |
1589			    HIFN_D_JUMP | HIFN_D_MASKDONEIRQ);
1590			HIFN_DSTR_SYNC(sc, idx,
1591			    BUS_DMASYNC_PREREAD | BUS_DMASYNC_PREWRITE);
1592			idx = 0;
1593		}
1594	}
1595
1596	if (cmd->sloplen == 0) {
1597		p = dst->segs[i].ds_addr;
1598		l = HIFN_D_VALID | HIFN_D_MASKDONEIRQ | HIFN_D_LAST |
1599		    dst->segs[i].ds_len;
1600	} else {
1601		p = sc->sc_dma_physaddr +
1602		    offsetof(struct hifn_dma, slop[cmd->slopidx]);
1603		l = HIFN_D_VALID | HIFN_D_MASKDONEIRQ | HIFN_D_LAST |
1604		    sizeof(u_int32_t);
1605
1606		if ((dst->segs[i].ds_len - cmd->sloplen) != 0) {
1607			dma->dstr[idx].p = htole32(dst->segs[i].ds_addr);
1608			dma->dstr[idx].l = htole32(HIFN_D_VALID |
1609			    HIFN_D_MASKDONEIRQ |
1610			    (dst->segs[i].ds_len - cmd->sloplen));
1611			HIFN_DSTR_SYNC(sc, idx,
1612			    BUS_DMASYNC_PREREAD | BUS_DMASYNC_PREWRITE);
1613			used++;
1614
1615			if (++idx == HIFN_D_DST_RSIZE) {
1616				dma->dstr[idx].l = htole32(HIFN_D_VALID |
1617				    HIFN_D_JUMP | HIFN_D_MASKDONEIRQ);
1618				HIFN_DSTR_SYNC(sc, idx,
1619				    BUS_DMASYNC_PREREAD | BUS_DMASYNC_PREWRITE);
1620				idx = 0;
1621			}
1622		}
1623	}
1624	dma->dstr[idx].p = htole32(p);
1625	dma->dstr[idx].l = htole32(l);
1626	HIFN_DSTR_SYNC(sc, idx, BUS_DMASYNC_PREREAD | BUS_DMASYNC_PREWRITE);
1627	used++;
1628
1629	if (++idx == HIFN_D_DST_RSIZE) {
1630		dma->dstr[idx].l = htole32(HIFN_D_VALID | HIFN_D_JUMP |
1631		    HIFN_D_MASKDONEIRQ);
1632		HIFN_DSTR_SYNC(sc, idx,
1633		    BUS_DMASYNC_PREREAD | BUS_DMASYNC_PREWRITE);
1634		idx = 0;
1635	}
1636
1637	dma->dsti = idx;
1638	dma->dstu += used;
1639	return (idx);
1640}
1641
1642static int
1643hifn_dmamap_load_src(struct hifn_softc *sc, struct hifn_command *cmd)
1644{
1645	struct hifn_dma *dma = sc->sc_dma;
1646	struct hifn_operand *src = &cmd->src;
1647	int idx, i;
1648	u_int32_t last = 0;
1649
1650	idx = dma->srci;
1651	for (i = 0; i < src->nsegs; i++) {
1652		if (i == src->nsegs - 1)
1653			last = HIFN_D_LAST;
1654
1655		dma->srcr[idx].p = htole32(src->segs[i].ds_addr);
1656		dma->srcr[idx].l = htole32(src->segs[i].ds_len |
1657		    HIFN_D_VALID | HIFN_D_MASKDONEIRQ | last);
1658		HIFN_SRCR_SYNC(sc, idx,
1659		    BUS_DMASYNC_PREWRITE | BUS_DMASYNC_PREREAD);
1660
1661		if (++idx == HIFN_D_SRC_RSIZE) {
1662			dma->srcr[idx].l = htole32(HIFN_D_VALID |
1663			    HIFN_D_JUMP | HIFN_D_MASKDONEIRQ);
1664			HIFN_SRCR_SYNC(sc, HIFN_D_SRC_RSIZE,
1665			    BUS_DMASYNC_PREWRITE | BUS_DMASYNC_PREREAD);
1666			idx = 0;
1667		}
1668	}
1669	dma->srci = idx;
1670	dma->srcu += src->nsegs;
1671	return (idx);
1672}
1673
1674static void
1675hifn_op_cb(void* arg, bus_dma_segment_t *seg, int nsegs, bus_size_t mapsize, int error)
1676{
1677	struct hifn_operand *op = arg;
1678
1679	KASSERT(nsegs <= MAX_SCATTER,
1680		("hifn_op_cb: too many DMA segments (%u > %u) "
1681		 "returned when mapping operand", nsegs, MAX_SCATTER));
1682	op->mapsize = mapsize;
1683	op->nsegs = nsegs;
1684	bcopy(seg, op->segs, nsegs * sizeof (seg[0]));
1685}
1686
1687static int
1688hifn_crypto(
1689	struct hifn_softc *sc,
1690	struct hifn_command *cmd,
1691	struct cryptop *crp,
1692	int hint)
1693{
1694	struct	hifn_dma *dma = sc->sc_dma;
1695	u_int32_t cmdlen;
1696	int cmdi, resi, err = 0;
1697
1698	/*
1699	 * need 1 cmd, and 1 res
1700	 *
1701	 * NB: check this first since it's easy.
1702	 */
1703	HIFN_LOCK(sc);
1704	if ((dma->cmdu + 1) > HIFN_D_CMD_RSIZE ||
1705	    (dma->resu + 1) > HIFN_D_RES_RSIZE) {
1706#ifdef HIFN_DEBUG
1707		if (hifn_debug) {
1708			device_printf(sc->sc_dev,
1709				"cmd/result exhaustion, cmdu %u resu %u\n",
1710				dma->cmdu, dma->resu);
1711		}
1712#endif
1713		hifnstats.hst_nomem_cr++;
1714		HIFN_UNLOCK(sc);
1715		return (ERESTART);
1716	}
1717
1718	if (bus_dmamap_create(sc->sc_dmat, BUS_DMA_NOWAIT, &cmd->src_map)) {
1719		hifnstats.hst_nomem_map++;
1720		HIFN_UNLOCK(sc);
1721		return (ENOMEM);
1722	}
1723
1724	if (crp->crp_flags & CRYPTO_F_IMBUF) {
1725		if (bus_dmamap_load_mbuf(sc->sc_dmat, cmd->src_map,
1726		    cmd->src_m, hifn_op_cb, &cmd->src, BUS_DMA_NOWAIT)) {
1727			hifnstats.hst_nomem_load++;
1728			err = ENOMEM;
1729			goto err_srcmap1;
1730		}
1731	} else if (crp->crp_flags & CRYPTO_F_IOV) {
1732		if (bus_dmamap_load_uio(sc->sc_dmat, cmd->src_map,
1733		    cmd->src_io, hifn_op_cb, &cmd->src, BUS_DMA_NOWAIT)) {
1734			hifnstats.hst_nomem_load++;
1735			err = ENOMEM;
1736			goto err_srcmap1;
1737		}
1738	} else {
1739		err = EINVAL;
1740		goto err_srcmap1;
1741	}
1742
1743	if (hifn_dmamap_aligned(&cmd->src)) {
1744		cmd->sloplen = cmd->src_mapsize & 3;
1745		cmd->dst = cmd->src;
1746	} else {
1747		if (crp->crp_flags & CRYPTO_F_IOV) {
1748			err = EINVAL;
1749			goto err_srcmap;
1750		} else if (crp->crp_flags & CRYPTO_F_IMBUF) {
1751			int totlen, len;
1752			struct mbuf *m, *m0, *mlast;
1753
1754			KASSERT(cmd->dst_m == cmd->src_m,
1755				("hifn_crypto: dst_m initialized improperly"));
1756			hifnstats.hst_unaligned++;
1757			/*
1758			 * Source is not aligned on a longword boundary.
1759			 * Copy the data to insure alignment.  If we fail
1760			 * to allocate mbufs or clusters while doing this
1761			 * we return ERESTART so the operation is requeued
1762			 * at the crypto later, but only if there are
1763			 * ops already posted to the hardware; otherwise we
1764			 * have no guarantee that we'll be re-entered.
1765			 */
1766			totlen = cmd->src_mapsize;
1767			if (cmd->src_m->m_flags & M_PKTHDR) {
1768				len = MHLEN;
1769				MGETHDR(m0, M_DONTWAIT, MT_DATA);
1770				if (m0 && !m_dup_pkthdr(m0, cmd->src_m, M_DONTWAIT)) {
1771					m_free(m0);
1772					m0 = NULL;
1773				}
1774			} else {
1775				len = MLEN;
1776				MGET(m0, M_DONTWAIT, MT_DATA);
1777			}
1778			if (m0 == NULL) {
1779				hifnstats.hst_nomem_mbuf++;
1780				err = dma->cmdu ? ERESTART : ENOMEM;
1781				goto err_srcmap;
1782			}
1783			if (totlen >= MINCLSIZE) {
1784				MCLGET(m0, M_DONTWAIT);
1785				if ((m0->m_flags & M_EXT) == 0) {
1786					hifnstats.hst_nomem_mcl++;
1787					err = dma->cmdu ? ERESTART : ENOMEM;
1788					m_freem(m0);
1789					goto err_srcmap;
1790				}
1791				len = MCLBYTES;
1792			}
1793			totlen -= len;
1794			m0->m_pkthdr.len = m0->m_len = len;
1795			mlast = m0;
1796
1797			while (totlen > 0) {
1798				MGET(m, M_DONTWAIT, MT_DATA);
1799				if (m == NULL) {
1800					hifnstats.hst_nomem_mbuf++;
1801					err = dma->cmdu ? ERESTART : ENOMEM;
1802					m_freem(m0);
1803					goto err_srcmap;
1804				}
1805				len = MLEN;
1806				if (totlen >= MINCLSIZE) {
1807					MCLGET(m, M_DONTWAIT);
1808					if ((m->m_flags & M_EXT) == 0) {
1809						hifnstats.hst_nomem_mcl++;
1810						err = dma->cmdu ? ERESTART : ENOMEM;
1811						mlast->m_next = m;
1812						m_freem(m0);
1813						goto err_srcmap;
1814					}
1815					len = MCLBYTES;
1816				}
1817
1818				m->m_len = len;
1819				m0->m_pkthdr.len += len;
1820				totlen -= len;
1821
1822				mlast->m_next = m;
1823				mlast = m;
1824			}
1825			cmd->dst_m = m0;
1826		}
1827	}
1828
1829	if (cmd->dst_map == NULL) {
1830		if (bus_dmamap_create(sc->sc_dmat, BUS_DMA_NOWAIT, &cmd->dst_map)) {
1831			hifnstats.hst_nomem_map++;
1832			err = ENOMEM;
1833			goto err_srcmap;
1834		}
1835		if (crp->crp_flags & CRYPTO_F_IMBUF) {
1836			if (bus_dmamap_load_mbuf(sc->sc_dmat, cmd->dst_map,
1837			    cmd->dst_m, hifn_op_cb, &cmd->dst, BUS_DMA_NOWAIT)) {
1838				hifnstats.hst_nomem_map++;
1839				err = ENOMEM;
1840				goto err_dstmap1;
1841			}
1842		} else if (crp->crp_flags & CRYPTO_F_IOV) {
1843			if (bus_dmamap_load_uio(sc->sc_dmat, cmd->dst_map,
1844			    cmd->dst_io, hifn_op_cb, &cmd->dst, BUS_DMA_NOWAIT)) {
1845				hifnstats.hst_nomem_load++;
1846				err = ENOMEM;
1847				goto err_dstmap1;
1848			}
1849		}
1850	}
1851
1852#ifdef HIFN_DEBUG
1853	if (hifn_debug) {
1854		device_printf(sc->sc_dev,
1855		    "Entering cmd: stat %8x ien %8x u %d/%d/%d/%d n %d/%d\n",
1856		    READ_REG_1(sc, HIFN_1_DMA_CSR),
1857		    READ_REG_1(sc, HIFN_1_DMA_IER),
1858		    dma->cmdu, dma->srcu, dma->dstu, dma->resu,
1859		    cmd->src_nsegs, cmd->dst_nsegs);
1860	}
1861#endif
1862
1863	if (cmd->src_map == cmd->dst_map) {
1864		bus_dmamap_sync(sc->sc_dmat, cmd->src_map,
1865		    BUS_DMASYNC_PREWRITE|BUS_DMASYNC_PREREAD);
1866	} else {
1867		bus_dmamap_sync(sc->sc_dmat, cmd->src_map,
1868		    BUS_DMASYNC_PREWRITE);
1869		bus_dmamap_sync(sc->sc_dmat, cmd->dst_map,
1870		    BUS_DMASYNC_PREREAD);
1871	}
1872
1873	/*
1874	 * need N src, and N dst
1875	 */
1876	if ((dma->srcu + cmd->src_nsegs) > HIFN_D_SRC_RSIZE ||
1877	    (dma->dstu + cmd->dst_nsegs + 1) > HIFN_D_DST_RSIZE) {
1878#ifdef HIFN_DEBUG
1879		if (hifn_debug) {
1880			device_printf(sc->sc_dev,
1881				"src/dst exhaustion, srcu %u+%u dstu %u+%u\n",
1882				dma->srcu, cmd->src_nsegs,
1883				dma->dstu, cmd->dst_nsegs);
1884		}
1885#endif
1886		hifnstats.hst_nomem_sd++;
1887		err = ERESTART;
1888		goto err_dstmap;
1889	}
1890
1891	if (dma->cmdi == HIFN_D_CMD_RSIZE) {
1892		dma->cmdi = 0;
1893		dma->cmdr[HIFN_D_CMD_RSIZE].l = htole32(HIFN_D_VALID |
1894		    HIFN_D_JUMP | HIFN_D_MASKDONEIRQ);
1895		HIFN_CMDR_SYNC(sc, HIFN_D_CMD_RSIZE,
1896		    BUS_DMASYNC_PREWRITE | BUS_DMASYNC_PREREAD);
1897	}
1898	cmdi = dma->cmdi++;
1899	cmdlen = hifn_write_command(cmd, dma->command_bufs[cmdi]);
1900	HIFN_CMD_SYNC(sc, cmdi, BUS_DMASYNC_PREWRITE);
1901
1902	/* .p for command/result already set */
1903	dma->cmdr[cmdi].l = htole32(cmdlen | HIFN_D_VALID | HIFN_D_LAST |
1904	    HIFN_D_MASKDONEIRQ);
1905	HIFN_CMDR_SYNC(sc, cmdi,
1906	    BUS_DMASYNC_PREWRITE | BUS_DMASYNC_PREREAD);
1907	dma->cmdu++;
1908	if (sc->sc_c_busy == 0) {
1909		WRITE_REG_1(sc, HIFN_1_DMA_CSR, HIFN_DMACSR_C_CTRL_ENA);
1910		sc->sc_c_busy = 1;
1911	}
1912
1913	/*
1914	 * We don't worry about missing an interrupt (which a "command wait"
1915	 * interrupt salvages us from), unless there is more than one command
1916	 * in the queue.
1917	 */
1918	if (dma->cmdu > 1) {
1919		sc->sc_dmaier |= HIFN_DMAIER_C_WAIT;
1920		WRITE_REG_1(sc, HIFN_1_DMA_IER, sc->sc_dmaier);
1921	}
1922
1923	hifnstats.hst_ipackets++;
1924	hifnstats.hst_ibytes += cmd->src_mapsize;
1925
1926	hifn_dmamap_load_src(sc, cmd);
1927	if (sc->sc_s_busy == 0) {
1928		WRITE_REG_1(sc, HIFN_1_DMA_CSR, HIFN_DMACSR_S_CTRL_ENA);
1929		sc->sc_s_busy = 1;
1930	}
1931
1932	/*
1933	 * Unlike other descriptors, we don't mask done interrupt from
1934	 * result descriptor.
1935	 */
1936#ifdef HIFN_DEBUG
1937	if (hifn_debug)
1938		printf("load res\n");
1939#endif
1940	if (dma->resi == HIFN_D_RES_RSIZE) {
1941		dma->resi = 0;
1942		dma->resr[HIFN_D_RES_RSIZE].l = htole32(HIFN_D_VALID |
1943		    HIFN_D_JUMP | HIFN_D_MASKDONEIRQ);
1944		HIFN_RESR_SYNC(sc, HIFN_D_RES_RSIZE,
1945		    BUS_DMASYNC_PREREAD | BUS_DMASYNC_PREWRITE);
1946	}
1947	resi = dma->resi++;
1948	KASSERT(dma->hifn_commands[resi] == NULL,
1949		("hifn_crypto: command slot %u busy", resi));
1950	dma->hifn_commands[resi] = cmd;
1951	HIFN_RES_SYNC(sc, resi, BUS_DMASYNC_PREREAD);
1952	if ((hint & CRYPTO_HINT_MORE) && sc->sc_curbatch < hifn_maxbatch) {
1953		dma->resr[resi].l = htole32(HIFN_MAX_RESULT |
1954		    HIFN_D_VALID | HIFN_D_LAST | HIFN_D_MASKDONEIRQ);
1955		sc->sc_curbatch++;
1956		if (sc->sc_curbatch > hifnstats.hst_maxbatch)
1957			hifnstats.hst_maxbatch = sc->sc_curbatch;
1958		hifnstats.hst_totbatch++;
1959	} else {
1960		dma->resr[resi].l = htole32(HIFN_MAX_RESULT |
1961		    HIFN_D_VALID | HIFN_D_LAST);
1962		sc->sc_curbatch = 0;
1963	}
1964	HIFN_RESR_SYNC(sc, resi,
1965	    BUS_DMASYNC_PREREAD | BUS_DMASYNC_PREWRITE);
1966	dma->resu++;
1967	if (sc->sc_r_busy == 0) {
1968		WRITE_REG_1(sc, HIFN_1_DMA_CSR, HIFN_DMACSR_R_CTRL_ENA);
1969		sc->sc_r_busy = 1;
1970	}
1971
1972	if (cmd->sloplen)
1973		cmd->slopidx = resi;
1974
1975	hifn_dmamap_load_dst(sc, cmd);
1976
1977	if (sc->sc_d_busy == 0) {
1978		WRITE_REG_1(sc, HIFN_1_DMA_CSR, HIFN_DMACSR_D_CTRL_ENA);
1979		sc->sc_d_busy = 1;
1980	}
1981
1982#ifdef HIFN_DEBUG
1983	if (hifn_debug) {
1984		device_printf(sc->sc_dev, "command: stat %8x ier %8x\n",
1985		    READ_REG_1(sc, HIFN_1_DMA_CSR),
1986		    READ_REG_1(sc, HIFN_1_DMA_IER));
1987	}
1988#endif
1989
1990	sc->sc_active = 5;
1991	HIFN_UNLOCK(sc);
1992	KASSERT(err == 0, ("hifn_crypto: success with error %u", err));
1993	return (err);		/* success */
1994
1995err_dstmap:
1996	if (cmd->src_map != cmd->dst_map)
1997		bus_dmamap_unload(sc->sc_dmat, cmd->dst_map);
1998err_dstmap1:
1999	if (cmd->src_map != cmd->dst_map)
2000		bus_dmamap_destroy(sc->sc_dmat, cmd->dst_map);
2001err_srcmap:
2002	if (crp->crp_flags & CRYPTO_F_IMBUF) {
2003		if (cmd->src_m != cmd->dst_m)
2004			m_freem(cmd->dst_m);
2005	}
2006	bus_dmamap_unload(sc->sc_dmat, cmd->src_map);
2007err_srcmap1:
2008	bus_dmamap_destroy(sc->sc_dmat, cmd->src_map);
2009	HIFN_UNLOCK(sc);
2010	return (err);
2011}
2012
2013static void
2014hifn_tick(void* vsc)
2015{
2016	struct hifn_softc *sc = vsc;
2017
2018	HIFN_LOCK(sc);
2019	if (sc->sc_active == 0) {
2020		struct hifn_dma *dma = sc->sc_dma;
2021		u_int32_t r = 0;
2022
2023		if (dma->cmdu == 0 && sc->sc_c_busy) {
2024			sc->sc_c_busy = 0;
2025			r |= HIFN_DMACSR_C_CTRL_DIS;
2026		}
2027		if (dma->srcu == 0 && sc->sc_s_busy) {
2028			sc->sc_s_busy = 0;
2029			r |= HIFN_DMACSR_S_CTRL_DIS;
2030		}
2031		if (dma->dstu == 0 && sc->sc_d_busy) {
2032			sc->sc_d_busy = 0;
2033			r |= HIFN_DMACSR_D_CTRL_DIS;
2034		}
2035		if (dma->resu == 0 && sc->sc_r_busy) {
2036			sc->sc_r_busy = 0;
2037			r |= HIFN_DMACSR_R_CTRL_DIS;
2038		}
2039		if (r)
2040			WRITE_REG_1(sc, HIFN_1_DMA_CSR, r);
2041	} else
2042		sc->sc_active--;
2043	HIFN_UNLOCK(sc);
2044	callout_reset(&sc->sc_tickto, hz, hifn_tick, sc);
2045}
2046
2047static void
2048hifn_intr(void *arg)
2049{
2050	struct hifn_softc *sc = arg;
2051	struct hifn_dma *dma;
2052	u_int32_t dmacsr, restart;
2053	int i, u;
2054
2055	dmacsr = READ_REG_1(sc, HIFN_1_DMA_CSR);
2056
2057	/* Nothing in the DMA unit interrupted */
2058	if ((dmacsr & sc->sc_dmaier) == 0)
2059		return;
2060
2061	HIFN_LOCK(sc);
2062
2063	dma = sc->sc_dma;
2064
2065#ifdef HIFN_DEBUG
2066	if (hifn_debug) {
2067		device_printf(sc->sc_dev,
2068		    "irq: stat %08x ien %08x damier %08x i %d/%d/%d/%d k %d/%d/%d/%d u %d/%d/%d/%d\n",
2069		    dmacsr, READ_REG_1(sc, HIFN_1_DMA_IER), sc->sc_dmaier,
2070		    dma->cmdi, dma->srci, dma->dsti, dma->resi,
2071		    dma->cmdk, dma->srck, dma->dstk, dma->resk,
2072		    dma->cmdu, dma->srcu, dma->dstu, dma->resu);
2073	}
2074#endif
2075
2076	WRITE_REG_1(sc, HIFN_1_DMA_CSR, dmacsr & sc->sc_dmaier);
2077
2078	if ((sc->sc_flags & HIFN_HAS_PUBLIC) &&
2079	    (dmacsr & HIFN_DMACSR_PUBDONE))
2080		WRITE_REG_1(sc, HIFN_1_PUB_STATUS,
2081		    READ_REG_1(sc, HIFN_1_PUB_STATUS) | HIFN_PUBSTS_DONE);
2082
2083	restart = dmacsr & (HIFN_DMACSR_D_OVER | HIFN_DMACSR_R_OVER);
2084	if (restart)
2085		device_printf(sc->sc_dev, "overrun %x\n", dmacsr);
2086
2087	if (sc->sc_flags & HIFN_IS_7811) {
2088		if (dmacsr & HIFN_DMACSR_ILLR)
2089			device_printf(sc->sc_dev, "illegal read\n");
2090		if (dmacsr & HIFN_DMACSR_ILLW)
2091			device_printf(sc->sc_dev, "illegal write\n");
2092	}
2093
2094	restart = dmacsr & (HIFN_DMACSR_C_ABORT | HIFN_DMACSR_S_ABORT |
2095	    HIFN_DMACSR_D_ABORT | HIFN_DMACSR_R_ABORT);
2096	if (restart) {
2097		device_printf(sc->sc_dev, "abort, resetting.\n");
2098		hifnstats.hst_abort++;
2099		hifn_abort(sc);
2100		HIFN_UNLOCK(sc);
2101		return;
2102	}
2103
2104	if ((dmacsr & HIFN_DMACSR_C_WAIT) && (dma->cmdu == 0)) {
2105		/*
2106		 * If no slots to process and we receive a "waiting on
2107		 * command" interrupt, we disable the "waiting on command"
2108		 * (by clearing it).
2109		 */
2110		sc->sc_dmaier &= ~HIFN_DMAIER_C_WAIT;
2111		WRITE_REG_1(sc, HIFN_1_DMA_IER, sc->sc_dmaier);
2112	}
2113
2114	/* clear the rings */
2115	i = dma->resk; u = dma->resu;
2116	while (u != 0) {
2117		HIFN_RESR_SYNC(sc, i,
2118		    BUS_DMASYNC_POSTREAD | BUS_DMASYNC_POSTWRITE);
2119		if (dma->resr[i].l & htole32(HIFN_D_VALID)) {
2120			HIFN_RESR_SYNC(sc, i,
2121			    BUS_DMASYNC_PREREAD | BUS_DMASYNC_PREWRITE);
2122			break;
2123		}
2124
2125		if (i != HIFN_D_RES_RSIZE) {
2126			struct hifn_command *cmd;
2127			u_int8_t *macbuf = NULL;
2128
2129			HIFN_RES_SYNC(sc, i, BUS_DMASYNC_POSTREAD);
2130			cmd = dma->hifn_commands[i];
2131			KASSERT(cmd != NULL,
2132				("hifn_intr: null command slot %u", i));
2133			dma->hifn_commands[i] = NULL;
2134
2135			if (cmd->base_masks & HIFN_BASE_CMD_MAC) {
2136				macbuf = dma->result_bufs[i];
2137				macbuf += 12;
2138			}
2139
2140			hifn_callback(sc, cmd, macbuf);
2141			hifnstats.hst_opackets++;
2142			u--;
2143		}
2144
2145		if (++i == (HIFN_D_RES_RSIZE + 1))
2146			i = 0;
2147	}
2148	dma->resk = i; dma->resu = u;
2149
2150	i = dma->srck; u = dma->srcu;
2151	while (u != 0) {
2152		if (i == HIFN_D_SRC_RSIZE)
2153			i = 0;
2154		HIFN_SRCR_SYNC(sc, i,
2155		    BUS_DMASYNC_POSTREAD | BUS_DMASYNC_POSTWRITE);
2156		if (dma->srcr[i].l & htole32(HIFN_D_VALID)) {
2157			HIFN_SRCR_SYNC(sc, i,
2158			    BUS_DMASYNC_PREREAD | BUS_DMASYNC_PREWRITE);
2159			break;
2160		}
2161		i++, u--;
2162	}
2163	dma->srck = i; dma->srcu = u;
2164
2165	i = dma->cmdk; u = dma->cmdu;
2166	while (u != 0) {
2167		HIFN_CMDR_SYNC(sc, i,
2168		    BUS_DMASYNC_POSTREAD | BUS_DMASYNC_POSTWRITE);
2169		if (dma->cmdr[i].l & htole32(HIFN_D_VALID)) {
2170			HIFN_CMDR_SYNC(sc, i,
2171			    BUS_DMASYNC_PREREAD | BUS_DMASYNC_PREWRITE);
2172			break;
2173		}
2174		if (i != HIFN_D_CMD_RSIZE) {
2175			u--;
2176			HIFN_CMD_SYNC(sc, i, BUS_DMASYNC_POSTWRITE);
2177		}
2178		if (++i == (HIFN_D_CMD_RSIZE + 1))
2179			i = 0;
2180	}
2181	dma->cmdk = i; dma->cmdu = u;
2182
2183	HIFN_UNLOCK(sc);
2184
2185	if (sc->sc_needwakeup) {		/* XXX check high watermark */
2186		int wakeup = sc->sc_needwakeup & (CRYPTO_SYMQ|CRYPTO_ASYMQ);
2187#ifdef HIFN_DEBUG
2188		if (hifn_debug)
2189			device_printf(sc->sc_dev,
2190				"wakeup crypto (%x) u %d/%d/%d/%d\n",
2191				sc->sc_needwakeup,
2192				dma->cmdu, dma->srcu, dma->dstu, dma->resu);
2193#endif
2194		sc->sc_needwakeup &= ~wakeup;
2195		crypto_unblock(sc->sc_cid, wakeup);
2196	}
2197}
2198
2199/*
2200 * Allocate a new 'session' and return an encoded session id.  'sidp'
2201 * contains our registration id, and should contain an encoded session
2202 * id on successful allocation.
2203 */
2204static int
2205hifn_newsession(void *arg, u_int32_t *sidp, struct cryptoini *cri)
2206{
2207	struct cryptoini *c;
2208	struct hifn_softc *sc = arg;
2209	int mac = 0, cry = 0, sesn;
2210	struct hifn_session *ses = NULL;
2211
2212	KASSERT(sc != NULL, ("hifn_newsession: null softc"));
2213	if (sidp == NULL || cri == NULL || sc == NULL)
2214		return (EINVAL);
2215
2216	if (sc->sc_sessions == NULL) {
2217		ses = sc->sc_sessions = (struct hifn_session *)malloc(
2218		    sizeof(*ses), M_DEVBUF, M_NOWAIT);
2219		if (ses == NULL)
2220			return (ENOMEM);
2221		sesn = 0;
2222		sc->sc_nsessions = 1;
2223	} else {
2224		for (sesn = 0; sesn < sc->sc_nsessions; sesn++) {
2225			if (!sc->sc_sessions[sesn].hs_used) {
2226				ses = &sc->sc_sessions[sesn];
2227				break;
2228			}
2229		}
2230
2231		if (ses == NULL) {
2232			sesn = sc->sc_nsessions;
2233			ses = (struct hifn_session *)malloc((sesn + 1) *
2234			    sizeof(*ses), M_DEVBUF, M_NOWAIT);
2235			if (ses == NULL)
2236				return (ENOMEM);
2237			bcopy(sc->sc_sessions, ses, sesn * sizeof(*ses));
2238			bzero(sc->sc_sessions, sesn * sizeof(*ses));
2239			free(sc->sc_sessions, M_DEVBUF);
2240			sc->sc_sessions = ses;
2241			ses = &sc->sc_sessions[sesn];
2242			sc->sc_nsessions++;
2243		}
2244	}
2245	bzero(ses, sizeof(*ses));
2246	ses->hs_used = 1;
2247
2248	for (c = cri; c != NULL; c = c->cri_next) {
2249		switch (c->cri_alg) {
2250		case CRYPTO_MD5:
2251		case CRYPTO_SHA1:
2252		case CRYPTO_MD5_HMAC:
2253		case CRYPTO_SHA1_HMAC:
2254			if (mac)
2255				return (EINVAL);
2256			mac = 1;
2257			break;
2258		case CRYPTO_DES_CBC:
2259		case CRYPTO_3DES_CBC:
2260		case CRYPTO_AES_CBC:
2261			/* XXX this may read fewer, does it matter? */
2262			read_random(ses->hs_iv,
2263				c->cri_alg == CRYPTO_AES_CBC ?
2264					HIFN_AES_IV_LENGTH : HIFN_IV_LENGTH);
2265			/*FALLTHROUGH*/
2266		case CRYPTO_ARC4:
2267			if (cry)
2268				return (EINVAL);
2269			cry = 1;
2270			break;
2271		default:
2272			return (EINVAL);
2273		}
2274	}
2275	if (mac == 0 && cry == 0)
2276		return (EINVAL);
2277
2278	*sidp = HIFN_SID(device_get_unit(sc->sc_dev), sesn);
2279
2280	return (0);
2281}
2282
2283/*
2284 * Deallocate a session.
2285 * XXX this routine should run a zero'd mac/encrypt key into context ram.
2286 * XXX to blow away any keys already stored there.
2287 */
2288static int
2289hifn_freesession(void *arg, u_int64_t tid)
2290{
2291	struct hifn_softc *sc = arg;
2292	int session;
2293	u_int32_t sid = CRYPTO_SESID2LID(tid);
2294
2295	KASSERT(sc != NULL, ("hifn_freesession: null softc"));
2296	if (sc == NULL)
2297		return (EINVAL);
2298
2299	session = HIFN_SESSION(sid);
2300	if (session >= sc->sc_nsessions)
2301		return (EINVAL);
2302
2303	bzero(&sc->sc_sessions[session], sizeof(sc->sc_sessions[session]));
2304	return (0);
2305}
2306
2307static int
2308hifn_process(void *arg, struct cryptop *crp, int hint)
2309{
2310	struct hifn_softc *sc = arg;
2311	struct hifn_command *cmd = NULL;
2312	int session, err, ivlen;
2313	struct cryptodesc *crd1, *crd2, *maccrd, *enccrd;
2314
2315	if (crp == NULL || crp->crp_callback == NULL) {
2316		hifnstats.hst_invalid++;
2317		return (EINVAL);
2318	}
2319	session = HIFN_SESSION(crp->crp_sid);
2320
2321	if (sc == NULL || session >= sc->sc_nsessions) {
2322		err = EINVAL;
2323		goto errout;
2324	}
2325
2326	cmd = malloc(sizeof(struct hifn_command), M_DEVBUF, M_NOWAIT | M_ZERO);
2327	if (cmd == NULL) {
2328		hifnstats.hst_nomem++;
2329		err = ENOMEM;
2330		goto errout;
2331	}
2332
2333	if (crp->crp_flags & CRYPTO_F_IMBUF) {
2334		cmd->src_m = (struct mbuf *)crp->crp_buf;
2335		cmd->dst_m = (struct mbuf *)crp->crp_buf;
2336	} else if (crp->crp_flags & CRYPTO_F_IOV) {
2337		cmd->src_io = (struct uio *)crp->crp_buf;
2338		cmd->dst_io = (struct uio *)crp->crp_buf;
2339	} else {
2340		err = EINVAL;
2341		goto errout;	/* XXX we don't handle contiguous buffers! */
2342	}
2343
2344	crd1 = crp->crp_desc;
2345	if (crd1 == NULL) {
2346		err = EINVAL;
2347		goto errout;
2348	}
2349	crd2 = crd1->crd_next;
2350
2351	if (crd2 == NULL) {
2352		if (crd1->crd_alg == CRYPTO_MD5_HMAC ||
2353		    crd1->crd_alg == CRYPTO_SHA1_HMAC ||
2354		    crd1->crd_alg == CRYPTO_SHA1 ||
2355		    crd1->crd_alg == CRYPTO_MD5) {
2356			maccrd = crd1;
2357			enccrd = NULL;
2358		} else if (crd1->crd_alg == CRYPTO_DES_CBC ||
2359		    crd1->crd_alg == CRYPTO_3DES_CBC ||
2360		    crd1->crd_alg == CRYPTO_AES_CBC ||
2361		    crd1->crd_alg == CRYPTO_ARC4) {
2362			if ((crd1->crd_flags & CRD_F_ENCRYPT) == 0)
2363				cmd->base_masks |= HIFN_BASE_CMD_DECODE;
2364			maccrd = NULL;
2365			enccrd = crd1;
2366		} else {
2367			err = EINVAL;
2368			goto errout;
2369		}
2370	} else {
2371		if ((crd1->crd_alg == CRYPTO_MD5_HMAC ||
2372                     crd1->crd_alg == CRYPTO_SHA1_HMAC ||
2373                     crd1->crd_alg == CRYPTO_MD5 ||
2374                     crd1->crd_alg == CRYPTO_SHA1) &&
2375		    (crd2->crd_alg == CRYPTO_DES_CBC ||
2376		     crd2->crd_alg == CRYPTO_3DES_CBC ||
2377		     crd2->crd_alg == CRYPTO_AES_CBC ||
2378		     crd2->crd_alg == CRYPTO_ARC4) &&
2379		    ((crd2->crd_flags & CRD_F_ENCRYPT) == 0)) {
2380			cmd->base_masks = HIFN_BASE_CMD_DECODE;
2381			maccrd = crd1;
2382			enccrd = crd2;
2383		} else if ((crd1->crd_alg == CRYPTO_DES_CBC ||
2384		     crd1->crd_alg == CRYPTO_ARC4 ||
2385		     crd1->crd_alg == CRYPTO_3DES_CBC ||
2386		     crd1->crd_alg == CRYPTO_AES_CBC) &&
2387		    (crd2->crd_alg == CRYPTO_MD5_HMAC ||
2388                     crd2->crd_alg == CRYPTO_SHA1_HMAC ||
2389                     crd2->crd_alg == CRYPTO_MD5 ||
2390                     crd2->crd_alg == CRYPTO_SHA1) &&
2391		    (crd1->crd_flags & CRD_F_ENCRYPT)) {
2392			enccrd = crd1;
2393			maccrd = crd2;
2394		} else {
2395			/*
2396			 * We cannot order the 7751 as requested
2397			 */
2398			err = EINVAL;
2399			goto errout;
2400		}
2401	}
2402
2403	if (enccrd) {
2404		cmd->enccrd = enccrd;
2405		cmd->base_masks |= HIFN_BASE_CMD_CRYPT;
2406		switch (enccrd->crd_alg) {
2407		case CRYPTO_ARC4:
2408			cmd->cry_masks |= HIFN_CRYPT_CMD_ALG_RC4;
2409			break;
2410		case CRYPTO_DES_CBC:
2411			cmd->cry_masks |= HIFN_CRYPT_CMD_ALG_DES |
2412			    HIFN_CRYPT_CMD_MODE_CBC |
2413			    HIFN_CRYPT_CMD_NEW_IV;
2414			break;
2415		case CRYPTO_3DES_CBC:
2416			cmd->cry_masks |= HIFN_CRYPT_CMD_ALG_3DES |
2417			    HIFN_CRYPT_CMD_MODE_CBC |
2418			    HIFN_CRYPT_CMD_NEW_IV;
2419			break;
2420		case CRYPTO_AES_CBC:
2421			cmd->cry_masks |= HIFN_CRYPT_CMD_ALG_AES |
2422			    HIFN_CRYPT_CMD_MODE_CBC |
2423			    HIFN_CRYPT_CMD_NEW_IV;
2424			break;
2425		default:
2426			err = EINVAL;
2427			goto errout;
2428		}
2429		if (enccrd->crd_alg != CRYPTO_ARC4) {
2430			ivlen = ((enccrd->crd_alg == CRYPTO_AES_CBC) ?
2431				HIFN_AES_IV_LENGTH : HIFN_IV_LENGTH);
2432			if (enccrd->crd_flags & CRD_F_ENCRYPT) {
2433				if (enccrd->crd_flags & CRD_F_IV_EXPLICIT)
2434					bcopy(enccrd->crd_iv, cmd->iv, ivlen);
2435				else
2436					bcopy(sc->sc_sessions[session].hs_iv,
2437					    cmd->iv, ivlen);
2438
2439				if ((enccrd->crd_flags & CRD_F_IV_PRESENT)
2440				    == 0) {
2441					if (crp->crp_flags & CRYPTO_F_IMBUF)
2442						m_copyback(cmd->src_m,
2443						    enccrd->crd_inject,
2444						    ivlen, cmd->iv);
2445					else if (crp->crp_flags & CRYPTO_F_IOV)
2446						cuio_copyback(cmd->src_io,
2447						    enccrd->crd_inject,
2448						    ivlen, cmd->iv);
2449				}
2450			} else {
2451				if (enccrd->crd_flags & CRD_F_IV_EXPLICIT)
2452					bcopy(enccrd->crd_iv, cmd->iv, ivlen);
2453				else if (crp->crp_flags & CRYPTO_F_IMBUF)
2454					m_copydata(cmd->src_m,
2455					    enccrd->crd_inject, ivlen, cmd->iv);
2456				else if (crp->crp_flags & CRYPTO_F_IOV)
2457					cuio_copydata(cmd->src_io,
2458					    enccrd->crd_inject, ivlen, cmd->iv);
2459			}
2460		}
2461
2462		if (enccrd->crd_flags & CRD_F_KEY_EXPLICIT)
2463			cmd->cry_masks |= HIFN_CRYPT_CMD_NEW_KEY;
2464		cmd->ck = enccrd->crd_key;
2465		cmd->cklen = enccrd->crd_klen >> 3;
2466		cmd->cry_masks |= HIFN_CRYPT_CMD_NEW_KEY;
2467
2468		/*
2469		 * Need to specify the size for the AES key in the masks.
2470		 */
2471		if ((cmd->cry_masks & HIFN_CRYPT_CMD_ALG_MASK) ==
2472		    HIFN_CRYPT_CMD_ALG_AES) {
2473			switch (cmd->cklen) {
2474			case 16:
2475				cmd->cry_masks |= HIFN_CRYPT_CMD_KSZ_128;
2476				break;
2477			case 24:
2478				cmd->cry_masks |= HIFN_CRYPT_CMD_KSZ_192;
2479				break;
2480			case 32:
2481				cmd->cry_masks |= HIFN_CRYPT_CMD_KSZ_256;
2482				break;
2483			default:
2484				err = EINVAL;
2485				goto errout;
2486			}
2487		}
2488	}
2489
2490	if (maccrd) {
2491		cmd->maccrd = maccrd;
2492		cmd->base_masks |= HIFN_BASE_CMD_MAC;
2493
2494		switch (maccrd->crd_alg) {
2495		case CRYPTO_MD5:
2496			cmd->mac_masks |= HIFN_MAC_CMD_ALG_MD5 |
2497			    HIFN_MAC_CMD_RESULT | HIFN_MAC_CMD_MODE_HASH |
2498			    HIFN_MAC_CMD_POS_IPSEC;
2499                       break;
2500		case CRYPTO_MD5_HMAC:
2501			cmd->mac_masks |= HIFN_MAC_CMD_ALG_MD5 |
2502			    HIFN_MAC_CMD_RESULT | HIFN_MAC_CMD_MODE_HMAC |
2503			    HIFN_MAC_CMD_POS_IPSEC | HIFN_MAC_CMD_TRUNC;
2504			break;
2505		case CRYPTO_SHA1:
2506			cmd->mac_masks |= HIFN_MAC_CMD_ALG_SHA1 |
2507			    HIFN_MAC_CMD_RESULT | HIFN_MAC_CMD_MODE_HASH |
2508			    HIFN_MAC_CMD_POS_IPSEC;
2509			break;
2510		case CRYPTO_SHA1_HMAC:
2511			cmd->mac_masks |= HIFN_MAC_CMD_ALG_SHA1 |
2512			    HIFN_MAC_CMD_RESULT | HIFN_MAC_CMD_MODE_HMAC |
2513			    HIFN_MAC_CMD_POS_IPSEC | HIFN_MAC_CMD_TRUNC;
2514			break;
2515		}
2516
2517		if (maccrd->crd_alg == CRYPTO_SHA1_HMAC ||
2518		     maccrd->crd_alg == CRYPTO_MD5_HMAC) {
2519			cmd->mac_masks |= HIFN_MAC_CMD_NEW_KEY;
2520			bcopy(maccrd->crd_key, cmd->mac, maccrd->crd_klen >> 3);
2521			bzero(cmd->mac + (maccrd->crd_klen >> 3),
2522			    HIFN_MAC_KEY_LENGTH - (maccrd->crd_klen >> 3));
2523		}
2524	}
2525
2526	cmd->crp = crp;
2527	cmd->session_num = session;
2528	cmd->softc = sc;
2529
2530	err = hifn_crypto(sc, cmd, crp, hint);
2531	if (!err) {
2532		return 0;
2533	} else if (err == ERESTART) {
2534		/*
2535		 * There weren't enough resources to dispatch the request
2536		 * to the part.  Notify the caller so they'll requeue this
2537		 * request and resubmit it again soon.
2538		 */
2539#ifdef HIFN_DEBUG
2540		if (hifn_debug)
2541			device_printf(sc->sc_dev, "requeue request\n");
2542#endif
2543		free(cmd, M_DEVBUF);
2544		sc->sc_needwakeup |= CRYPTO_SYMQ;
2545		return (err);
2546	}
2547
2548errout:
2549	if (cmd != NULL)
2550		free(cmd, M_DEVBUF);
2551	if (err == EINVAL)
2552		hifnstats.hst_invalid++;
2553	else
2554		hifnstats.hst_nomem++;
2555	crp->crp_etype = err;
2556	crypto_done(crp);
2557	return (err);
2558}
2559
2560static void
2561hifn_abort(struct hifn_softc *sc)
2562{
2563	struct hifn_dma *dma = sc->sc_dma;
2564	struct hifn_command *cmd;
2565	struct cryptop *crp;
2566	int i, u;
2567
2568	i = dma->resk; u = dma->resu;
2569	while (u != 0) {
2570		cmd = dma->hifn_commands[i];
2571		KASSERT(cmd != NULL, ("hifn_abort: null command slot %u", i));
2572		dma->hifn_commands[i] = NULL;
2573		crp = cmd->crp;
2574
2575		if ((dma->resr[i].l & htole32(HIFN_D_VALID)) == 0) {
2576			/* Salvage what we can. */
2577			u_int8_t *macbuf;
2578
2579			if (cmd->base_masks & HIFN_BASE_CMD_MAC) {
2580				macbuf = dma->result_bufs[i];
2581				macbuf += 12;
2582			} else
2583				macbuf = NULL;
2584			hifnstats.hst_opackets++;
2585			hifn_callback(sc, cmd, macbuf);
2586		} else {
2587			if (cmd->src_map == cmd->dst_map) {
2588				bus_dmamap_sync(sc->sc_dmat, cmd->src_map,
2589				    BUS_DMASYNC_POSTREAD|BUS_DMASYNC_POSTWRITE);
2590			} else {
2591				bus_dmamap_sync(sc->sc_dmat, cmd->src_map,
2592				    BUS_DMASYNC_POSTWRITE);
2593				bus_dmamap_sync(sc->sc_dmat, cmd->dst_map,
2594				    BUS_DMASYNC_POSTREAD);
2595			}
2596
2597			if (cmd->src_m != cmd->dst_m) {
2598				m_freem(cmd->src_m);
2599				crp->crp_buf = (caddr_t)cmd->dst_m;
2600			}
2601
2602			/* non-shared buffers cannot be restarted */
2603			if (cmd->src_map != cmd->dst_map) {
2604				/*
2605				 * XXX should be EAGAIN, delayed until
2606				 * after the reset.
2607				 */
2608				crp->crp_etype = ENOMEM;
2609				bus_dmamap_unload(sc->sc_dmat, cmd->dst_map);
2610				bus_dmamap_destroy(sc->sc_dmat, cmd->dst_map);
2611			} else
2612				crp->crp_etype = ENOMEM;
2613
2614			bus_dmamap_unload(sc->sc_dmat, cmd->src_map);
2615			bus_dmamap_destroy(sc->sc_dmat, cmd->src_map);
2616
2617			free(cmd, M_DEVBUF);
2618			if (crp->crp_etype != EAGAIN)
2619				crypto_done(crp);
2620		}
2621
2622		if (++i == HIFN_D_RES_RSIZE)
2623			i = 0;
2624		u--;
2625	}
2626	dma->resk = i; dma->resu = u;
2627
2628	hifn_reset_board(sc, 1);
2629	hifn_init_dma(sc);
2630	hifn_init_pci_registers(sc);
2631}
2632
2633static void
2634hifn_callback(struct hifn_softc *sc, struct hifn_command *cmd, u_int8_t *macbuf)
2635{
2636	struct hifn_dma *dma = sc->sc_dma;
2637	struct cryptop *crp = cmd->crp;
2638	struct cryptodesc *crd;
2639	struct mbuf *m;
2640	int totlen, i, u, ivlen;
2641
2642	if (cmd->src_map == cmd->dst_map) {
2643		bus_dmamap_sync(sc->sc_dmat, cmd->src_map,
2644		    BUS_DMASYNC_POSTWRITE | BUS_DMASYNC_POSTREAD);
2645	} else {
2646		bus_dmamap_sync(sc->sc_dmat, cmd->src_map,
2647		    BUS_DMASYNC_POSTWRITE);
2648		bus_dmamap_sync(sc->sc_dmat, cmd->dst_map,
2649		    BUS_DMASYNC_POSTREAD);
2650	}
2651
2652	if (crp->crp_flags & CRYPTO_F_IMBUF) {
2653		if (cmd->src_m != cmd->dst_m) {
2654			crp->crp_buf = (caddr_t)cmd->dst_m;
2655			totlen = cmd->src_mapsize;
2656			for (m = cmd->dst_m; m != NULL; m = m->m_next) {
2657				if (totlen < m->m_len) {
2658					m->m_len = totlen;
2659					totlen = 0;
2660				} else
2661					totlen -= m->m_len;
2662			}
2663			cmd->dst_m->m_pkthdr.len = cmd->src_m->m_pkthdr.len;
2664			m_freem(cmd->src_m);
2665		}
2666	}
2667
2668	if (cmd->sloplen != 0) {
2669		if (crp->crp_flags & CRYPTO_F_IMBUF)
2670			m_copyback((struct mbuf *)crp->crp_buf,
2671			    cmd->src_mapsize - cmd->sloplen,
2672			    cmd->sloplen, (caddr_t)&dma->slop[cmd->slopidx]);
2673		else if (crp->crp_flags & CRYPTO_F_IOV)
2674			cuio_copyback((struct uio *)crp->crp_buf,
2675			    cmd->src_mapsize - cmd->sloplen,
2676			    cmd->sloplen, (caddr_t)&dma->slop[cmd->slopidx]);
2677	}
2678
2679	i = dma->dstk; u = dma->dstu;
2680	while (u != 0) {
2681		if (i == HIFN_D_DST_RSIZE)
2682			i = 0;
2683		bus_dmamap_sync(sc->sc_dmat, sc->sc_dmamap,
2684		    BUS_DMASYNC_POSTREAD | BUS_DMASYNC_POSTWRITE);
2685		if (dma->dstr[i].l & htole32(HIFN_D_VALID)) {
2686			bus_dmamap_sync(sc->sc_dmat, sc->sc_dmamap,
2687			    BUS_DMASYNC_PREREAD | BUS_DMASYNC_PREWRITE);
2688			break;
2689		}
2690		i++, u--;
2691	}
2692	dma->dstk = i; dma->dstu = u;
2693
2694	hifnstats.hst_obytes += cmd->dst_mapsize;
2695
2696	if ((cmd->base_masks & (HIFN_BASE_CMD_CRYPT | HIFN_BASE_CMD_DECODE)) ==
2697	    HIFN_BASE_CMD_CRYPT) {
2698		for (crd = crp->crp_desc; crd; crd = crd->crd_next) {
2699			if (crd->crd_alg != CRYPTO_DES_CBC &&
2700			    crd->crd_alg != CRYPTO_3DES_CBC &&
2701			    crd->crd_alg != CRYPTO_AES_CBC)
2702				continue;
2703			ivlen = ((crd->crd_alg == CRYPTO_AES_CBC) ?
2704				HIFN_AES_IV_LENGTH : HIFN_IV_LENGTH);
2705			if (crp->crp_flags & CRYPTO_F_IMBUF)
2706				m_copydata((struct mbuf *)crp->crp_buf,
2707				    crd->crd_skip + crd->crd_len - ivlen, ivlen,
2708				    cmd->softc->sc_sessions[cmd->session_num].hs_iv);
2709			else if (crp->crp_flags & CRYPTO_F_IOV) {
2710				cuio_copydata((struct uio *)crp->crp_buf,
2711				    crd->crd_skip + crd->crd_len - ivlen, ivlen,
2712				    cmd->softc->sc_sessions[cmd->session_num].hs_iv);
2713			}
2714			break;
2715		}
2716	}
2717
2718	if (macbuf != NULL) {
2719		for (crd = crp->crp_desc; crd; crd = crd->crd_next) {
2720                        int len;
2721
2722                        if (crd->crd_alg == CRYPTO_MD5)
2723				len = 16;
2724                        else if (crd->crd_alg == CRYPTO_SHA1)
2725				len = 20;
2726                        else if (crd->crd_alg == CRYPTO_MD5_HMAC ||
2727                            crd->crd_alg == CRYPTO_SHA1_HMAC)
2728				len = 12;
2729                        else
2730				continue;
2731
2732			if (crp->crp_flags & CRYPTO_F_IMBUF)
2733				m_copyback((struct mbuf *)crp->crp_buf,
2734                                   crd->crd_inject, len, macbuf);
2735			else if ((crp->crp_flags & CRYPTO_F_IOV) && crp->crp_mac)
2736				bcopy((caddr_t)macbuf, crp->crp_mac, len);
2737			break;
2738		}
2739	}
2740
2741	if (cmd->src_map != cmd->dst_map) {
2742		bus_dmamap_unload(sc->sc_dmat, cmd->dst_map);
2743		bus_dmamap_destroy(sc->sc_dmat, cmd->dst_map);
2744	}
2745	bus_dmamap_unload(sc->sc_dmat, cmd->src_map);
2746	bus_dmamap_destroy(sc->sc_dmat, cmd->src_map);
2747	free(cmd, M_DEVBUF);
2748	crypto_done(crp);
2749}
2750
2751/*
2752 * 7811 PB3 rev/2 parts lock-up on burst writes to Group 0
2753 * and Group 1 registers; avoid conditions that could create
2754 * burst writes by doing a read in between the writes.
2755 *
2756 * NB: The read we interpose is always to the same register;
2757 *     we do this because reading from an arbitrary (e.g. last)
2758 *     register may not always work.
2759 */
2760static void
2761hifn_write_reg_0(struct hifn_softc *sc, bus_size_t reg, u_int32_t val)
2762{
2763	if (sc->sc_flags & HIFN_IS_7811) {
2764		if (sc->sc_bar0_lastreg == reg - 4)
2765			bus_space_read_4(sc->sc_st0, sc->sc_sh0, HIFN_0_PUCNFG);
2766		sc->sc_bar0_lastreg = reg;
2767	}
2768	bus_space_write_4(sc->sc_st0, sc->sc_sh0, reg, val);
2769}
2770
2771static void
2772hifn_write_reg_1(struct hifn_softc *sc, bus_size_t reg, u_int32_t val)
2773{
2774	if (sc->sc_flags & HIFN_IS_7811) {
2775		if (sc->sc_bar1_lastreg == reg - 4)
2776			bus_space_read_4(sc->sc_st1, sc->sc_sh1, HIFN_1_REVID);
2777		sc->sc_bar1_lastreg = reg;
2778	}
2779	bus_space_write_4(sc->sc_st1, sc->sc_sh1, reg, val);
2780}
2781