xref: /netbsd-src/sys/dev/marvell/mvcesa.c (revision ee55792f151450e8c80b0c52d56963c8c4df0e64)
1*ee55792fSriastradh /*	$NetBSD: mvcesa.c,v 1.6 2022/05/22 11:39:27 riastradh Exp $	*/
2068a6eb9Skiyohara /*
3068a6eb9Skiyohara  * Copyright (c) 2008 KIYOHARA Takashi
4068a6eb9Skiyohara  * All rights reserved.
5068a6eb9Skiyohara  *
6068a6eb9Skiyohara  * Redistribution and use in source and binary forms, with or without
7068a6eb9Skiyohara  * modification, are permitted provided that the following conditions
8068a6eb9Skiyohara  * are met:
9068a6eb9Skiyohara  * 1. Redistributions of source code must retain the above copyright
10068a6eb9Skiyohara  *    notice, this list of conditions and the following disclaimer.
11068a6eb9Skiyohara  * 2. Redistributions in binary form must reproduce the above copyright
12068a6eb9Skiyohara  *    notice, this list of conditions and the following disclaimer in the
13068a6eb9Skiyohara  *    documentation and/or other materials provided with the distribution.
14068a6eb9Skiyohara  *
15068a6eb9Skiyohara  * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
16068a6eb9Skiyohara  * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED
17068a6eb9Skiyohara  * WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE
18068a6eb9Skiyohara  * DISCLAIMED.  IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT,
19068a6eb9Skiyohara  * INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES
20068a6eb9Skiyohara  * (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR
21068a6eb9Skiyohara  * SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
22068a6eb9Skiyohara  * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT,
23068a6eb9Skiyohara  * STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN
24068a6eb9Skiyohara  * ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
25068a6eb9Skiyohara  * POSSIBILITY OF SUCH DAMAGE.
26068a6eb9Skiyohara  */
27068a6eb9Skiyohara 
28068a6eb9Skiyohara #include <sys/cdefs.h>
29*ee55792fSriastradh __KERNEL_RCSID(0, "$NetBSD: mvcesa.c,v 1.6 2022/05/22 11:39:27 riastradh Exp $");
30068a6eb9Skiyohara 
31068a6eb9Skiyohara #include <sys/param.h>
32068a6eb9Skiyohara #include <sys/bus.h>
33068a6eb9Skiyohara #include <sys/cprng.h>
34068a6eb9Skiyohara #include <sys/device.h>
35068a6eb9Skiyohara #include <sys/endian.h>
36068a6eb9Skiyohara #include <sys/errno.h>
37068a6eb9Skiyohara #include <sys/mbuf.h>
38068a6eb9Skiyohara #include <sys/md5.h>
39068a6eb9Skiyohara #include <sys/uio.h>
40068a6eb9Skiyohara #include <sys/sha1.h>
41068a6eb9Skiyohara 
42068a6eb9Skiyohara #include <opencrypto/cryptodev.h>
43068a6eb9Skiyohara #include <opencrypto/xform.h>
44068a6eb9Skiyohara 
45068a6eb9Skiyohara #include <dev/marvell/marvellreg.h>
46068a6eb9Skiyohara #include <dev/marvell/marvellvar.h>
47068a6eb9Skiyohara #include <dev/marvell/mvcesareg.h>
48068a6eb9Skiyohara 
49068a6eb9Skiyohara #include "locators.h"
50068a6eb9Skiyohara 
51068a6eb9Skiyohara #define MVCESA_SESSION(sid)		((sid) & 0x0fffffff)
52068a6eb9Skiyohara #define MVCESA_SID(crd, sesn)		(((crd) << 28) | ((sesn) & 0x0fffffff))
53068a6eb9Skiyohara 
54068a6eb9Skiyohara 
55068a6eb9Skiyohara struct mvcesa_session {
56068a6eb9Skiyohara 	int ses_used;
57068a6eb9Skiyohara 
58068a6eb9Skiyohara 	int ses_klen;
59068a6eb9Skiyohara 	uint32_t ses_key[8];
60068a6eb9Skiyohara 
61068a6eb9Skiyohara 	uint32_t ses_hminner[5];	/* HMAC inner state */
62068a6eb9Skiyohara 	uint32_t ses_hmouter[5];	/* HMAC outer state */
63068a6eb9Skiyohara };
64068a6eb9Skiyohara 
65068a6eb9Skiyohara struct mvcesa_softc {
66068a6eb9Skiyohara 	device_t sc_dev;
67068a6eb9Skiyohara 
68068a6eb9Skiyohara 	bus_space_tag_t sc_iot;
69068a6eb9Skiyohara 	bus_space_handle_t sc_ioh;
70068a6eb9Skiyohara 	bus_dma_tag_t sc_dmat;
71068a6eb9Skiyohara 
72068a6eb9Skiyohara 	int sc_cid;
73068a6eb9Skiyohara 	int sc_nsessions;
74068a6eb9Skiyohara 	struct mvcesa_session *sc_sessions;
75068a6eb9Skiyohara };
76068a6eb9Skiyohara 
77068a6eb9Skiyohara static int mvcesa_match(device_t, cfdata_t, void *);
78068a6eb9Skiyohara static void mvcesa_attach(device_t, device_t, void *);
79068a6eb9Skiyohara 
80068a6eb9Skiyohara static int mvcesa_intr(void *);
81068a6eb9Skiyohara 
82068a6eb9Skiyohara static int mvcesa_newsession(void *, u_int32_t *, struct cryptoini *);
83*ee55792fSriastradh static void mvcesa_freesession(void *, u_int64_t);
84068a6eb9Skiyohara static int mvcesa_process(void *, struct cryptop *, int);
85068a6eb9Skiyohara 
86068a6eb9Skiyohara static int mvcesa_authentication(struct mvcesa_softc *, struct mvcesa_session *,
87068a6eb9Skiyohara 				 uint32_t, uint32_t *, uint32_t *, uint64_t,
88068a6eb9Skiyohara 				 int, int, char *, struct mbuf *, struct uio *);
89068a6eb9Skiyohara static int mvcesa_des_encdec(struct mvcesa_softc *, struct mvcesa_session *,
90068a6eb9Skiyohara 			     uint32_t, uint32_t, uint32_t, uint32_t *, int, int,
91068a6eb9Skiyohara 			     char *, struct mbuf *, struct uio *);
92068a6eb9Skiyohara 
93068a6eb9Skiyohara 
94068a6eb9Skiyohara CFATTACH_DECL_NEW(mvcesa_gt, sizeof(struct mvcesa_softc),
95068a6eb9Skiyohara     mvcesa_match, mvcesa_attach, NULL, NULL);
96068a6eb9Skiyohara CFATTACH_DECL_NEW(mvcesa_mbus, sizeof(struct mvcesa_softc),
97068a6eb9Skiyohara     mvcesa_match, mvcesa_attach, NULL, NULL);
98068a6eb9Skiyohara 
99068a6eb9Skiyohara 
100068a6eb9Skiyohara /* ARGSUSED */
101068a6eb9Skiyohara static int
mvcesa_match(device_t parent,cfdata_t match,void * aux)102068a6eb9Skiyohara mvcesa_match(device_t parent, cfdata_t match, void *aux)
103068a6eb9Skiyohara {
104068a6eb9Skiyohara 	struct marvell_attach_args *mva = aux;
105068a6eb9Skiyohara 
106068a6eb9Skiyohara 	if (strcmp(mva->mva_name, match->cf_name) != 0)
107068a6eb9Skiyohara 		return 0;
108068a6eb9Skiyohara 	if (mva->mva_offset == MVA_OFFSET_DEFAULT ||
109068a6eb9Skiyohara 	    mva->mva_irq == MVA_IRQ_DEFAULT)
110068a6eb9Skiyohara 		return 0;
111068a6eb9Skiyohara 
112068a6eb9Skiyohara 	mva->mva_size = MVCESA_SIZE;
113068a6eb9Skiyohara 	return 1;
114068a6eb9Skiyohara }
115068a6eb9Skiyohara 
116068a6eb9Skiyohara /* ARGSUSED */
117068a6eb9Skiyohara static void
mvcesa_attach(device_t parent,device_t self,void * aux)118068a6eb9Skiyohara mvcesa_attach(device_t parent, device_t self, void *aux)
119068a6eb9Skiyohara {
120068a6eb9Skiyohara 	struct mvcesa_softc *sc = device_private(self);
121068a6eb9Skiyohara 	struct marvell_attach_args *mva = aux;
122068a6eb9Skiyohara 
123068a6eb9Skiyohara 	aprint_normal(
124068a6eb9Skiyohara 	    ": Marvell Cryptographic Engines and Security Accelerator\n");
125068a6eb9Skiyohara 	aprint_naive("\n");
126068a6eb9Skiyohara 
127068a6eb9Skiyohara 	sc->sc_dev = self;
128068a6eb9Skiyohara 	sc->sc_iot = mva->mva_iot;
129068a6eb9Skiyohara         /* Map I/O registers */
130068a6eb9Skiyohara 	if (bus_space_subregion(mva->mva_iot, mva->mva_ioh, mva->mva_offset,
131068a6eb9Skiyohara 	    mva->mva_size, &sc->sc_ioh)) {
132068a6eb9Skiyohara 		aprint_error_dev(self, "can't map registers\n");
133068a6eb9Skiyohara 		return;
134068a6eb9Skiyohara 	}
135068a6eb9Skiyohara 	sc->sc_dmat = mva->mva_dmat;
136068a6eb9Skiyohara 
137068a6eb9Skiyohara 	sc->sc_nsessions = 0;
138068a6eb9Skiyohara 
139068a6eb9Skiyohara 	/* Setup Opencrypto stuff */
140068a6eb9Skiyohara 	sc->sc_cid = crypto_get_driverid(0);
141068a6eb9Skiyohara 	if (sc->sc_cid < 0) {
142068a6eb9Skiyohara 		aprint_error_dev(self, "couldn't get crypto driver id\n");
143068a6eb9Skiyohara 		return;
144068a6eb9Skiyohara 	}
145068a6eb9Skiyohara 	crypto_register(sc->sc_cid, CRYPTO_DES_CBC, 0, 0,
146068a6eb9Skiyohara 	    mvcesa_newsession, mvcesa_freesession, mvcesa_process, sc);
147068a6eb9Skiyohara 	crypto_register(sc->sc_cid, CRYPTO_3DES_CBC, 0, 0,
148068a6eb9Skiyohara 	    mvcesa_newsession, mvcesa_freesession, mvcesa_process, sc);
149068a6eb9Skiyohara #if __DMA_notyet__
150068a6eb9Skiyohara /*
151068a6eb9Skiyohara  * Don't know how to process to AES CBC in PIO-mode.
152068a6eb9Skiyohara  * I havn't found IV registers.
153068a6eb9Skiyohara  */
154068a6eb9Skiyohara 	crypto_register(sc->sc_cid, CRYPTO_AES_CBC, 0, 0,
155068a6eb9Skiyohara 	    mvcesa_newsession, mvcesa_freesession, mvcesa_process, sc);
156068a6eb9Skiyohara #endif
157068a6eb9Skiyohara 	crypto_register(sc->sc_cid, CRYPTO_SHA1, 0, 0,
158068a6eb9Skiyohara 	    mvcesa_newsession, mvcesa_freesession, mvcesa_process, sc);
159068a6eb9Skiyohara 	crypto_register(sc->sc_cid, CRYPTO_SHA1_HMAC, 0, 0,
160068a6eb9Skiyohara 	    mvcesa_newsession, mvcesa_freesession, mvcesa_process, sc);
161068a6eb9Skiyohara 	crypto_register(sc->sc_cid, CRYPTO_MD5, 0, 0,
162068a6eb9Skiyohara 	    mvcesa_newsession, mvcesa_freesession, mvcesa_process, sc);
163068a6eb9Skiyohara 	crypto_register(sc->sc_cid, CRYPTO_MD5_HMAC, 0, 0,
164068a6eb9Skiyohara 	    mvcesa_newsession, mvcesa_freesession, mvcesa_process, sc);
165068a6eb9Skiyohara 
166068a6eb9Skiyohara 	/* Clear and establish interrupt */
167068a6eb9Skiyohara 	bus_space_write_4(sc->sc_iot, sc->sc_ioh, MVCESA_IC, 0);
168068a6eb9Skiyohara 	marvell_intr_establish(mva->mva_irq, IPL_NET, mvcesa_intr, sc);
169068a6eb9Skiyohara 
170068a6eb9Skiyohara 	bus_space_write_4(sc->sc_iot, sc->sc_ioh, MVCESA_IM, 0);
171068a6eb9Skiyohara }
172068a6eb9Skiyohara 
173068a6eb9Skiyohara 
174068a6eb9Skiyohara static int
mvcesa_intr(void * arg)175068a6eb9Skiyohara mvcesa_intr(void *arg)
176068a6eb9Skiyohara {
177068a6eb9Skiyohara #if 0
178068a6eb9Skiyohara 	struct mvcesa_softc *sc = (struct mvcesa_softc *)arg;
179068a6eb9Skiyohara #endif
180068a6eb9Skiyohara 	int handled = 0;
181068a6eb9Skiyohara 
182068a6eb9Skiyohara 	return handled;
183068a6eb9Skiyohara }
184068a6eb9Skiyohara 
185068a6eb9Skiyohara 
186068a6eb9Skiyohara /*
187068a6eb9Skiyohara  * Opencrypto functions
188068a6eb9Skiyohara  */
189068a6eb9Skiyohara /*
190068a6eb9Skiyohara  * Allocate a new 'session' and return an encoded session id.  'sidp'
191068a6eb9Skiyohara  * contains our registration id, and should contain an encoded session
192068a6eb9Skiyohara  * id on successful allocation.
193068a6eb9Skiyohara  */
194068a6eb9Skiyohara static int
mvcesa_newsession(void * arg,u_int32_t * sidp,struct cryptoini * cri)195068a6eb9Skiyohara mvcesa_newsession(void *arg, u_int32_t *sidp, struct cryptoini *cri)
196068a6eb9Skiyohara {
197068a6eb9Skiyohara 	struct mvcesa_softc *sc = (struct mvcesa_softc *)arg;
198068a6eb9Skiyohara 	struct cryptoini *c;
199068a6eb9Skiyohara 	struct mvcesa_session *ses = NULL;
200068a6eb9Skiyohara 	int sesn, count, enc, mac, i;
201068a6eb9Skiyohara 
202068a6eb9Skiyohara 	KASSERT(sc != NULL /*, ("mvcesa_newsession: null softc")*/);
203068a6eb9Skiyohara 	if (sidp == NULL || cri == NULL || sc == NULL)
204068a6eb9Skiyohara 		return EINVAL;
205068a6eb9Skiyohara 
206068a6eb9Skiyohara 	for (sesn = 0; sesn < sc->sc_nsessions; sesn++)
207068a6eb9Skiyohara 		if (sc->sc_sessions[sesn].ses_used == 0) {
208068a6eb9Skiyohara 			ses = sc->sc_sessions + sesn;
209068a6eb9Skiyohara 			break;
210068a6eb9Skiyohara 		}
211068a6eb9Skiyohara 
212068a6eb9Skiyohara 	if (ses == NULL) {
213068a6eb9Skiyohara 		sesn = sc->sc_nsessions;
214068a6eb9Skiyohara 		ses = malloc((sesn + 1) * sizeof(*ses), M_DEVBUF, M_NOWAIT);
215068a6eb9Skiyohara 		if (ses == NULL)
216068a6eb9Skiyohara 			return ENOMEM;
217068a6eb9Skiyohara 		if (sesn != 0) {
218068a6eb9Skiyohara 			memcpy(ses, sc->sc_sessions, sesn * sizeof(*ses));
219068a6eb9Skiyohara 			memset(sc->sc_sessions, 0, sesn * sizeof(*ses));
220068a6eb9Skiyohara 			free(sc->sc_sessions, M_DEVBUF);
221068a6eb9Skiyohara 		}
222068a6eb9Skiyohara 		sc->sc_sessions = ses;
223068a6eb9Skiyohara 		ses = sc->sc_sessions + sesn;
224068a6eb9Skiyohara 		sc->sc_nsessions++;
225068a6eb9Skiyohara 	}
226068a6eb9Skiyohara 	memset(ses, 0, sizeof(*ses));
227068a6eb9Skiyohara 
228068a6eb9Skiyohara 	count = 0;
229068a6eb9Skiyohara 	enc = mac = 0;
230068a6eb9Skiyohara 	for (c = cri; c != NULL; c = c->cri_next) {
231068a6eb9Skiyohara 		switch (c->cri_alg) {
232068a6eb9Skiyohara 		case CRYPTO_DES_CBC:
233068a6eb9Skiyohara 		case CRYPTO_3DES_CBC:
234068a6eb9Skiyohara 			if (enc)
235068a6eb9Skiyohara 				return EINVAL;
236068a6eb9Skiyohara 			enc = 1;
237068a6eb9Skiyohara 
238068a6eb9Skiyohara 			/* Go ahead and compute key in CESA's byte order */
239068a6eb9Skiyohara 			ses->ses_klen = c->cri_klen;
240068a6eb9Skiyohara 			memcpy(ses->ses_key, c->cri_key, c->cri_klen / 8);
241068a6eb9Skiyohara 			switch (c->cri_alg) {
242068a6eb9Skiyohara 			case CRYPTO_3DES_CBC:
243068a6eb9Skiyohara 				ses->ses_key[5] = htobe32(ses->ses_key[5]);
244068a6eb9Skiyohara 				ses->ses_key[4] = htobe32(ses->ses_key[4]);
245068a6eb9Skiyohara 				ses->ses_key[3] = htobe32(ses->ses_key[3]);
246068a6eb9Skiyohara 				ses->ses_key[2] = htobe32(ses->ses_key[2]);
247068a6eb9Skiyohara 
248068a6eb9Skiyohara 				/* FALLTHROUGH */
249068a6eb9Skiyohara 			case CRYPTO_DES_CBC:
250068a6eb9Skiyohara 				ses->ses_key[1] = htobe32(ses->ses_key[1]);
251068a6eb9Skiyohara 				ses->ses_key[0] = htobe32(ses->ses_key[0]);
252068a6eb9Skiyohara 			}
253068a6eb9Skiyohara 			break;
254068a6eb9Skiyohara 
255068a6eb9Skiyohara 		case CRYPTO_SHA1_HMAC:
256068a6eb9Skiyohara 		case CRYPTO_MD5_HMAC:
257068a6eb9Skiyohara 		{
258068a6eb9Skiyohara 			MD5_CTX md5ctx;
259068a6eb9Skiyohara 			SHA1_CTX sha1ctx;
260068a6eb9Skiyohara 			int klen_bytes = c->cri_klen / 8;
261068a6eb9Skiyohara 
262068a6eb9Skiyohara 			KASSERT(c->cri_klen == 512);
263068a6eb9Skiyohara 
264068a6eb9Skiyohara 			for (i = 0; i < klen_bytes; i++)
265068a6eb9Skiyohara 				c->cri_key[i] ^= HMAC_IPAD_VAL;
266068a6eb9Skiyohara 			if (c->cri_alg == CRYPTO_MD5_HMAC_96) {
267068a6eb9Skiyohara 				MD5Init(&md5ctx);
268068a6eb9Skiyohara 				MD5Update(&md5ctx, c->cri_key, klen_bytes);
269068a6eb9Skiyohara 				MD5Update(&md5ctx, hmac_ipad_buffer,
270068a6eb9Skiyohara 				    HMAC_BLOCK_LEN - klen_bytes);
271068a6eb9Skiyohara 				memcpy(ses->ses_hminner, md5ctx.state,
272068a6eb9Skiyohara 				    sizeof(md5ctx.state));
273068a6eb9Skiyohara 			} else {
274068a6eb9Skiyohara 				SHA1Init(&sha1ctx);
275068a6eb9Skiyohara 				SHA1Update(&sha1ctx, c->cri_key, klen_bytes);
276068a6eb9Skiyohara 				SHA1Update(&sha1ctx, hmac_ipad_buffer,
277068a6eb9Skiyohara 				    HMAC_BLOCK_LEN - klen_bytes);
278068a6eb9Skiyohara 				memcpy(ses->ses_hminner, sha1ctx.state,
279068a6eb9Skiyohara 				    sizeof(sha1ctx.state));
280068a6eb9Skiyohara 			}
281068a6eb9Skiyohara 
282068a6eb9Skiyohara 			for (i = 0; i < klen_bytes; i++)
283068a6eb9Skiyohara 				c->cri_key[i] ^=
284068a6eb9Skiyohara 				    (HMAC_IPAD_VAL ^ HMAC_OPAD_VAL);
285068a6eb9Skiyohara 			if (c->cri_alg == CRYPTO_MD5_HMAC_96) {
286068a6eb9Skiyohara 				MD5Init(&md5ctx);
287068a6eb9Skiyohara 				MD5Update(&md5ctx, c->cri_key, klen_bytes);
288068a6eb9Skiyohara 				MD5Update(&md5ctx, hmac_opad_buffer,
289068a6eb9Skiyohara 				    HMAC_BLOCK_LEN - klen_bytes);
290068a6eb9Skiyohara 				memcpy(ses->ses_hmouter, md5ctx.state,
291068a6eb9Skiyohara 				    sizeof(md5ctx.state));
292068a6eb9Skiyohara 			} else {
293068a6eb9Skiyohara 				SHA1Init(&sha1ctx);
294068a6eb9Skiyohara 				SHA1Update(&sha1ctx, c->cri_key, klen_bytes);
295068a6eb9Skiyohara 				SHA1Update(&sha1ctx, hmac_opad_buffer,
296068a6eb9Skiyohara 				    HMAC_BLOCK_LEN - klen_bytes);
297068a6eb9Skiyohara 				memcpy(ses->ses_hmouter, sha1ctx.state,
298068a6eb9Skiyohara 				    sizeof(sha1ctx.state));
299068a6eb9Skiyohara 			}
300068a6eb9Skiyohara 
301068a6eb9Skiyohara 			for (i = 0; i < klen_bytes; i++)
302068a6eb9Skiyohara 				c->cri_key[i] ^= HMAC_OPAD_VAL;
303068a6eb9Skiyohara 		}
304068a6eb9Skiyohara 			/* FALLTHROUGH */
305068a6eb9Skiyohara 
306068a6eb9Skiyohara 		case CRYPTO_SHA1:
307068a6eb9Skiyohara 		case CRYPTO_MD5:
308068a6eb9Skiyohara 			if (mac)
309068a6eb9Skiyohara 				return EINVAL;
310068a6eb9Skiyohara 			mac = 1;
311068a6eb9Skiyohara 		}
312068a6eb9Skiyohara 		count++;
313068a6eb9Skiyohara 	}
314068a6eb9Skiyohara 	if (count > 2) {
315068a6eb9Skiyohara 		mvcesa_freesession(sc, sesn);
316068a6eb9Skiyohara 		return EINVAL;
317068a6eb9Skiyohara 	}
318068a6eb9Skiyohara 
319068a6eb9Skiyohara 	*sidp = MVCESA_SID(device_unit(sc->sc_dev), sesn);
320068a6eb9Skiyohara 	ses->ses_used = 1;
321068a6eb9Skiyohara 
322068a6eb9Skiyohara 	return 0;
323068a6eb9Skiyohara }
324068a6eb9Skiyohara 
325068a6eb9Skiyohara /*
326068a6eb9Skiyohara  * Deallocate a session.
327068a6eb9Skiyohara  */
328*ee55792fSriastradh static void
mvcesa_freesession(void * arg,u_int64_t tid)329068a6eb9Skiyohara mvcesa_freesession(void *arg, u_int64_t tid)
330068a6eb9Skiyohara {
331068a6eb9Skiyohara 	struct mvcesa_softc *sc = (struct mvcesa_softc *)arg;
332068a6eb9Skiyohara 	int session;
333068a6eb9Skiyohara 	uint32_t sid = ((uint32_t)tid) & 0xffffffff;
334068a6eb9Skiyohara 
335068a6eb9Skiyohara 	session = MVCESA_SESSION(sid);
3364b175f25Sriastradh 	KASSERTMSG(session >= 0, "session=%d", session);
3374b175f25Sriastradh 	KASSERTMSG(session < sc->sc_nsessions, "session=%d nsessions=%d",
3384b175f25Sriastradh 	    session, sc->sc_nsessions);
339068a6eb9Skiyohara 
340068a6eb9Skiyohara 	memset(&sc->sc_sessions[session], 0, sizeof(sc->sc_sessions[session]));
341068a6eb9Skiyohara }
342068a6eb9Skiyohara 
343068a6eb9Skiyohara static int
mvcesa_process(void * arg,struct cryptop * crp,int hint)344068a6eb9Skiyohara mvcesa_process(void *arg, struct cryptop *crp, int hint)
345068a6eb9Skiyohara {
3464b175f25Sriastradh 	struct mvcesa_softc *sc = arg;
347068a6eb9Skiyohara 	struct mvcesa_session *ses;
348068a6eb9Skiyohara 	struct cryptodesc *crd;
349068a6eb9Skiyohara 	struct mbuf *m = NULL;
350068a6eb9Skiyohara 	struct uio *uio = NULL;
351068a6eb9Skiyohara 	int session;
352068a6eb9Skiyohara 	char *buf = NULL;
353068a6eb9Skiyohara 
354068a6eb9Skiyohara 	session = MVCESA_SESSION(crp->crp_sid);
3554b175f25Sriastradh 	KASSERTMSG(session < sc->sc_nsessions, "session=%d nsessions=%d",
3564b175f25Sriastradh 	    session, sc->sc_nsessions);
357068a6eb9Skiyohara 	ses = &sc->sc_sessions[session];
358068a6eb9Skiyohara 
359068a6eb9Skiyohara 	if (crp->crp_flags & CRYPTO_F_IMBUF)
360068a6eb9Skiyohara 		m = (struct mbuf *)crp->crp_buf;
361068a6eb9Skiyohara 	else if (crp->crp_flags & CRYPTO_F_IOV)
362068a6eb9Skiyohara 		uio = (struct uio *)crp->crp_buf;
363068a6eb9Skiyohara 	else
364068a6eb9Skiyohara 		buf = (char *)crp->crp_buf;
365068a6eb9Skiyohara 
366068a6eb9Skiyohara 	if (0 /* DMA support */) {
367068a6eb9Skiyohara 		/* not yet... */
368068a6eb9Skiyohara 
369068a6eb9Skiyohara 		goto done;
370068a6eb9Skiyohara 	}
371068a6eb9Skiyohara 
372068a6eb9Skiyohara 	/* PIO operation */
373068a6eb9Skiyohara 
374068a6eb9Skiyohara 	for (crd = crp->crp_desc; crd; crd = crd->crd_next) {
375068a6eb9Skiyohara 		switch (crd->crd_alg) {
376068a6eb9Skiyohara 		case CRYPTO_DES_CBC:
377068a6eb9Skiyohara 		case CRYPTO_3DES_CBC:
378068a6eb9Skiyohara 		{
379068a6eb9Skiyohara 			uint32_t alg, mode, dir, *iv, ivbuf[2];
380068a6eb9Skiyohara 
381068a6eb9Skiyohara 			mode = MVCESA_DESE_C_DESMODE_CBC;
382068a6eb9Skiyohara 			if (crd->crd_alg == CRYPTO_DES_CBC)
383068a6eb9Skiyohara 				alg = MVCESA_DESE_C_ALGORITHM_DES;
384068a6eb9Skiyohara 			else {	/* CRYPTO_3DES_CBC */
385068a6eb9Skiyohara 				alg = MVCESA_DESE_C_ALGORITHM_3DES;
386068a6eb9Skiyohara 				mode |= MVCESA_DESE_C_3DESMODE_EDE;
387068a6eb9Skiyohara 			}
388068a6eb9Skiyohara 			if (crd->crd_flags & CRD_F_ENCRYPT) {
389068a6eb9Skiyohara 				dir = MVCESA_DESE_C_DIRECTION_ENC;
390068a6eb9Skiyohara 				if (crd->crd_flags & CRD_F_IV_EXPLICIT)
391068a6eb9Skiyohara 					iv = (uint32_t *)crd->crd_iv;
3929da090b0Sriastradh 				else {
3939da090b0Sriastradh 					cprng_fast(ivbuf, sizeof(ivbuf));
3949da090b0Sriastradh 					iv = ivbuf;
3959da090b0Sriastradh 				}
396068a6eb9Skiyohara 				if (!(crd->crd_flags & CRD_F_IV_PRESENT)) {
397068a6eb9Skiyohara 					if (m != NULL)
398068a6eb9Skiyohara 						m_copyback(m, crd->crd_inject,
399068a6eb9Skiyohara 						    8, iv);
400068a6eb9Skiyohara 					else if (uio != NULL)
401068a6eb9Skiyohara 						cuio_copyback(uio,
402068a6eb9Skiyohara 						    crd->crd_inject, 8, iv);
403068a6eb9Skiyohara 				}
404068a6eb9Skiyohara 			} else {
405068a6eb9Skiyohara 				dir = MVCESA_DESE_C_DIRECTION_DEC;
406068a6eb9Skiyohara 				if (crd->crd_flags & CRD_F_IV_EXPLICIT)
407068a6eb9Skiyohara 					iv = (uint32_t *)crd->crd_iv;
408068a6eb9Skiyohara 				else {
409068a6eb9Skiyohara 					if (m != NULL)
410068a6eb9Skiyohara 						m_copydata(m, crd->crd_inject,
411068a6eb9Skiyohara 						    8, ivbuf);
412068a6eb9Skiyohara 					else if (uio != NULL)
413068a6eb9Skiyohara 						cuio_copydata(uio,
414068a6eb9Skiyohara 						    crd->crd_inject, 8, ivbuf);
415068a6eb9Skiyohara 					iv = ivbuf;
416068a6eb9Skiyohara 				}
417068a6eb9Skiyohara 			}
418068a6eb9Skiyohara 
419068a6eb9Skiyohara 			crp->crp_etype = mvcesa_des_encdec(sc, ses,
420068a6eb9Skiyohara 			    alg, mode, dir, iv, crd->crd_skip, crd->crd_len,
421068a6eb9Skiyohara 			    buf, m, uio);
422068a6eb9Skiyohara 			break;
423068a6eb9Skiyohara 		}
424068a6eb9Skiyohara 
425068a6eb9Skiyohara 		case CRYPTO_SHA1:
426068a6eb9Skiyohara 		case CRYPTO_SHA1_HMAC:
427068a6eb9Skiyohara 		case CRYPTO_MD5:
428068a6eb9Skiyohara 		case CRYPTO_MD5_HMAC:
429068a6eb9Skiyohara 		{
430068a6eb9Skiyohara 			uint64_t bits;
431068a6eb9Skiyohara 			uint32_t alg, *iv = NULL, digest[512 / 8 / 4], dlen;
432068a6eb9Skiyohara 
433068a6eb9Skiyohara 			if (crd->crd_alg == CRYPTO_SHA1 ||
434068a6eb9Skiyohara 			    crd->crd_alg == CRYPTO_SHA1_HMAC) {
435068a6eb9Skiyohara 				alg = MVCESA_SHA1MD5I_AC_ALGORITHM_SHA1;
436068a6eb9Skiyohara 				dlen = 160;
437068a6eb9Skiyohara 			} else {	/* CRYPTO_MD5 || CRYPTO_MD5_HMAC */
438068a6eb9Skiyohara 				alg = MVCESA_SHA1MD5I_AC_ALGORITHM_MD5;
439068a6eb9Skiyohara 				dlen = 128;
440068a6eb9Skiyohara 			}
441068a6eb9Skiyohara 			bits = crd->crd_len << 3;
442068a6eb9Skiyohara 			if (crd->crd_alg == CRYPTO_SHA1_HMAC ||
443068a6eb9Skiyohara 			    crd->crd_alg == CRYPTO_MD5_HMAC) {
444068a6eb9Skiyohara 				iv = ses->ses_hminner;
445068a6eb9Skiyohara 				bits += 512;
446068a6eb9Skiyohara 			}
447068a6eb9Skiyohara 
448068a6eb9Skiyohara 			crp->crp_etype = mvcesa_authentication(sc, ses,
449068a6eb9Skiyohara 			    alg, iv, digest, bits, crd->crd_skip, crd->crd_len,
450068a6eb9Skiyohara 			    buf, m, uio);
451068a6eb9Skiyohara 			if (crp->crp_etype != 0)
452068a6eb9Skiyohara 				break;
453068a6eb9Skiyohara 
454068a6eb9Skiyohara 			if (crd->crd_alg == CRYPTO_SHA1_HMAC ||
455068a6eb9Skiyohara 			    crd->crd_alg == CRYPTO_MD5_HMAC)
456068a6eb9Skiyohara 				crp->crp_etype = mvcesa_authentication(sc,
457068a6eb9Skiyohara 				    ses, alg, ses->ses_hmouter, digest,
458068a6eb9Skiyohara 				    512 + dlen, 0, dlen, (char *)digest, NULL,
459068a6eb9Skiyohara 				    NULL);
460068a6eb9Skiyohara 			if (crp->crp_etype != 0)
461068a6eb9Skiyohara 				break;
462068a6eb9Skiyohara 
463068a6eb9Skiyohara 			/* Inject the authentication data */
464068a6eb9Skiyohara 			if (buf != NULL)
465068a6eb9Skiyohara 				memcpy(buf + crd->crd_inject, digest, dlen / 8);
466068a6eb9Skiyohara 			else if (m != NULL)
467068a6eb9Skiyohara 				m_copyback(m, crd->crd_inject, dlen / 8,
468068a6eb9Skiyohara 				    digest);
469068a6eb9Skiyohara 			else if (uio != NULL)
470068a6eb9Skiyohara 				memcpy(crp->crp_mac, digest, dlen / 8);
471068a6eb9Skiyohara 		}
472068a6eb9Skiyohara 		}
473068a6eb9Skiyohara 		if (crp->crp_etype != 0)
474068a6eb9Skiyohara 			break;
475068a6eb9Skiyohara 	}
476068a6eb9Skiyohara 
477068a6eb9Skiyohara done:
478068a6eb9Skiyohara 	DPRINTF(("request %08x done\n", (uint32_t)crp));
479068a6eb9Skiyohara 	crypto_done(crp);
480068a6eb9Skiyohara 	return 0;
481068a6eb9Skiyohara }
482068a6eb9Skiyohara 
483068a6eb9Skiyohara 
484068a6eb9Skiyohara static int
mvcesa_authentication(struct mvcesa_softc * sc,struct mvcesa_session * ses,uint32_t alg,uint32_t * iv,uint32_t * digest,uint64_t bits,int skip,int len,char * buf,struct mbuf * m,struct uio * uio)485068a6eb9Skiyohara mvcesa_authentication(struct mvcesa_softc *sc, struct mvcesa_session *ses,
486068a6eb9Skiyohara 		      uint32_t alg, uint32_t *iv, uint32_t *digest,
487068a6eb9Skiyohara 		      uint64_t bits, int skip, int len, char *buf,
488068a6eb9Skiyohara 		      struct mbuf *m, struct uio *uio)
489068a6eb9Skiyohara {
490068a6eb9Skiyohara 	uint32_t cmd, bswp, data = 0;
491068a6eb9Skiyohara 	int dlen, off, i, s;
492068a6eb9Skiyohara 
493068a6eb9Skiyohara 	/*
494068a6eb9Skiyohara 	 * SHA/MD5 algorithms work in 512-bit chunks, equal to 16 words.
495068a6eb9Skiyohara 	 */
496068a6eb9Skiyohara 
497068a6eb9Skiyohara 	KASSERT(!(len & (512 - 1)) || bits != 0);
498068a6eb9Skiyohara 	KASSERT(buf != NULL || m != NULL || uio != NULL);
499068a6eb9Skiyohara 
500068a6eb9Skiyohara 	cmd = bus_space_read_4(sc->sc_iot, sc->sc_ioh, MVCESA_SHA1MD5I_AC);
501068a6eb9Skiyohara 	if (!(cmd & MVCESA_SHA1MD5I_AC_TERMINATION))
502068a6eb9Skiyohara 		return ERESTART;
503068a6eb9Skiyohara 
504068a6eb9Skiyohara 	bswp = 0;
505068a6eb9Skiyohara 	if (alg == MVCESA_SHA1MD5I_AC_ALGORITHM_SHA1) {
506068a6eb9Skiyohara 		dlen = 160;
507068a6eb9Skiyohara 		bits = htobe64(bits);
508068a6eb9Skiyohara #if BYTE_ORDER == LITTLE_ENDIAN
509068a6eb9Skiyohara 		bswp = MVCESA_SHA1MD5I_AC_DATABYTESWAP |
510068a6eb9Skiyohara 		    MVCESA_SHA1MD5I_AC_IVBYTESWAP;
511068a6eb9Skiyohara #endif
512068a6eb9Skiyohara 	} else {	/* MVCESA_SHA1MD5I_AC_ALGORITHM_MD5 */
513068a6eb9Skiyohara 		dlen = 128;
514068a6eb9Skiyohara 		bits = htole64(bits);
515068a6eb9Skiyohara #if BYTE_ORDER == BIG_ENDIAN
516068a6eb9Skiyohara 		bswp = MVCESA_SHA1MD5I_AC_DATABYTESWAP |
517068a6eb9Skiyohara 		    MVCESA_SHA1MD5I_AC_IVBYTESWAP;
518068a6eb9Skiyohara #endif
519068a6eb9Skiyohara 	}
520068a6eb9Skiyohara 	bus_space_write_4(sc->sc_iot, sc->sc_ioh, MVCESA_SHA1MD5I_AC,
521068a6eb9Skiyohara 	    alg | bswp | MVCESA_SHA1MD5I_AC_MODE_USEIV);
522068a6eb9Skiyohara 
523068a6eb9Skiyohara 	if (iv != NULL)
524068a6eb9Skiyohara 		bus_space_write_region_4(sc->sc_iot, sc->sc_ioh,
525068a6eb9Skiyohara 		    MVCESA_SHA1MD5I_IVDA, iv, dlen / 4);
526068a6eb9Skiyohara 
527068a6eb9Skiyohara 	off = i = 0;
528068a6eb9Skiyohara 	while (1 /* CONSTCOND */) {
529068a6eb9Skiyohara 		data = 0;
530068a6eb9Skiyohara 		if (buf != NULL)
531068a6eb9Skiyohara 			for (i = 0; i < 512 / 8 && off + i < len; i += s) {
532d1579b2dSriastradh 				s = uimin(sizeof(data), len - off - i);
533068a6eb9Skiyohara 				memcpy(&data, buf + skip + off + i, s);
534068a6eb9Skiyohara 				if (s == sizeof(data))
535068a6eb9Skiyohara 					bus_space_write_4(sc->sc_iot,
536068a6eb9Skiyohara 					    sc->sc_ioh, MVCESA_SHA1MD5I_DI,
537068a6eb9Skiyohara 					    data);
538068a6eb9Skiyohara 			}
539068a6eb9Skiyohara 		else if (m != NULL)
540068a6eb9Skiyohara 			for (i = 0; i < 512 / 8 && off + i < len; i += s) {
541d1579b2dSriastradh 				s = uimin(sizeof(data), len - off - i);
542068a6eb9Skiyohara 				m_copydata(m, skip + off + i, s, &data);
543068a6eb9Skiyohara 				if (s == sizeof(data))
544068a6eb9Skiyohara 					bus_space_write_4(sc->sc_iot,
545068a6eb9Skiyohara 					    sc->sc_ioh, MVCESA_SHA1MD5I_DI,
546068a6eb9Skiyohara 					    data);
547068a6eb9Skiyohara 			}
548068a6eb9Skiyohara 		else if (uio != NULL)
549068a6eb9Skiyohara 			for (i = 0; i < 512 / 8 && off + i < len; i += s) {
550d1579b2dSriastradh 				s = uimin(sizeof(data), len - off - i);
551068a6eb9Skiyohara 				cuio_copydata(uio, skip + off + i, s, &data);
552068a6eb9Skiyohara 				if (s == sizeof(data))
553068a6eb9Skiyohara 					bus_space_write_4(sc->sc_iot,
554068a6eb9Skiyohara 					    sc->sc_ioh, MVCESA_SHA1MD5I_DI,
555068a6eb9Skiyohara 					    data);
556068a6eb9Skiyohara 			}
557068a6eb9Skiyohara 
558068a6eb9Skiyohara 		off += i;
559068a6eb9Skiyohara 		if (i < 512 / 8)
560068a6eb9Skiyohara 			break;
561068a6eb9Skiyohara 
562068a6eb9Skiyohara 		do {
563068a6eb9Skiyohara 			cmd = bus_space_read_4(sc->sc_iot, sc->sc_ioh,
564068a6eb9Skiyohara 			    MVCESA_SHA1MD5I_AC);
565068a6eb9Skiyohara 		} while (!(cmd & MVCESA_SHA1MD5I_AC_TERMINATION));
566068a6eb9Skiyohara 
567068a6eb9Skiyohara 		bus_space_write_4(sc->sc_iot, sc->sc_ioh, MVCESA_SHA1MD5I_AC,
568068a6eb9Skiyohara 		    alg | bswp | MVCESA_SHA1MD5I_AC_MODE_CONTINUE);
569068a6eb9Skiyohara 	}
570068a6eb9Skiyohara 
571068a6eb9Skiyohara 	if (i < 512 / 8) {
572068a6eb9Skiyohara 		*((char *)&data + (i % 4)) = 0x80;
573068a6eb9Skiyohara 		bus_space_write_4(sc->sc_iot, sc->sc_ioh, MVCESA_SHA1MD5I_DI,
574068a6eb9Skiyohara 		    data);
575068a6eb9Skiyohara 		i = (i & ~3) + 4;
576068a6eb9Skiyohara 
577068a6eb9Skiyohara 		/* Do pad to 512 bits, if chunk size is more than 448 bits. */
578068a6eb9Skiyohara 		if (i > 448 / 8) {
579068a6eb9Skiyohara 			for (; i < 512 / 8; i += 4)
580068a6eb9Skiyohara 				bus_space_write_4(sc->sc_iot, sc->sc_ioh,
581068a6eb9Skiyohara 				    MVCESA_SHA1MD5I_DI, 0);
582068a6eb9Skiyohara 			do {
583068a6eb9Skiyohara 				cmd = bus_space_read_4(sc->sc_iot, sc->sc_ioh,
584068a6eb9Skiyohara 				    MVCESA_SHA1MD5I_AC);
585068a6eb9Skiyohara 			} while (!(cmd & MVCESA_SHA1MD5I_AC_TERMINATION));
586068a6eb9Skiyohara 			i = 0;
587068a6eb9Skiyohara 		}
588068a6eb9Skiyohara 		for (; i < 448 / 8; i += 4)
589068a6eb9Skiyohara 			bus_space_write_4(sc->sc_iot, sc->sc_ioh,
590068a6eb9Skiyohara 			    MVCESA_SHA1MD5I_DI, 0);
591068a6eb9Skiyohara 
592068a6eb9Skiyohara 		/* Set total bits */
593068a6eb9Skiyohara 		bus_space_write_4(sc->sc_iot, sc->sc_ioh, MVCESA_SHA1MD5I_BCL,
594068a6eb9Skiyohara 		    bits & 0xffffffff);
595068a6eb9Skiyohara 		bus_space_write_4(sc->sc_iot, sc->sc_ioh, MVCESA_SHA1MD5I_BCH,
596068a6eb9Skiyohara 		    bits >> 32);
597068a6eb9Skiyohara 		do {
598068a6eb9Skiyohara 			cmd = bus_space_read_4(sc->sc_iot, sc->sc_ioh,
599068a6eb9Skiyohara 			    MVCESA_SHA1MD5I_AC);
600068a6eb9Skiyohara 		} while (!(cmd & MVCESA_SHA1MD5I_AC_TERMINATION));
601068a6eb9Skiyohara 	}
602068a6eb9Skiyohara 
603068a6eb9Skiyohara 	if (digest != NULL) {
604068a6eb9Skiyohara 		/* Read digest */
605068a6eb9Skiyohara 		bus_space_read_region_4(sc->sc_iot, sc->sc_ioh,
606068a6eb9Skiyohara 		    MVCESA_SHA1MD5I_IVDA, digest, dlen / 8 / 4);
607068a6eb9Skiyohara #if BYTE_ORDER == LITTLE_ENDIAN
608068a6eb9Skiyohara 		if (alg == MVCESA_SHA1MD5I_AC_ALGORITHM_SHA1)
609068a6eb9Skiyohara 			for (i = 0; i < dlen / 8 / 4; i++)
610068a6eb9Skiyohara 				digest[i] = be32toh(digest[i]);
611068a6eb9Skiyohara #else
612068a6eb9Skiyohara 		if (alg == MVCESA_SHA1MD5I_AC_ALGORITHM_MD5)
613068a6eb9Skiyohara 			for (i = 0; i < dlen / 8 / 4; i++)
614068a6eb9Skiyohara 				digest[i] = le32toh(digest[i]);
615068a6eb9Skiyohara #endif
616068a6eb9Skiyohara 	}
617068a6eb9Skiyohara 	return 0;
618068a6eb9Skiyohara }
619068a6eb9Skiyohara 
620068a6eb9Skiyohara static int
mvcesa_des_encdec(struct mvcesa_softc * sc,struct mvcesa_session * ses,uint32_t alg,uint32_t mode,uint32_t dir,uint32_t * iv,int skip,int len,char * buf,struct mbuf * m,struct uio * uio)621068a6eb9Skiyohara mvcesa_des_encdec(struct mvcesa_softc *sc, struct mvcesa_session *ses,
622068a6eb9Skiyohara 		  uint32_t alg, uint32_t mode, uint32_t dir, uint32_t *iv,
623068a6eb9Skiyohara 		  int skip, int len, char *buf, struct mbuf *m, struct uio *uio)
624068a6eb9Skiyohara {
625068a6eb9Skiyohara 	uint64_t iblk, oblk;
626068a6eb9Skiyohara 	uint32_t cmd, bswp = 0;
627068a6eb9Skiyohara 	int i, o, s;
628068a6eb9Skiyohara 
629068a6eb9Skiyohara 	KASSERT(buf != NULL || m != NULL || uio != NULL);
630068a6eb9Skiyohara 
631068a6eb9Skiyohara 	cmd = bus_space_read_4(sc->sc_iot, sc->sc_ioh, MVCESA_DESE_C);
632068a6eb9Skiyohara 	if (!(cmd & MVCESA_DESE_C_TERMINATION))
633068a6eb9Skiyohara 		return ERESTART;
634068a6eb9Skiyohara 
635068a6eb9Skiyohara #if BYTE_ORDER == LITTLE_ENDIAN
636068a6eb9Skiyohara 	bswp = MVCESA_DESE_C_DATABYTESWAP | MVCESA_DESE_C_IVBYTESWAP   |
637068a6eb9Skiyohara 	    MVCESA_DESE_C_OUTBYTESWAP;
638068a6eb9Skiyohara #endif
639068a6eb9Skiyohara 	bus_space_write_4(sc->sc_iot, sc->sc_ioh, MVCESA_DESE_C,
640068a6eb9Skiyohara 	    dir | alg | mode | bswp | MVCESA_DESE_C_ALLTERMINATION);
641068a6eb9Skiyohara 
642068a6eb9Skiyohara 	bus_space_write_4(sc->sc_iot, sc->sc_ioh, MVCESA_DESE_K0L,
643068a6eb9Skiyohara 	    ses->ses_key[1]);
644068a6eb9Skiyohara 	bus_space_write_4(sc->sc_iot, sc->sc_ioh, MVCESA_DESE_K0H,
645068a6eb9Skiyohara 	    ses->ses_key[0]);
646068a6eb9Skiyohara 	if (alg == MVCESA_DESE_C_ALGORITHM_3DES) {
647068a6eb9Skiyohara 		bus_space_write_4(sc->sc_iot, sc->sc_ioh, MVCESA_DESE_K1L,
648068a6eb9Skiyohara 		    ses->ses_key[3]);
649068a6eb9Skiyohara 		bus_space_write_4(sc->sc_iot, sc->sc_ioh, MVCESA_DESE_K1H,
650068a6eb9Skiyohara 		    ses->ses_key[2]);
651068a6eb9Skiyohara 		bus_space_write_4(sc->sc_iot, sc->sc_ioh, MVCESA_DESE_K2L,
652068a6eb9Skiyohara 		    ses->ses_key[5]);
653068a6eb9Skiyohara 		bus_space_write_4(sc->sc_iot, sc->sc_ioh, MVCESA_DESE_K2H,
654068a6eb9Skiyohara 		    ses->ses_key[4]);
655068a6eb9Skiyohara 	}
656068a6eb9Skiyohara 
657068a6eb9Skiyohara 	bus_space_write_4(sc->sc_iot, sc->sc_ioh, MVCESA_DESE_IVL, iv[1]);
658068a6eb9Skiyohara 	bus_space_write_4(sc->sc_iot, sc->sc_ioh, MVCESA_DESE_IVH, iv[0]);
659068a6eb9Skiyohara 
660068a6eb9Skiyohara 	i = o = 0;
661068a6eb9Skiyohara 	while (i < len) {
662d1579b2dSriastradh 		s = uimin(sizeof(iblk), len - i);
663068a6eb9Skiyohara 		iblk = 0;
664068a6eb9Skiyohara 
665068a6eb9Skiyohara 		if (buf != NULL)
666068a6eb9Skiyohara 			memcpy(&iblk, buf + skip + i, s);
667068a6eb9Skiyohara 		else if (m != NULL)
668068a6eb9Skiyohara 			m_copydata(m, skip + i, s, &iblk);
669068a6eb9Skiyohara 		else if (uio != NULL)
670068a6eb9Skiyohara 			cuio_copydata(uio, skip + i, s, &iblk);
671068a6eb9Skiyohara 
672068a6eb9Skiyohara 		/*
673068a6eb9Skiyohara 		 * We have the pipeline that two data enters.
674068a6eb9Skiyohara 		 */
675068a6eb9Skiyohara 
676068a6eb9Skiyohara 		while (1 /* CONSTCOND */) {
677068a6eb9Skiyohara 			cmd = bus_space_read_4(sc->sc_iot, sc->sc_ioh,
678068a6eb9Skiyohara 			    MVCESA_DESE_C);
679068a6eb9Skiyohara 			if (cmd & MVCESA_DESE_C_ALLTERMINATION)
680068a6eb9Skiyohara 				/* Engine is ready.  Can write two data. */
681068a6eb9Skiyohara 				break;
682068a6eb9Skiyohara 			if (cmd & MVCESA_DESE_C_READALLOW) {
683068a6eb9Skiyohara 				oblk = bus_space_read_4(sc->sc_iot, sc->sc_ioh,
684068a6eb9Skiyohara 				    MVCESA_DESE_DOH);
685068a6eb9Skiyohara 				/* XXXX: needs barrier? */
686068a6eb9Skiyohara 				oblk |= (uint64_t)bus_space_read_4(sc->sc_iot,
687068a6eb9Skiyohara 				    sc->sc_ioh, MVCESA_DESE_DOL) << 32;
688068a6eb9Skiyohara 
689068a6eb9Skiyohara 				if (buf != NULL)
690068a6eb9Skiyohara 					memcpy(buf + skip + o, &oblk,
691068a6eb9Skiyohara 					    sizeof(oblk));
692068a6eb9Skiyohara 				else if (m != NULL)
693068a6eb9Skiyohara 					m_copydata(m, skip + o, sizeof(oblk),
694068a6eb9Skiyohara 					    &oblk);
695068a6eb9Skiyohara 				else if (uio != NULL)
696068a6eb9Skiyohara 					cuio_copyback(uio, skip + o,
697068a6eb9Skiyohara 					    sizeof(oblk), &oblk);
698068a6eb9Skiyohara 				o += sizeof(oblk);
699068a6eb9Skiyohara 
700068a6eb9Skiyohara 				/* Can write one data */
701068a6eb9Skiyohara 				break;
702068a6eb9Skiyohara 			}
703068a6eb9Skiyohara 		}
704068a6eb9Skiyohara 
705068a6eb9Skiyohara 		/*
70660277796Smsaitoh 		 * Encryption/Decryption calculation time is 9 cycles in DES
707068a6eb9Skiyohara 		 * mode and 25 cycles in 3DES mode.
708068a6eb9Skiyohara 		 */
709068a6eb9Skiyohara 		bus_space_write_4(sc->sc_iot, sc->sc_ioh, MVCESA_DESE_DBL,
710068a6eb9Skiyohara 		    iblk >> 32);
711068a6eb9Skiyohara 		/* XXXX: needs barrier? */
712068a6eb9Skiyohara 		bus_space_write_4(sc->sc_iot, sc->sc_ioh, MVCESA_DESE_DBH,
713068a6eb9Skiyohara 		    iblk & 0xffffffff);
714068a6eb9Skiyohara 		i += s;
715068a6eb9Skiyohara 	}
716068a6eb9Skiyohara 
717068a6eb9Skiyohara 	while (1 /* CONSTCOND */) {
718068a6eb9Skiyohara 		cmd = bus_space_read_4(sc->sc_iot, sc->sc_ioh,
719068a6eb9Skiyohara 		    MVCESA_DESE_C);
720068a6eb9Skiyohara 		if (cmd & (MVCESA_DESE_C_READALLOW |
721068a6eb9Skiyohara 					MVCESA_DESE_C_ALLTERMINATION)) {
722068a6eb9Skiyohara 			oblk = bus_space_read_4(sc->sc_iot, sc->sc_ioh,
723068a6eb9Skiyohara 			    MVCESA_DESE_DOH);
724068a6eb9Skiyohara 			/* XXXX: needs barrier? */
725068a6eb9Skiyohara 			oblk |= (uint64_t)bus_space_read_4(sc->sc_iot,
726068a6eb9Skiyohara 			    sc->sc_ioh, MVCESA_DESE_DOL) << 32;
727068a6eb9Skiyohara 
728068a6eb9Skiyohara 			if (cmd & MVCESA_DESE_C_ALLTERMINATION) {
729068a6eb9Skiyohara 				/* We can read IV from Data Out Registers. */
730068a6eb9Skiyohara 				if (dir == MVCESA_DESE_C_DIRECTION_ENC)
731068a6eb9Skiyohara 					o -= sizeof(oblk);
732068a6eb9Skiyohara 				else
733068a6eb9Skiyohara 					break;
734068a6eb9Skiyohara 			}
735068a6eb9Skiyohara 			if (buf != NULL)
736068a6eb9Skiyohara 				memcpy(buf + skip + o, &oblk, sizeof(oblk));
737068a6eb9Skiyohara 			else if (m != NULL)
738068a6eb9Skiyohara 				m_copydata(m, skip + o, sizeof(oblk), &oblk);
739068a6eb9Skiyohara 			else if (uio != NULL)
740068a6eb9Skiyohara 				cuio_copyback(uio, skip + o, sizeof(oblk),
741068a6eb9Skiyohara 				    &oblk);
742068a6eb9Skiyohara 			o += sizeof(oblk);
743068a6eb9Skiyohara 			if (cmd & MVCESA_DESE_C_ALLTERMINATION)
744068a6eb9Skiyohara 				break;
745068a6eb9Skiyohara 		}
746068a6eb9Skiyohara 	}
747068a6eb9Skiyohara 
748068a6eb9Skiyohara 	return 0;
749068a6eb9Skiyohara }
750