sun8i_crypto.c revision 1.1 1 1.1 riastrad /* $NetBSD: sun8i_crypto.c,v 1.1 2019/12/09 04:51:03 riastradh Exp $ */
2 1.1 riastrad
3 1.1 riastrad /*-
4 1.1 riastrad * Copyright (c) 2019 The NetBSD Foundation, Inc.
5 1.1 riastrad * All rights reserved.
6 1.1 riastrad *
7 1.1 riastrad * This code is derived from software contributed to The NetBSD Foundation
8 1.1 riastrad * by Taylor R. Campbell.
9 1.1 riastrad *
10 1.1 riastrad * Redistribution and use in source and binary forms, with or without
11 1.1 riastrad * modification, are permitted provided that the following conditions
12 1.1 riastrad * are met:
13 1.1 riastrad * 1. Redistributions of source code must retain the above copyright
14 1.1 riastrad * notice, this list of conditions and the following disclaimer.
15 1.1 riastrad * 2. Redistributions in binary form must reproduce the above copyright
16 1.1 riastrad * notice, this list of conditions and the following disclaimer in the
17 1.1 riastrad * documentation and/or other materials provided with the distribution.
18 1.1 riastrad *
19 1.1 riastrad * THIS SOFTWARE IS PROVIDED BY THE NETBSD FOUNDATION, INC. AND CONTRIBUTORS
20 1.1 riastrad * ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED
21 1.1 riastrad * TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR
22 1.1 riastrad * PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE FOUNDATION OR CONTRIBUTORS
23 1.1 riastrad * BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
24 1.1 riastrad * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
25 1.1 riastrad * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
26 1.1 riastrad * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
27 1.1 riastrad * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
28 1.1 riastrad * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
29 1.1 riastrad * POSSIBILITY OF SUCH DAMAGE.
30 1.1 riastrad */
31 1.1 riastrad
32 1.1 riastrad /*
33 1.1 riastrad * sun8i_crypto -- Allwinner Crypto Engine driver
34 1.1 riastrad *
35 1.1 riastrad * The Crypto Engine is documented in Sec. 3.15 of the Allwinner A64
36 1.1 riastrad * User Manual v1.1, on pp. 230--241. We only use it for the TRNG at
37 1.1 riastrad * the moment, but in principle it could be wired up with opencrypto(9)
38 1.1 riastrad * to compute AES, DES, 3DES, MD5, SHA-1, SHA-224, SHA-256, HMAC-SHA1,
39 1.1 riastrad * HMAC-HA256, RSA, and an undocumented PRNG. It also seems to support
40 1.1 riastrad * AES keys in SRAM (for some kind of HDMI HDCP stuff?).
41 1.1 riastrad *
42 1.1 riastrad * https://linux-sunxi.org/images/b/b4/Allwinner_A64_User_Manual_V1.1.pdf
43 1.1 riastrad */
44 1.1 riastrad
45 1.1 riastrad #include <sys/cdefs.h>
46 1.1 riastrad __KERNEL_RCSID(1, "$NetBSD: sun8i_crypto.c,v 1.1 2019/12/09 04:51:03 riastradh Exp $");
47 1.1 riastrad
48 1.1 riastrad #include <sys/types.h>
49 1.1 riastrad #include <sys/param.h>
50 1.1 riastrad #include <sys/atomic.h>
51 1.1 riastrad #include <sys/bus.h>
52 1.1 riastrad #include <sys/callout.h>
53 1.1 riastrad #include <sys/conf.h>
54 1.1 riastrad #include <sys/device.h>
55 1.1 riastrad #include <sys/kernel.h>
56 1.1 riastrad #include <sys/kmem.h>
57 1.1 riastrad #include <sys/mutex.h>
58 1.1 riastrad #include <sys/rndpool.h>
59 1.1 riastrad #include <sys/rndsource.h>
60 1.1 riastrad #include <sys/sysctl.h>
61 1.1 riastrad #include <sys/workqueue.h>
62 1.1 riastrad
63 1.1 riastrad #include <dev/fdt/fdtvar.h>
64 1.1 riastrad
65 1.1 riastrad #include <arm/sunxi/sun8i_crypto.h>
66 1.1 riastrad
67 1.1 riastrad #define SUN8I_CRYPTO_TIMEOUT hz
68 1.1 riastrad #define SUN8I_CRYPTO_RNGENTROPY 8 /* estimated bits per bit of entropy */
69 1.1 riastrad #define SUN8I_CRYPTO_RNGBYTES \
70 1.1 riastrad (SUN8I_CRYPTO_RNGENTROPY*howmany(RND_POOLBITS, NBBY))
71 1.1 riastrad
72 1.1 riastrad struct sun8i_crypto_task;
73 1.1 riastrad
74 1.1 riastrad struct sun8i_crypto_buf {
75 1.1 riastrad bus_dma_segment_t cb_seg[1];
76 1.1 riastrad int cb_nsegs;
77 1.1 riastrad bus_dmamap_t cb_map;
78 1.1 riastrad void *cb_kva;
79 1.1 riastrad };
80 1.1 riastrad
81 1.1 riastrad struct sun8i_crypto_softc {
82 1.1 riastrad device_t sc_dev;
83 1.1 riastrad bus_space_tag_t sc_bst;
84 1.1 riastrad bus_space_handle_t sc_bsh;
85 1.1 riastrad bus_dma_tag_t sc_dmat;
86 1.1 riastrad kmutex_t sc_lock;
87 1.1 riastrad struct sun8i_crypto_chan {
88 1.1 riastrad struct sun8i_crypto_task *cc_task;
89 1.1 riastrad unsigned cc_starttime;
90 1.1 riastrad } sc_chan[SUN8I_CRYPTO_NCHAN];
91 1.1 riastrad struct callout sc_timeout;
92 1.1 riastrad struct workqueue *sc_wq;
93 1.1 riastrad struct work sc_work;
94 1.1 riastrad void *sc_ih;
95 1.1 riastrad uint32_t sc_done;
96 1.1 riastrad uint32_t sc_esr;
97 1.1 riastrad bool sc_work_pending;
98 1.1 riastrad struct sun8i_crypto_rng {
99 1.1 riastrad struct sun8i_crypto_buf cr_buf;
100 1.1 riastrad struct sun8i_crypto_task *cr_task;
101 1.1 riastrad struct krndsource cr_rndsource;
102 1.1 riastrad bool cr_pending;
103 1.1 riastrad } sc_rng;
104 1.1 riastrad struct sun8i_crypto_selftest {
105 1.1 riastrad struct sun8i_crypto_buf cs_in;
106 1.1 riastrad struct sun8i_crypto_buf cs_key;
107 1.1 riastrad struct sun8i_crypto_buf cs_out;
108 1.1 riastrad struct sun8i_crypto_task *cs_task;
109 1.1 riastrad } sc_selftest;
110 1.1 riastrad struct sun8i_crypto_sysctl {
111 1.1 riastrad struct sysctllog *cy_log;
112 1.1 riastrad const struct sysctlnode *cy_root_node;
113 1.1 riastrad const struct sysctlnode *cy_trng_node;
114 1.1 riastrad } sc_sysctl;
115 1.1 riastrad };
116 1.1 riastrad
117 1.1 riastrad struct sun8i_crypto_task {
118 1.1 riastrad bus_dma_segment_t ct_desc_seg[1];
119 1.1 riastrad int ct_desc_nseg;
120 1.1 riastrad bus_dmamap_t ct_desc_map;
121 1.1 riastrad void *ct_desc_kva;
122 1.1 riastrad struct sun8i_crypto_taskdesc *ct_desc;
123 1.1 riastrad void (*ct_callback)(struct sun8i_crypto_softc *,
124 1.1 riastrad struct sun8i_crypto_task *, void *, int);
125 1.1 riastrad void *ct_cookie;
126 1.1 riastrad };
127 1.1 riastrad
128 1.1 riastrad /*
129 1.1 riastrad * Forward declarations
130 1.1 riastrad */
131 1.1 riastrad
132 1.1 riastrad static int sun8i_crypto_match(device_t, cfdata_t, void *);
133 1.1 riastrad static void sun8i_crypto_attach(device_t, device_t, void *);
134 1.1 riastrad
135 1.1 riastrad static struct sun8i_crypto_task *
136 1.1 riastrad sun8i_crypto_task_get(struct sun8i_crypto_softc *,
137 1.1 riastrad void (*)(struct sun8i_crypto_softc *,
138 1.1 riastrad struct sun8i_crypto_task *, void *, int),
139 1.1 riastrad void *);
140 1.1 riastrad static void sun8i_crypto_task_put(struct sun8i_crypto_softc *,
141 1.1 riastrad struct sun8i_crypto_task *);
142 1.1 riastrad static void sun8i_crypto_task_reset(struct sun8i_crypto_task *);
143 1.1 riastrad
144 1.1 riastrad static void sun8i_crypto_task_set_key(struct sun8i_crypto_task *,
145 1.1 riastrad bus_dmamap_t);
146 1.1 riastrad static void sun8i_crypto_task_set_iv(struct sun8i_crypto_task *,
147 1.1 riastrad bus_dmamap_t);
148 1.1 riastrad static void sun8i_crypto_task_set_ctr(struct sun8i_crypto_task *,
149 1.1 riastrad bus_dmamap_t);
150 1.1 riastrad static void sun8i_crypto_task_set_input(struct sun8i_crypto_task *,
151 1.1 riastrad bus_dmamap_t);
152 1.1 riastrad static void sun8i_crypto_task_set_output(struct sun8i_crypto_task *,
153 1.1 riastrad bus_dmamap_t);
154 1.1 riastrad
155 1.1 riastrad static void sun8i_crypto_task_scatter(struct sun8i_crypto_adrlen *,
156 1.1 riastrad bus_dmamap_t);
157 1.1 riastrad
158 1.1 riastrad static int sun8i_crypto_submit_trng(struct sun8i_crypto_softc *,
159 1.1 riastrad struct sun8i_crypto_task *, uint32_t);
160 1.1 riastrad static int sun8i_crypto_submit_aesecb(struct sun8i_crypto_softc *,
161 1.1 riastrad struct sun8i_crypto_task *, uint32_t, uint32_t, uint32_t);
162 1.1 riastrad static int sun8i_crypto_submit(struct sun8i_crypto_softc *,
163 1.1 riastrad struct sun8i_crypto_task *);
164 1.1 riastrad
165 1.1 riastrad static void sun8i_crypto_timeout(void *);
166 1.1 riastrad static int sun8i_crypto_intr(void *);
167 1.1 riastrad static void sun8i_crypto_schedule_worker(struct sun8i_crypto_softc *);
168 1.1 riastrad static void sun8i_crypto_worker(struct work *, void *);
169 1.1 riastrad static void sun8i_crypto_chan_done(struct sun8i_crypto_softc *, unsigned,
170 1.1 riastrad int);
171 1.1 riastrad
172 1.1 riastrad static int sun8i_crypto_allocbuf(struct sun8i_crypto_softc *, size_t,
173 1.1 riastrad struct sun8i_crypto_buf *);
174 1.1 riastrad static void sun8i_crypto_freebuf(struct sun8i_crypto_softc *, size_t,
175 1.1 riastrad struct sun8i_crypto_buf *);
176 1.1 riastrad
177 1.1 riastrad static void sun8i_crypto_rng_attach(struct sun8i_crypto_softc *);
178 1.1 riastrad static void sun8i_crypto_rng_get(size_t, void *);
179 1.1 riastrad static void sun8i_crypto_rng_done(struct sun8i_crypto_softc *,
180 1.1 riastrad struct sun8i_crypto_task *, void *, int);
181 1.1 riastrad
182 1.1 riastrad static void sun8i_crypto_selftest(device_t);
183 1.1 riastrad static void sun8i_crypto_selftest_done(struct sun8i_crypto_softc *,
184 1.1 riastrad struct sun8i_crypto_task *, void *, int);
185 1.1 riastrad
186 1.1 riastrad static void sun8i_crypto_sysctl_attach(struct sun8i_crypto_softc *);
187 1.1 riastrad static int sun8i_crypto_sysctl_rng(SYSCTLFN_ARGS);
188 1.1 riastrad static void sun8i_crypto_sysctl_rng_done(struct sun8i_crypto_softc *,
189 1.1 riastrad struct sun8i_crypto_task *, void *, int);
190 1.1 riastrad
191 1.1 riastrad /*
192 1.1 riastrad * Register access
193 1.1 riastrad */
194 1.1 riastrad
195 1.1 riastrad static uint32_t
196 1.1 riastrad sun8i_crypto_read(struct sun8i_crypto_softc *sc, bus_addr_t reg)
197 1.1 riastrad {
198 1.1 riastrad return bus_space_read_4(sc->sc_bst, sc->sc_bsh, reg);
199 1.1 riastrad }
200 1.1 riastrad
201 1.1 riastrad static void
202 1.1 riastrad sun8i_crypto_write(struct sun8i_crypto_softc *sc, bus_addr_t reg, uint32_t v)
203 1.1 riastrad {
204 1.1 riastrad bus_space_write_4(sc->sc_bst, sc->sc_bsh, reg, v);
205 1.1 riastrad }
206 1.1 riastrad
207 1.1 riastrad /*
208 1.1 riastrad * Autoconf goo
209 1.1 riastrad */
210 1.1 riastrad
211 1.1 riastrad CFATTACH_DECL_NEW(sun8i_crypto, sizeof(struct sun8i_crypto_softc),
212 1.1 riastrad sun8i_crypto_match, sun8i_crypto_attach, NULL, NULL);
213 1.1 riastrad
214 1.1 riastrad static const struct of_compat_data compat_data[] = {
215 1.1 riastrad {"allwinner,sun50i-a64-crypto", 0},
216 1.1 riastrad {NULL}
217 1.1 riastrad };
218 1.1 riastrad
219 1.1 riastrad static int
220 1.1 riastrad sun8i_crypto_match(device_t parent, cfdata_t cf, void *aux)
221 1.1 riastrad {
222 1.1 riastrad const struct fdt_attach_args *const faa = aux;
223 1.1 riastrad
224 1.1 riastrad return of_match_compat_data(faa->faa_phandle, compat_data);
225 1.1 riastrad }
226 1.1 riastrad
227 1.1 riastrad static void
228 1.1 riastrad sun8i_crypto_attach(device_t parent, device_t self, void *aux)
229 1.1 riastrad {
230 1.1 riastrad struct sun8i_crypto_softc *const sc = device_private(self);
231 1.1 riastrad const struct fdt_attach_args *const faa = aux;
232 1.1 riastrad bus_addr_t addr;
233 1.1 riastrad bus_size_t size;
234 1.1 riastrad const int phandle = faa->faa_phandle;
235 1.1 riastrad char intrstr[128];
236 1.1 riastrad struct clk *clk;
237 1.1 riastrad struct fdtbus_reset *rst;
238 1.1 riastrad
239 1.1 riastrad sc->sc_dev = self;
240 1.1 riastrad sc->sc_dmat = faa->faa_dmat;
241 1.1 riastrad sc->sc_bst = faa->faa_bst;
242 1.1 riastrad mutex_init(&sc->sc_lock, MUTEX_DEFAULT, IPL_VM);
243 1.1 riastrad callout_init(&sc->sc_timeout, CALLOUT_MPSAFE);
244 1.1 riastrad callout_setfunc(&sc->sc_timeout, &sun8i_crypto_timeout, sc);
245 1.1 riastrad if (workqueue_create(&sc->sc_wq, device_xname(self),
246 1.1 riastrad &sun8i_crypto_worker, sc, PRI_NONE, IPL_VM, WQ_MPSAFE) != 0) {
247 1.1 riastrad aprint_error(": couldn't create workqueue\n");
248 1.1 riastrad return;
249 1.1 riastrad }
250 1.1 riastrad
251 1.1 riastrad /* Get and map device registers. */
252 1.1 riastrad if (fdtbus_get_reg(phandle, 0, &addr, &size) != 0) {
253 1.1 riastrad aprint_error(": couldn't get registers\n");
254 1.1 riastrad return;
255 1.1 riastrad }
256 1.1 riastrad if (bus_space_map(sc->sc_bst, addr, size, 0, &sc->sc_bsh) != 0) {
257 1.1 riastrad aprint_error(": couldn't map registers\n");
258 1.1 riastrad return;
259 1.1 riastrad }
260 1.1 riastrad
261 1.1 riastrad /* Get an interrupt handle. */
262 1.1 riastrad if (!fdtbus_intr_str(phandle, 0, intrstr, sizeof(intrstr))) {
263 1.1 riastrad aprint_error(": failed to decode interrupt\n");
264 1.1 riastrad return;
265 1.1 riastrad }
266 1.1 riastrad
267 1.1 riastrad /* Enable the bus clock. */
268 1.1 riastrad if (fdtbus_clock_enable(phandle, "bus", true) != 0) {
269 1.1 riastrad aprint_error(": couldn't enable bus clock\n");
270 1.1 riastrad return;
271 1.1 riastrad }
272 1.1 riastrad
273 1.1 riastrad /* Get the module clock and set it to 300 MHz. */
274 1.1 riastrad if ((clk = fdtbus_clock_get(phandle, "mod")) != NULL) {
275 1.1 riastrad if (clk_enable(clk) != 0) {
276 1.1 riastrad aprint_error(": couldn't enable CE clock\n");
277 1.1 riastrad return;
278 1.1 riastrad }
279 1.1 riastrad if (clk_set_rate(clk, 300*1000*1000) != 0) {
280 1.1 riastrad aprint_error(": couldn't set CE clock to 300MHz\n");
281 1.1 riastrad return;
282 1.1 riastrad }
283 1.1 riastrad }
284 1.1 riastrad
285 1.1 riastrad /* Get a reset handle if we need and try to deassert it. */
286 1.1 riastrad if ((rst = fdtbus_reset_get_index(phandle, 0)) != NULL) {
287 1.1 riastrad if (fdtbus_reset_deassert(rst) != 0) {
288 1.1 riastrad aprint_error(": couldn't de-assert reset\n");
289 1.1 riastrad return;
290 1.1 riastrad }
291 1.1 riastrad }
292 1.1 riastrad
293 1.1 riastrad aprint_naive("\n");
294 1.1 riastrad aprint_normal(": Crypto Engine\n");
295 1.1 riastrad aprint_debug_dev(self, ": clock freq %d\n", clk_get_rate(clk));
296 1.1 riastrad
297 1.1 riastrad /* Disable and clear interrupts. */
298 1.1 riastrad sun8i_crypto_write(sc, SUN8I_CRYPTO_ICR, 0);
299 1.1 riastrad sun8i_crypto_write(sc, SUN8I_CRYPTO_ISR, 0);
300 1.1 riastrad
301 1.1 riastrad /* Establish an interrupt handler. */
302 1.1 riastrad sc->sc_ih = fdtbus_intr_establish(phandle, 0, IPL_VM, FDT_INTR_MPSAFE,
303 1.1 riastrad &sun8i_crypto_intr, sc);
304 1.1 riastrad if (sc->sc_ih == NULL) {
305 1.1 riastrad aprint_error_dev(self, "failed to establish interrupt on %s\n",
306 1.1 riastrad intrstr);
307 1.1 riastrad return;
308 1.1 riastrad }
309 1.1 riastrad aprint_normal_dev(self, "interrupting on %s\n", intrstr);
310 1.1 riastrad
311 1.1 riastrad /* Set up the RNG. */
312 1.1 riastrad sun8i_crypto_rng_attach(sc);
313 1.1 riastrad
314 1.1 riastrad /* Attach the sysctl. */
315 1.1 riastrad sun8i_crypto_sysctl_attach(sc);
316 1.1 riastrad
317 1.1 riastrad /* Perform self-tests. */
318 1.1 riastrad config_interrupts(self, sun8i_crypto_selftest);
319 1.1 riastrad }
320 1.1 riastrad
321 1.1 riastrad /*
322 1.1 riastrad * Task allocation
323 1.1 riastrad */
324 1.1 riastrad
325 1.1 riastrad static struct sun8i_crypto_task *
326 1.1 riastrad sun8i_crypto_task_get(struct sun8i_crypto_softc *sc,
327 1.1 riastrad void (*callback)(struct sun8i_crypto_softc *, struct sun8i_crypto_task *,
328 1.1 riastrad void *, int),
329 1.1 riastrad void *cookie)
330 1.1 riastrad {
331 1.1 riastrad struct sun8i_crypto_task *task;
332 1.1 riastrad const size_t desc_size = sizeof(*task->ct_desc);
333 1.1 riastrad int error;
334 1.1 riastrad
335 1.1 riastrad task = kmem_zalloc(sizeof(*task), KM_SLEEP);
336 1.1 riastrad
337 1.1 riastrad /* Allocate DMA-safe memory for the descriptor. */
338 1.1 riastrad error = bus_dmamem_alloc(sc->sc_dmat, desc_size, 0, 0,
339 1.1 riastrad task->ct_desc_seg, __arraycount(task->ct_desc_seg),
340 1.1 riastrad &task->ct_desc_nseg, BUS_DMA_NOWAIT);
341 1.1 riastrad if (error)
342 1.1 riastrad goto fail0;
343 1.1 riastrad
344 1.1 riastrad /* Map the descriptor into kernel virtual address space. */
345 1.1 riastrad error = bus_dmamem_map(sc->sc_dmat, task->ct_desc_seg,
346 1.1 riastrad task->ct_desc_nseg, desc_size, &task->ct_desc_kva, BUS_DMA_NOWAIT);
347 1.1 riastrad if (error)
348 1.1 riastrad goto fail1;
349 1.1 riastrad task->ct_desc = task->ct_desc_kva;
350 1.1 riastrad
351 1.1 riastrad /* Create a map for exposing the descriptor to DMA. */
352 1.1 riastrad error = bus_dmamap_create(sc->sc_dmat, desc_size, 1, desc_size, 0,
353 1.1 riastrad BUS_DMA_NOWAIT, &task->ct_desc_map);
354 1.1 riastrad if (error)
355 1.1 riastrad goto fail2;
356 1.1 riastrad
357 1.1 riastrad /* Load the descriptor into the DMA map. */
358 1.1 riastrad error = bus_dmamap_load(sc->sc_dmat, task->ct_desc_map,
359 1.1 riastrad task->ct_desc_kva, desc_size, NULL, BUS_DMA_NOWAIT);
360 1.1 riastrad if (error)
361 1.1 riastrad goto fail3;
362 1.1 riastrad
363 1.1 riastrad task->ct_callback = callback;
364 1.1 riastrad task->ct_cookie = cookie;
365 1.1 riastrad
366 1.1 riastrad return task;
367 1.1 riastrad
368 1.1 riastrad fail4: __unused
369 1.1 riastrad bus_dmamap_unload(sc->sc_dmat, task->ct_desc_map);
370 1.1 riastrad fail3: bus_dmamap_destroy(sc->sc_dmat, task->ct_desc_map);
371 1.1 riastrad fail2: bus_dmamem_unmap(sc->sc_dmat, task->ct_desc_kva,
372 1.1 riastrad sizeof(*task->ct_desc));
373 1.1 riastrad fail1: bus_dmamem_free(sc->sc_dmat, task->ct_desc_seg, task->ct_desc_nseg);
374 1.1 riastrad fail0: kmem_free(task, sizeof(*task));
375 1.1 riastrad return NULL;
376 1.1 riastrad }
377 1.1 riastrad
378 1.1 riastrad static void
379 1.1 riastrad sun8i_crypto_task_put(struct sun8i_crypto_softc *sc,
380 1.1 riastrad struct sun8i_crypto_task *task)
381 1.1 riastrad {
382 1.1 riastrad
383 1.1 riastrad bus_dmamap_unload(sc->sc_dmat, task->ct_desc_map);
384 1.1 riastrad bus_dmamap_destroy(sc->sc_dmat, task->ct_desc_map);
385 1.1 riastrad bus_dmamem_unmap(sc->sc_dmat, task->ct_desc_kva,
386 1.1 riastrad sizeof(*task->ct_desc));
387 1.1 riastrad bus_dmamem_free(sc->sc_dmat, task->ct_desc_seg, task->ct_desc_nseg);
388 1.1 riastrad kmem_free(task, sizeof(*task));
389 1.1 riastrad }
390 1.1 riastrad
391 1.1 riastrad /*
392 1.1 riastrad * Task descriptor setup
393 1.1 riastrad *
394 1.1 riastrad * WARNING: Task descriptor fields are little-endian, not host-endian.
395 1.1 riastrad */
396 1.1 riastrad
397 1.1 riastrad static void
398 1.1 riastrad sun8i_crypto_task_reset(struct sun8i_crypto_task *task)
399 1.1 riastrad {
400 1.1 riastrad
401 1.1 riastrad memset(task->ct_desc, 0, sizeof(*task->ct_desc));
402 1.1 riastrad }
403 1.1 riastrad
404 1.1 riastrad static void
405 1.1 riastrad sun8i_crypto_task_set_key(struct sun8i_crypto_task *task, bus_dmamap_t map)
406 1.1 riastrad {
407 1.1 riastrad
408 1.1 riastrad KASSERT(map->dm_nsegs == 1);
409 1.1 riastrad task->ct_desc->td_keydesc = htole32(map->dm_segs[0].ds_addr);
410 1.1 riastrad }
411 1.1 riastrad
412 1.1 riastrad static void __unused /* XXX opencrypto(9) */
413 1.1 riastrad sun8i_crypto_task_set_iv(struct sun8i_crypto_task *task, bus_dmamap_t map)
414 1.1 riastrad {
415 1.1 riastrad
416 1.1 riastrad KASSERT(map->dm_nsegs == 1);
417 1.1 riastrad task->ct_desc->td_ivdesc = htole32(map->dm_segs[0].ds_addr);
418 1.1 riastrad }
419 1.1 riastrad
420 1.1 riastrad static void __unused /* XXX opencrypto(9) */
421 1.1 riastrad sun8i_crypto_task_set_ctr(struct sun8i_crypto_task *task, bus_dmamap_t map)
422 1.1 riastrad {
423 1.1 riastrad
424 1.1 riastrad KASSERT(map->dm_nsegs == 1);
425 1.1 riastrad task->ct_desc->td_ctrdesc = htole32(map->dm_segs[0].ds_addr);
426 1.1 riastrad }
427 1.1 riastrad
428 1.1 riastrad static void
429 1.1 riastrad sun8i_crypto_task_set_input(struct sun8i_crypto_task *task, bus_dmamap_t map)
430 1.1 riastrad {
431 1.1 riastrad
432 1.1 riastrad sun8i_crypto_task_scatter(task->ct_desc->td_src, map);
433 1.1 riastrad }
434 1.1 riastrad
435 1.1 riastrad static void
436 1.1 riastrad sun8i_crypto_task_set_output(struct sun8i_crypto_task *task, bus_dmamap_t map)
437 1.1 riastrad {
438 1.1 riastrad
439 1.1 riastrad sun8i_crypto_task_scatter(task->ct_desc->td_dst, map);
440 1.1 riastrad }
441 1.1 riastrad
442 1.1 riastrad static void
443 1.1 riastrad sun8i_crypto_task_scatter(struct sun8i_crypto_adrlen *adrlen, bus_dmamap_t map)
444 1.1 riastrad {
445 1.1 riastrad uint32_t total __diagused = 0;
446 1.1 riastrad unsigned i;
447 1.1 riastrad
448 1.1 riastrad KASSERT(map->dm_nsegs <= SUN8I_CRYPTO_MAXSEGS);
449 1.1 riastrad for (i = 0; i < map->dm_nsegs; i++) {
450 1.1 riastrad KASSERT((map->dm_segs[i].ds_addr % 4) == 0);
451 1.1 riastrad KASSERT(map->dm_segs[i].ds_addr <= UINT32_MAX);
452 1.1 riastrad KASSERT(map->dm_segs[i].ds_len <= UINT32_MAX - total);
453 1.1 riastrad adrlen[i].adr = htole32(map->dm_segs[i].ds_addr);
454 1.1 riastrad adrlen[i].len = htole32(map->dm_segs[i].ds_len/4);
455 1.1 riastrad total += map->dm_segs[i].ds_len;
456 1.1 riastrad }
457 1.1 riastrad
458 1.1 riastrad /* Verify the remainder are zero. */
459 1.1 riastrad for (; i < SUN8I_CRYPTO_MAXSEGS; i++) {
460 1.1 riastrad KASSERT(adrlen[i].adr == 0);
461 1.1 riastrad KASSERT(adrlen[i].len == 0);
462 1.1 riastrad }
463 1.1 riastrad
464 1.1 riastrad /* Verify the total size matches the DMA map. */
465 1.1 riastrad KASSERT(total == map->dm_mapsize);
466 1.1 riastrad }
467 1.1 riastrad
468 1.1 riastrad /*
469 1.1 riastrad * Task submission
470 1.1 riastrad *
471 1.1 riastrad * WARNING: Task descriptor fields are little-endian, not host-endian.
472 1.1 riastrad */
473 1.1 riastrad
474 1.1 riastrad static int
475 1.1 riastrad sun8i_crypto_submit_trng(struct sun8i_crypto_softc *sc,
476 1.1 riastrad struct sun8i_crypto_task *task, uint32_t datalen)
477 1.1 riastrad {
478 1.1 riastrad struct sun8i_crypto_taskdesc *desc = task->ct_desc;
479 1.1 riastrad uint32_t tdqc = 0;
480 1.1 riastrad uint32_t total __diagused;
481 1.1 riastrad unsigned i __diagused;
482 1.1 riastrad
483 1.1 riastrad /* Data length must be a multiple of 4 because...reasons. */
484 1.1 riastrad KASSERT((datalen % 4) == 0);
485 1.1 riastrad
486 1.1 riastrad /* All of the sources should be empty. */
487 1.1 riastrad for (total = 0, i = 0; i < SUN8I_CRYPTO_MAXSEGS; i++)
488 1.1 riastrad KASSERT(le32toh(task->ct_desc->td_src[i].len) == 0);
489 1.1 riastrad
490 1.1 riastrad /* Verify the total output length -- should be datalen/4. */
491 1.1 riastrad for (total = 0, i = 0; i < SUN8I_CRYPTO_MAXSEGS; i++) {
492 1.1 riastrad uint32_t len = le32toh(task->ct_desc->td_dst[i].len);
493 1.1 riastrad KASSERT(len <= UINT32_MAX - total);
494 1.1 riastrad total += len;
495 1.1 riastrad }
496 1.1 riastrad KASSERT(total == datalen/4);
497 1.1 riastrad
498 1.1 riastrad /* Verify the key, IV, and CTR are unset. */
499 1.1 riastrad KASSERT(desc->td_keydesc == 0);
500 1.1 riastrad KASSERT(desc->td_ivdesc == 0);
501 1.1 riastrad KASSERT(desc->td_ctrdesc == 0);
502 1.1 riastrad
503 1.1 riastrad /* Set up the task descriptor queue control words. */
504 1.1 riastrad tdqc |= SUN8I_CRYPTO_TDQC_INTR_EN;
505 1.1 riastrad tdqc |= __SHIFTIN(SUN8I_CRYPTO_TDQC_METHOD_TRNG,
506 1.1 riastrad SUN8I_CRYPTO_TDQC_METHOD);
507 1.1 riastrad desc->td_tdqc = htole32(tdqc);
508 1.1 riastrad desc->td_tdqs = 0; /* no symmetric crypto */
509 1.1 riastrad desc->td_tdqa = 0; /* no asymmetric crypto */
510 1.1 riastrad
511 1.1 riastrad /* Set the data length for the output. */
512 1.1 riastrad desc->td_datalen = htole32(datalen/4);
513 1.1 riastrad
514 1.1 riastrad /* Submit! */
515 1.1 riastrad return sun8i_crypto_submit(sc, task);
516 1.1 riastrad }
517 1.1 riastrad
518 1.1 riastrad static int
519 1.1 riastrad sun8i_crypto_submit_aesecb(struct sun8i_crypto_softc *sc,
520 1.1 riastrad struct sun8i_crypto_task *task,
521 1.1 riastrad uint32_t datalen, uint32_t keysize, uint32_t dir)
522 1.1 riastrad {
523 1.1 riastrad struct sun8i_crypto_taskdesc *desc = task->ct_desc;
524 1.1 riastrad uint32_t tdqc = 0, tdqs = 0;
525 1.1 riastrad uint32_t total __diagused;
526 1.1 riastrad unsigned i __diagused;
527 1.1 riastrad
528 1.1 riastrad /*
529 1.1 riastrad * Data length must be a multiple of 4 because...reasons.
530 1.1 riastrad *
531 1.1 riastrad * WARNING: For `AES-CTS' (maybe that means AES-XTS?), datalen
532 1.1 riastrad * is in units of bytes, not units of words -- but everything
533 1.1 riastrad * _else_ is in units of words. This routine applies only to
534 1.1 riastrad * AES-ECB for the self-test.
535 1.1 riastrad */
536 1.1 riastrad KASSERT((datalen % 4) == 0);
537 1.1 riastrad
538 1.1 riastrad /* Verify the total input length -- should be datalen/4. */
539 1.1 riastrad for (total = 0, i = 0; i < SUN8I_CRYPTO_MAXSEGS; i++) {
540 1.1 riastrad uint32_t len = le32toh(task->ct_desc->td_src[i].len);
541 1.1 riastrad KASSERT(len <= UINT32_MAX - total);
542 1.1 riastrad total += len;
543 1.1 riastrad }
544 1.1 riastrad KASSERT(total == datalen/4);
545 1.1 riastrad
546 1.1 riastrad /* Verify the total output length -- should be datalen/4. */
547 1.1 riastrad for (total = 0, i = 0; i < SUN8I_CRYPTO_MAXSEGS; i++) {
548 1.1 riastrad uint32_t len = le32toh(task->ct_desc->td_dst[i].len);
549 1.1 riastrad KASSERT(len <= UINT32_MAX - total);
550 1.1 riastrad total += len;
551 1.1 riastrad }
552 1.1 riastrad KASSERT(total == datalen/4);
553 1.1 riastrad
554 1.1 riastrad /* Set up the task descriptor queue control word. */
555 1.1 riastrad tdqc |= SUN8I_CRYPTO_TDQC_INTR_EN;
556 1.1 riastrad tdqc |= __SHIFTIN(SUN8I_CRYPTO_TDQC_METHOD_AES,
557 1.1 riastrad SUN8I_CRYPTO_TDQC_METHOD);
558 1.1 riastrad desc->td_tdqc = htole32(tdqc);
559 1.1 riastrad
560 1.1 riastrad /* Set up the symmetric control word. */
561 1.1 riastrad tdqs |= __SHIFTIN(SUN8I_CRYPTO_TDQS_SKEY_SELECT_SS_KEYx,
562 1.1 riastrad SUN8I_CRYPTO_TDQS_SKEY_SELECT);
563 1.1 riastrad tdqs |= __SHIFTIN(SUN8I_CRYPTO_TDQS_OP_MODE_ECB,
564 1.1 riastrad SUN8I_CRYPTO_TDQS_OP_MODE);
565 1.1 riastrad tdqs |= __SHIFTIN(SUN8I_CRYPTO_TDQS_AES_KEYSIZE_128,
566 1.1 riastrad SUN8I_CRYPTO_TDQS_AES_KEYSIZE);
567 1.1 riastrad desc->td_tdqs = htole32(tdqs);
568 1.1 riastrad
569 1.1 riastrad desc->td_tdqa = 0; /* no asymmetric crypto */
570 1.1 riastrad
571 1.1 riastrad /* Set the data length for the output. */
572 1.1 riastrad desc->td_datalen = htole32(datalen/4);
573 1.1 riastrad
574 1.1 riastrad /* Submit! */
575 1.1 riastrad return sun8i_crypto_submit(sc, task);
576 1.1 riastrad }
577 1.1 riastrad
578 1.1 riastrad static int
579 1.1 riastrad sun8i_crypto_submit(struct sun8i_crypto_softc *sc,
580 1.1 riastrad struct sun8i_crypto_task *task)
581 1.1 riastrad {
582 1.1 riastrad unsigned i, retries = 0;
583 1.1 riastrad uint32_t icr;
584 1.1 riastrad int error = 0;
585 1.1 riastrad
586 1.1 riastrad /* One at a time at the device registers, please. */
587 1.1 riastrad mutex_enter(&sc->sc_lock);
588 1.1 riastrad
589 1.1 riastrad /* Find a channel. */
590 1.1 riastrad for (i = 0; i < SUN8I_CRYPTO_NCHAN; i++) {
591 1.1 riastrad if (sc->sc_chan[i].cc_task == NULL)
592 1.1 riastrad break;
593 1.1 riastrad }
594 1.1 riastrad if (i == SUN8I_CRYPTO_NCHAN) {
595 1.1 riastrad device_printf(sc->sc_dev, "no free channels\n");
596 1.1 riastrad error = ERESTART;
597 1.1 riastrad goto out;
598 1.1 riastrad }
599 1.1 riastrad
600 1.1 riastrad /*
601 1.1 riastrad * Set the channel id. Caller is responsible for setting up
602 1.1 riastrad * all other parts of the descriptor.
603 1.1 riastrad */
604 1.1 riastrad task->ct_desc->td_cid = htole32(i);
605 1.1 riastrad
606 1.1 riastrad /* Prepare to send the descriptor to the device by DMA. */
607 1.1 riastrad bus_dmamap_sync(sc->sc_dmat, task->ct_desc_map, 0,
608 1.1 riastrad sizeof(*task->ct_desc), BUS_DMASYNC_PREWRITE);
609 1.1 riastrad
610 1.1 riastrad /* Confirm we're ready to go. */
611 1.1 riastrad if (sun8i_crypto_read(sc, SUN8I_CRYPTO_TLR) & SUN8I_CRYPTO_TLR_LOAD) {
612 1.1 riastrad device_printf(sc->sc_dev, "TLR not clear\n");
613 1.1 riastrad error = EIO;
614 1.1 riastrad goto out;
615 1.1 riastrad }
616 1.1 riastrad
617 1.1 riastrad /* Enable interrupts for this channel. */
618 1.1 riastrad icr = sun8i_crypto_read(sc, SUN8I_CRYPTO_ICR);
619 1.1 riastrad icr |= __SHIFTIN(SUN8I_CRYPTO_ICR_INTR_EN_CHAN(i),
620 1.1 riastrad SUN8I_CRYPTO_ICR_INTR_EN);
621 1.1 riastrad sun8i_crypto_write(sc, SUN8I_CRYPTO_ICR, icr);
622 1.1 riastrad
623 1.1 riastrad /* Set the task descriptor queue address. */
624 1.1 riastrad sun8i_crypto_write(sc, SUN8I_CRYPTO_TDQ,
625 1.1 riastrad task->ct_desc_map->dm_segs[0].ds_addr);
626 1.1 riastrad
627 1.1 riastrad /* Notify the engine to load it, and wait for acknowledgement. */
628 1.1 riastrad sun8i_crypto_write(sc, SUN8I_CRYPTO_TLR, SUN8I_CRYPTO_TLR_LOAD);
629 1.1 riastrad while (sun8i_crypto_read(sc, SUN8I_CRYPTO_TLR) & SUN8I_CRYPTO_TLR_LOAD)
630 1.1 riastrad {
631 1.1 riastrad /*
632 1.1 riastrad * XXX Timeout pulled from arse. Is it even important
633 1.1 riastrad * to wait here?
634 1.1 riastrad */
635 1.1 riastrad if (++retries == 1000) {
636 1.1 riastrad device_printf(sc->sc_dev, "TLR didn't clear: %08x\n",
637 1.1 riastrad sun8i_crypto_read(sc, SUN8I_CRYPTO_TLR));
638 1.1 riastrad /*
639 1.1 riastrad * Hope it clears eventually; if not, we'll
640 1.1 riastrad * time out.
641 1.1 riastrad */
642 1.1 riastrad break;
643 1.1 riastrad }
644 1.1 riastrad DELAY(1);
645 1.1 riastrad }
646 1.1 riastrad
647 1.1 riastrad /* Loaded up and ready to go. Start a timer ticking. */
648 1.1 riastrad sc->sc_chan[i].cc_task = task;
649 1.1 riastrad sc->sc_chan[i].cc_starttime = atomic_load_relaxed(&hardclock_ticks);
650 1.1 riastrad callout_schedule(&sc->sc_timeout, SUN8I_CRYPTO_TIMEOUT);
651 1.1 riastrad
652 1.1 riastrad /* XXX Consider polling if cold to get entropy earlier. */
653 1.1 riastrad
654 1.1 riastrad out: /* Done! */
655 1.1 riastrad mutex_exit(&sc->sc_lock);
656 1.1 riastrad return error;
657 1.1 riastrad }
658 1.1 riastrad
659 1.1 riastrad static void
660 1.1 riastrad sun8i_crypto_timeout(void *cookie)
661 1.1 riastrad {
662 1.1 riastrad struct sun8i_crypto_softc *sc = cookie;
663 1.1 riastrad unsigned i;
664 1.1 riastrad
665 1.1 riastrad mutex_enter(&sc->sc_lock);
666 1.1 riastrad
667 1.1 riastrad /* Check whether there are any tasks pending. */
668 1.1 riastrad for (i = 0; i < SUN8I_CRYPTO_NCHAN; i++) {
669 1.1 riastrad if (sc->sc_chan[i].cc_task)
670 1.1 riastrad break;
671 1.1 riastrad }
672 1.1 riastrad if (i == SUN8I_CRYPTO_NCHAN)
673 1.1 riastrad /* None pending, so nothing to do. */
674 1.1 riastrad goto out;
675 1.1 riastrad
676 1.1 riastrad /*
677 1.1 riastrad * Schedule the worker to check for timeouts, and schedule
678 1.1 riastrad * another timeout in case we need it.
679 1.1 riastrad */
680 1.1 riastrad sun8i_crypto_schedule_worker(sc);
681 1.1 riastrad callout_schedule(&sc->sc_timeout, SUN8I_CRYPTO_TIMEOUT);
682 1.1 riastrad
683 1.1 riastrad out: mutex_exit(&sc->sc_lock);
684 1.1 riastrad }
685 1.1 riastrad
686 1.1 riastrad static int
687 1.1 riastrad sun8i_crypto_intr(void *cookie)
688 1.1 riastrad {
689 1.1 riastrad struct sun8i_crypto_softc *sc = cookie;
690 1.1 riastrad uint32_t isr, esr;
691 1.1 riastrad
692 1.1 riastrad mutex_enter(&sc->sc_lock);
693 1.1 riastrad
694 1.1 riastrad /*
695 1.1 riastrad * Get and acknowledge the interrupts and error status.
696 1.1 riastrad *
697 1.1 riastrad * XXX Data sheet says the error status register is read-only,
698 1.1 riastrad * but then advises writing 1 to bit x1xx (keysram access error
699 1.1 riastrad * for AES, SUN8I_CRYPTO_ESR_KEYSRAMERR) to clear it. What do?
700 1.1 riastrad */
701 1.1 riastrad isr = sun8i_crypto_read(sc, SUN8I_CRYPTO_ISR);
702 1.1 riastrad esr = sun8i_crypto_read(sc, SUN8I_CRYPTO_ESR);
703 1.1 riastrad sun8i_crypto_write(sc, SUN8I_CRYPTO_ISR, isr);
704 1.1 riastrad sun8i_crypto_write(sc, SUN8I_CRYPTO_ISR, esr);
705 1.1 riastrad
706 1.1 riastrad /* Start the worker if necessary. */
707 1.1 riastrad sun8i_crypto_schedule_worker(sc);
708 1.1 riastrad
709 1.1 riastrad /* Tell the worker what to do. */
710 1.1 riastrad sc->sc_done |= __SHIFTOUT(isr, SUN8I_CRYPTO_ISR_DONE);
711 1.1 riastrad sc->sc_esr |= esr;
712 1.1 riastrad
713 1.1 riastrad mutex_exit(&sc->sc_lock);
714 1.1 riastrad
715 1.1 riastrad return __SHIFTOUT(isr, SUN8I_CRYPTO_ISR_DONE) != 0;
716 1.1 riastrad }
717 1.1 riastrad
718 1.1 riastrad static void
719 1.1 riastrad sun8i_crypto_schedule_worker(struct sun8i_crypto_softc *sc)
720 1.1 riastrad {
721 1.1 riastrad
722 1.1 riastrad KASSERT(mutex_owned(&sc->sc_lock));
723 1.1 riastrad
724 1.1 riastrad /* Start the worker if necessary. */
725 1.1 riastrad if (!sc->sc_work_pending) {
726 1.1 riastrad workqueue_enqueue(sc->sc_wq, &sc->sc_work, NULL);
727 1.1 riastrad sc->sc_work_pending = true;
728 1.1 riastrad }
729 1.1 riastrad }
730 1.1 riastrad
731 1.1 riastrad static void
732 1.1 riastrad sun8i_crypto_worker(struct work *wk, void *cookie)
733 1.1 riastrad {
734 1.1 riastrad struct sun8i_crypto_softc *sc = cookie;
735 1.1 riastrad uint32_t done, esr, esr_chan;
736 1.1 riastrad unsigned i, now;
737 1.1 riastrad int error;
738 1.1 riastrad
739 1.1 riastrad /*
740 1.1 riastrad * Acquire the lock. Note: We will be releasing and
741 1.1 riastrad * reacquiring it throughout the loop.
742 1.1 riastrad */
743 1.1 riastrad mutex_enter(&sc->sc_lock);
744 1.1 riastrad
745 1.1 riastrad /* Acknowledge the work. */
746 1.1 riastrad KASSERT(sc->sc_work_pending);
747 1.1 riastrad sc->sc_work_pending = false;
748 1.1 riastrad
749 1.1 riastrad /*
750 1.1 riastrad * Claim the done mask and error status once; we will be
751 1.1 riastrad * releasing and reacquiring the lock for the callbacks, so
752 1.1 riastrad * they may change.
753 1.1 riastrad */
754 1.1 riastrad done = sc->sc_done;
755 1.1 riastrad esr = sc->sc_esr;
756 1.1 riastrad sc->sc_done = 0;
757 1.1 riastrad sc->sc_esr = 0;
758 1.1 riastrad
759 1.1 riastrad /* Check the time to determine what's timed out. */
760 1.1 riastrad now = atomic_load_relaxed(&hardclock_ticks);
761 1.1 riastrad
762 1.1 riastrad /* Process the channels. */
763 1.1 riastrad for (i = 0; i < SUN8I_CRYPTO_NCHAN; i++) {
764 1.1 riastrad if (!ISSET(done, SUN8I_CRYPTO_ISR_DONE_CHAN(i))) {
765 1.1 riastrad /* Check to see if we have a task that timed out. */
766 1.1 riastrad if ((sc->sc_chan[i].cc_task != NULL) &&
767 1.1 riastrad ((now - sc->sc_chan[i].cc_starttime) >=
768 1.1 riastrad SUN8I_CRYPTO_TIMEOUT))
769 1.1 riastrad sun8i_crypto_chan_done(sc, i, ETIMEDOUT);
770 1.1 riastrad continue;
771 1.1 riastrad }
772 1.1 riastrad esr_chan = __SHIFTOUT(esr, SUN8I_CRYPTO_ESR_CHAN(i));
773 1.1 riastrad if (esr_chan & SUN8I_CRYPTO_ESR_CHAN_ALGNOTSUP) {
774 1.1 riastrad device_printf(sc->sc_dev, "channel %u:"
775 1.1 riastrad " alg not supported\n", i);
776 1.1 riastrad error = ENODEV;
777 1.1 riastrad } else if (esr_chan & SUN8I_CRYPTO_ESR_CHAN_DATALENERR) {
778 1.1 riastrad device_printf(sc->sc_dev, "channel %u:"
779 1.1 riastrad " data length error\n", i);
780 1.1 riastrad error = EIO; /* XXX */
781 1.1 riastrad } else if (esr_chan & SUN8I_CRYPTO_ESR_CHAN_KEYSRAMERR) {
782 1.1 riastrad device_printf(sc->sc_dev, "channel %u:"
783 1.1 riastrad " key sram error\n", i);
784 1.1 riastrad error = EIO; /* XXX */
785 1.1 riastrad } else if (esr_chan != 0) {
786 1.1 riastrad error = EIO; /* generic I/O error */
787 1.1 riastrad } else {
788 1.1 riastrad error = 0;
789 1.1 riastrad }
790 1.1 riastrad
791 1.1 riastrad /* May release the lock to invoke a callback. */
792 1.1 riastrad sun8i_crypto_chan_done(sc, i, error);
793 1.1 riastrad }
794 1.1 riastrad
795 1.1 riastrad /* All one; release the lock one last time. */
796 1.1 riastrad mutex_exit(&sc->sc_lock);
797 1.1 riastrad }
798 1.1 riastrad
799 1.1 riastrad static void
800 1.1 riastrad sun8i_crypto_chan_done(struct sun8i_crypto_softc *sc, unsigned i, int error)
801 1.1 riastrad {
802 1.1 riastrad struct sun8i_crypto_task *task;
803 1.1 riastrad uint32_t icr;
804 1.1 riastrad
805 1.1 riastrad KASSERT(mutex_owned(&sc->sc_lock));
806 1.1 riastrad
807 1.1 riastrad /* Claim the task if there is one; bail if not. */
808 1.1 riastrad if ((task = sc->sc_chan[i].cc_task) == NULL) {
809 1.1 riastrad device_printf(sc->sc_dev, "channel %u: no task but error=%d\n",
810 1.1 riastrad i, error);
811 1.1 riastrad return;
812 1.1 riastrad }
813 1.1 riastrad sc->sc_chan[i].cc_task = NULL;
814 1.1 riastrad
815 1.1 riastrad /* Disable interrupts on this channel. */
816 1.1 riastrad icr = sun8i_crypto_read(sc, SUN8I_CRYPTO_ICR);
817 1.1 riastrad icr &= ~__SHIFTIN(SUN8I_CRYPTO_ICR_INTR_EN_CHAN(i),
818 1.1 riastrad SUN8I_CRYPTO_ICR_INTR_EN);
819 1.1 riastrad sun8i_crypto_write(sc, SUN8I_CRYPTO_ICR, icr);
820 1.1 riastrad
821 1.1 riastrad /* Finished sending the descriptor to the device by DMA. */
822 1.1 riastrad bus_dmamap_sync(sc->sc_dmat, task->ct_desc_map, 0,
823 1.1 riastrad sizeof(*task->ct_desc), BUS_DMASYNC_POSTWRITE);
824 1.1 riastrad
825 1.1 riastrad /* Temporarily release the lock to invoke the callback. */
826 1.1 riastrad mutex_exit(&sc->sc_lock);
827 1.1 riastrad (*task->ct_callback)(sc, task, task->ct_cookie, error);
828 1.1 riastrad mutex_enter(&sc->sc_lock);
829 1.1 riastrad }
830 1.1 riastrad
831 1.1 riastrad /*
832 1.1 riastrad * DMA buffers
833 1.1 riastrad */
834 1.1 riastrad
835 1.1 riastrad static int
836 1.1 riastrad sun8i_crypto_allocbuf(struct sun8i_crypto_softc *sc, size_t size,
837 1.1 riastrad struct sun8i_crypto_buf *buf)
838 1.1 riastrad {
839 1.1 riastrad int error;
840 1.1 riastrad
841 1.1 riastrad /* Allocate a DMA-safe buffer. */
842 1.1 riastrad error = bus_dmamem_alloc(sc->sc_dmat, size, 0, 0, buf->cb_seg,
843 1.1 riastrad __arraycount(buf->cb_seg), &buf->cb_nsegs, BUS_DMA_WAITOK);
844 1.1 riastrad if (error)
845 1.1 riastrad goto fail0;
846 1.1 riastrad
847 1.1 riastrad /* Map the buffer into kernel virtual address space. */
848 1.1 riastrad error = bus_dmamem_map(sc->sc_dmat, buf->cb_seg, buf->cb_nsegs,
849 1.1 riastrad size, &buf->cb_kva, BUS_DMA_WAITOK);
850 1.1 riastrad if (error)
851 1.1 riastrad goto fail1;
852 1.1 riastrad
853 1.1 riastrad /* Create a DMA map for the buffer. */
854 1.1 riastrad error = bus_dmamap_create(sc->sc_dmat, size, 1, size, 0,
855 1.1 riastrad BUS_DMA_WAITOK, &buf->cb_map);
856 1.1 riastrad if (error)
857 1.1 riastrad goto fail2;
858 1.1 riastrad
859 1.1 riastrad /* Load the buffer into the DMA map. */
860 1.1 riastrad error = bus_dmamap_load(sc->sc_dmat, buf->cb_map, buf->cb_kva, size,
861 1.1 riastrad NULL, BUS_DMA_WAITOK);
862 1.1 riastrad if (error)
863 1.1 riastrad goto fail3;
864 1.1 riastrad
865 1.1 riastrad /* Success! */
866 1.1 riastrad return 0;
867 1.1 riastrad
868 1.1 riastrad fail4: __unused
869 1.1 riastrad bus_dmamap_unload(sc->sc_dmat, buf->cb_map);
870 1.1 riastrad fail3: bus_dmamap_destroy(sc->sc_dmat, buf->cb_map);
871 1.1 riastrad fail2: bus_dmamem_unmap(sc->sc_dmat, buf->cb_kva, size);
872 1.1 riastrad fail1: bus_dmamem_free(sc->sc_dmat, buf->cb_seg, buf->cb_nsegs);
873 1.1 riastrad fail0: return error;
874 1.1 riastrad }
875 1.1 riastrad
876 1.1 riastrad static void
877 1.1 riastrad sun8i_crypto_freebuf(struct sun8i_crypto_softc *sc, size_t size,
878 1.1 riastrad struct sun8i_crypto_buf *buf)
879 1.1 riastrad {
880 1.1 riastrad
881 1.1 riastrad bus_dmamap_unload(sc->sc_dmat, buf->cb_map);
882 1.1 riastrad bus_dmamap_destroy(sc->sc_dmat, buf->cb_map);
883 1.1 riastrad bus_dmamem_unmap(sc->sc_dmat, buf->cb_kva, size);
884 1.1 riastrad bus_dmamem_free(sc->sc_dmat, buf->cb_seg, buf->cb_nsegs);
885 1.1 riastrad }
886 1.1 riastrad
887 1.1 riastrad /*
888 1.1 riastrad * Crypto Engine - TRNG
889 1.1 riastrad */
890 1.1 riastrad
891 1.1 riastrad static void
892 1.1 riastrad sun8i_crypto_rng_attach(struct sun8i_crypto_softc *sc)
893 1.1 riastrad {
894 1.1 riastrad device_t self = sc->sc_dev;
895 1.1 riastrad struct sun8i_crypto_rng *rng = &sc->sc_rng;
896 1.1 riastrad int error;
897 1.1 riastrad
898 1.1 riastrad /* Preallocate a buffer to reuse. */
899 1.1 riastrad error = sun8i_crypto_allocbuf(sc, SUN8I_CRYPTO_RNGBYTES, &rng->cr_buf);
900 1.1 riastrad if (error)
901 1.1 riastrad goto fail0;
902 1.1 riastrad
903 1.1 riastrad /* Create a task to reuse. */
904 1.1 riastrad rng->cr_task = sun8i_crypto_task_get(sc, sun8i_crypto_rng_done, rng);
905 1.1 riastrad if (rng->cr_task == NULL)
906 1.1 riastrad goto fail1;
907 1.1 riastrad
908 1.1 riastrad /*
909 1.1 riastrad * Attach the rndsource. This is _not_ marked as RND_TYPE_RNG
910 1.1 riastrad * because the output is not uniformly distributed. The bits
911 1.1 riastrad * are heavily weighted toward 0 or 1, at different times, and
912 1.1 riastrad * I haven't scienced a satisfactory story out of it yet.
913 1.1 riastrad */
914 1.1 riastrad rndsource_setcb(&rng->cr_rndsource, sun8i_crypto_rng_get, sc);
915 1.1 riastrad rnd_attach_source(&rng->cr_rndsource, device_xname(self),
916 1.1 riastrad RND_TYPE_UNKNOWN,
917 1.1 riastrad RND_FLAG_COLLECT_VALUE|RND_FLAG_ESTIMATE_VALUE|RND_FLAG_HASCB);
918 1.1 riastrad
919 1.1 riastrad /* Success! */
920 1.1 riastrad return;
921 1.1 riastrad
922 1.1 riastrad fail2: __unused
923 1.1 riastrad sun8i_crypto_task_put(sc, rng->cr_task);
924 1.1 riastrad fail1: sun8i_crypto_freebuf(sc, SUN8I_CRYPTO_RNGBYTES, &rng->cr_buf);
925 1.1 riastrad fail0: aprint_error_dev(self, "failed to set up RNG, error=%d\n", error);
926 1.1 riastrad }
927 1.1 riastrad
928 1.1 riastrad static void
929 1.1 riastrad sun8i_crypto_rng_get(size_t nbytes, void *cookie)
930 1.1 riastrad {
931 1.1 riastrad struct sun8i_crypto_softc *sc = cookie;
932 1.1 riastrad struct sun8i_crypto_rng *rng = &sc->sc_rng;
933 1.1 riastrad bool pending;
934 1.1 riastrad int error;
935 1.1 riastrad
936 1.1 riastrad /*
937 1.1 riastrad * Test and set the RNG-pending flag. If it's already in
938 1.1 riastrad * progress, nothing to do here.
939 1.1 riastrad */
940 1.1 riastrad mutex_enter(&sc->sc_lock);
941 1.1 riastrad pending = rng->cr_pending;
942 1.1 riastrad rng->cr_pending = true;
943 1.1 riastrad mutex_exit(&sc->sc_lock);
944 1.1 riastrad if (pending)
945 1.1 riastrad return;
946 1.1 riastrad
947 1.1 riastrad /* Prepare for a DMA read into the buffer. */
948 1.1 riastrad bus_dmamap_sync(sc->sc_dmat, rng->cr_buf.cb_map,
949 1.1 riastrad 0, SUN8I_CRYPTO_RNGBYTES, BUS_DMASYNC_PREREAD);
950 1.1 riastrad
951 1.1 riastrad /* Set the task up for TRNG to our buffer. */
952 1.1 riastrad sun8i_crypto_task_reset(rng->cr_task);
953 1.1 riastrad sun8i_crypto_task_set_output(rng->cr_task, rng->cr_buf.cb_map);
954 1.1 riastrad
955 1.1 riastrad /* Submit the TRNG task. */
956 1.1 riastrad error = sun8i_crypto_submit_trng(sc, rng->cr_task,
957 1.1 riastrad SUN8I_CRYPTO_RNGBYTES);
958 1.1 riastrad if (error)
959 1.1 riastrad goto fail;
960 1.1 riastrad
961 1.1 riastrad /* All done! */
962 1.1 riastrad return;
963 1.1 riastrad
964 1.1 riastrad fail: mutex_enter(&sc->sc_lock);
965 1.1 riastrad rng->cr_pending = false;
966 1.1 riastrad mutex_exit(&sc->sc_lock);
967 1.1 riastrad }
968 1.1 riastrad
969 1.1 riastrad static void
970 1.1 riastrad sun8i_crypto_rng_done(struct sun8i_crypto_softc *sc,
971 1.1 riastrad struct sun8i_crypto_task *task, void *cookie, int error)
972 1.1 riastrad {
973 1.1 riastrad struct sun8i_crypto_rng *rng = cookie;
974 1.1 riastrad uint8_t *buf = rng->cr_buf.cb_kva;
975 1.1 riastrad uint32_t entropybits;
976 1.1 riastrad
977 1.1 riastrad KASSERT(rng == &sc->sc_rng);
978 1.1 riastrad
979 1.1 riastrad /* Finished the DMA read into the buffer. */
980 1.1 riastrad bus_dmamap_sync(sc->sc_dmat, rng->cr_buf.cb_map,
981 1.1 riastrad 0, SUN8I_CRYPTO_RNGBYTES, BUS_DMASYNC_POSTREAD);
982 1.1 riastrad
983 1.1 riastrad /* If anything went wrong, forget about it. */
984 1.1 riastrad if (error)
985 1.1 riastrad goto out;
986 1.1 riastrad
987 1.1 riastrad /*
988 1.1 riastrad * This TRNG has quite low entropy at best. But if it fails a
989 1.1 riastrad * repeated output test, then assume it's busted.
990 1.1 riastrad */
991 1.1 riastrad CTASSERT((SUN8I_CRYPTO_RNGBYTES % SUN8I_CRYPTO_RNGENTROPY) == 0);
992 1.1 riastrad entropybits = NBBY * (SUN8I_CRYPTO_RNGBYTES/SUN8I_CRYPTO_RNGENTROPY);
993 1.1 riastrad if (consttime_memequal(buf, buf + SUN8I_CRYPTO_RNGBYTES/2,
994 1.1 riastrad SUN8I_CRYPTO_RNGBYTES/2)) {
995 1.1 riastrad device_printf(sc->sc_dev, "failed repeated output test\n");
996 1.1 riastrad entropybits = 0;
997 1.1 riastrad }
998 1.1 riastrad
999 1.1 riastrad /* Success! Enter and erase the data. */
1000 1.1 riastrad rnd_add_data(&rng->cr_rndsource, buf, SUN8I_CRYPTO_RNGBYTES,
1001 1.1 riastrad entropybits);
1002 1.1 riastrad explicit_memset(buf, 0, SUN8I_CRYPTO_RNGBYTES);
1003 1.1 riastrad
1004 1.1 riastrad out: /* Done -- clear the RNG-pending flag. */
1005 1.1 riastrad mutex_enter(&sc->sc_lock);
1006 1.1 riastrad rng->cr_pending = false;
1007 1.1 riastrad mutex_exit(&sc->sc_lock);
1008 1.1 riastrad }
1009 1.1 riastrad
1010 1.1 riastrad /*
1011 1.1 riastrad * Self-test
1012 1.1 riastrad */
1013 1.1 riastrad
1014 1.1 riastrad static uint8_t selftest_input[16];
1015 1.1 riastrad static uint8_t selftest_key[16];
1016 1.1 riastrad static uint8_t selftest_output[16] = {
1017 1.1 riastrad 0x66,0xe9,0x4b,0xd4,0xef,0x8a,0x2c,0x3b,
1018 1.1 riastrad 0x88,0x4c,0xfa,0x59,0xca,0x34,0x2b,0x2e,
1019 1.1 riastrad };
1020 1.1 riastrad
1021 1.1 riastrad static void
1022 1.1 riastrad sun8i_crypto_selftest(device_t self)
1023 1.1 riastrad {
1024 1.1 riastrad const size_t datalen = sizeof selftest_input;
1025 1.1 riastrad struct sun8i_crypto_softc *sc = device_private(self);
1026 1.1 riastrad struct sun8i_crypto_selftest *selftest = &sc->sc_selftest;
1027 1.1 riastrad int error;
1028 1.1 riastrad
1029 1.1 riastrad CTASSERT(sizeof selftest_input == sizeof selftest_output);
1030 1.1 riastrad
1031 1.1 riastrad /* Allocate an input buffer. */
1032 1.1 riastrad error = sun8i_crypto_allocbuf(sc, sizeof selftest_input,
1033 1.1 riastrad &selftest->cs_in);
1034 1.1 riastrad if (error)
1035 1.1 riastrad goto fail0;
1036 1.1 riastrad
1037 1.1 riastrad /* Allocate a key buffer. */
1038 1.1 riastrad error = sun8i_crypto_allocbuf(sc, sizeof selftest_key,
1039 1.1 riastrad &selftest->cs_key);
1040 1.1 riastrad if (error)
1041 1.1 riastrad goto fail1;
1042 1.1 riastrad
1043 1.1 riastrad /* Allocate an output buffer. */
1044 1.1 riastrad error = sun8i_crypto_allocbuf(sc, sizeof selftest_output,
1045 1.1 riastrad &selftest->cs_out);
1046 1.1 riastrad if (error)
1047 1.1 riastrad goto fail2;
1048 1.1 riastrad
1049 1.1 riastrad /* Allocate a task descriptor. */
1050 1.1 riastrad selftest->cs_task = sun8i_crypto_task_get(sc,
1051 1.1 riastrad sun8i_crypto_selftest_done, selftest);
1052 1.1 riastrad if (selftest->cs_task == NULL)
1053 1.1 riastrad goto fail3;
1054 1.1 riastrad
1055 1.1 riastrad /* Copy the input and key into their buffers. */
1056 1.1 riastrad memcpy(selftest->cs_in.cb_kva, selftest_input, sizeof selftest_input);
1057 1.1 riastrad memcpy(selftest->cs_key.cb_kva, selftest_key, sizeof selftest_key);
1058 1.1 riastrad
1059 1.1 riastrad /* Prepare for a DMA write from the input and key buffers. */
1060 1.1 riastrad bus_dmamap_sync(sc->sc_dmat, selftest->cs_in.cb_map, 0,
1061 1.1 riastrad sizeof selftest_input, BUS_DMASYNC_PREWRITE);
1062 1.1 riastrad bus_dmamap_sync(sc->sc_dmat, selftest->cs_key.cb_map, 0,
1063 1.1 riastrad sizeof selftest_key, BUS_DMASYNC_PREWRITE);
1064 1.1 riastrad
1065 1.1 riastrad /* Prepare for a DMA read into the output buffer. */
1066 1.1 riastrad bus_dmamap_sync(sc->sc_dmat, selftest->cs_out.cb_map, 0,
1067 1.1 riastrad sizeof selftest_output, BUS_DMASYNC_PREREAD);
1068 1.1 riastrad
1069 1.1 riastrad /* Set up the task descriptor. */
1070 1.1 riastrad sun8i_crypto_task_reset(selftest->cs_task);
1071 1.1 riastrad sun8i_crypto_task_set_key(selftest->cs_task, selftest->cs_key.cb_map);
1072 1.1 riastrad sun8i_crypto_task_set_input(selftest->cs_task, selftest->cs_in.cb_map);
1073 1.1 riastrad sun8i_crypto_task_set_output(selftest->cs_task,
1074 1.1 riastrad selftest->cs_out.cb_map);
1075 1.1 riastrad
1076 1.1 riastrad /* Submit the AES-128 ECB task. */
1077 1.1 riastrad error = sun8i_crypto_submit_aesecb(sc, selftest->cs_task, datalen,
1078 1.1 riastrad SUN8I_CRYPTO_TDQS_AES_KEYSIZE_128, SUN8I_CRYPTO_TDQC_OP_DIR_ENC);
1079 1.1 riastrad if (error)
1080 1.1 riastrad goto fail4;
1081 1.1 riastrad
1082 1.1 riastrad device_printf(sc->sc_dev, "AES-128 self-test initiated\n");
1083 1.1 riastrad
1084 1.1 riastrad /* Success! */
1085 1.1 riastrad return;
1086 1.1 riastrad
1087 1.1 riastrad fail4: sun8i_crypto_task_put(sc, selftest->cs_task);
1088 1.1 riastrad fail3: sun8i_crypto_freebuf(sc, sizeof selftest_output, &selftest->cs_out);
1089 1.1 riastrad fail2: sun8i_crypto_freebuf(sc, sizeof selftest_key, &selftest->cs_key);
1090 1.1 riastrad fail1: sun8i_crypto_freebuf(sc, sizeof selftest_input, &selftest->cs_in);
1091 1.1 riastrad fail0: aprint_error_dev(self, "failed to run self-test, error=%d\n", error);
1092 1.1 riastrad }
1093 1.1 riastrad
1094 1.1 riastrad static void
1095 1.1 riastrad sun8i_crypto_selftest_done(struct sun8i_crypto_softc *sc,
1096 1.1 riastrad struct sun8i_crypto_task *task, void *cookie, int error)
1097 1.1 riastrad {
1098 1.1 riastrad struct sun8i_crypto_selftest *selftest = cookie;
1099 1.1 riastrad unsigned i;
1100 1.1 riastrad bool ok = true;
1101 1.1 riastrad
1102 1.1 riastrad KASSERT(selftest == &sc->sc_selftest);
1103 1.1 riastrad
1104 1.1 riastrad bus_dmamap_sync(sc->sc_dmat, selftest->cs_out.cb_map, 0,
1105 1.1 riastrad sizeof selftest_output, BUS_DMASYNC_POSTREAD);
1106 1.1 riastrad bus_dmamap_sync(sc->sc_dmat, selftest->cs_in.cb_map, 0,
1107 1.1 riastrad sizeof selftest_input, BUS_DMASYNC_POSTWRITE);
1108 1.1 riastrad
1109 1.1 riastrad if (error) {
1110 1.1 riastrad device_printf(sc->sc_dev, "self-test error=%d\n", error);
1111 1.1 riastrad goto out;
1112 1.1 riastrad }
1113 1.1 riastrad
1114 1.1 riastrad if (memcmp(selftest_input, selftest->cs_in.cb_kva,
1115 1.1 riastrad sizeof selftest_input) != 0) {
1116 1.1 riastrad device_printf(sc->sc_dev, "self-test: input clobbered\n");
1117 1.1 riastrad printf("expected: ");
1118 1.1 riastrad for (i = 0; i < sizeof selftest_input; i++)
1119 1.1 riastrad printf("%02hhx", selftest_input[i]);
1120 1.1 riastrad printf("\n");
1121 1.1 riastrad printf("actual: ");
1122 1.1 riastrad for (i = 0; i < sizeof selftest_input; i++)
1123 1.1 riastrad printf("%02hhx",
1124 1.1 riastrad ((const uint8_t *)selftest->cs_in.cb_kva)[i]);
1125 1.1 riastrad printf("\n");
1126 1.1 riastrad ok = false;
1127 1.1 riastrad }
1128 1.1 riastrad
1129 1.1 riastrad if (memcmp(selftest_key, selftest->cs_key.cb_kva,
1130 1.1 riastrad sizeof selftest_key) != 0) {
1131 1.1 riastrad device_printf(sc->sc_dev, "self-test: key clobbered\n");
1132 1.1 riastrad printf("expected: ");
1133 1.1 riastrad for (i = 0; i < sizeof selftest_key; i++)
1134 1.1 riastrad printf("%02hhx", selftest_key[i]);
1135 1.1 riastrad printf("\n");
1136 1.1 riastrad printf("actual: ");
1137 1.1 riastrad for (i = 0; i < sizeof selftest_key; i++)
1138 1.1 riastrad printf("%02hhx",
1139 1.1 riastrad ((const uint8_t *)selftest->cs_key.cb_kva)[i]);
1140 1.1 riastrad printf("\n");
1141 1.1 riastrad ok = false;
1142 1.1 riastrad }
1143 1.1 riastrad
1144 1.1 riastrad if (memcmp(selftest_output, selftest->cs_out.cb_kva,
1145 1.1 riastrad sizeof selftest_output) != 0) {
1146 1.1 riastrad device_printf(sc->sc_dev, "self-test: output mismatch\n");
1147 1.1 riastrad printf("expected: ");
1148 1.1 riastrad for (i = 0; i < sizeof selftest_output; i++)
1149 1.1 riastrad printf("%02hhx", selftest_output[i]);
1150 1.1 riastrad printf("\n");
1151 1.1 riastrad printf("actual: ");
1152 1.1 riastrad for (i = 0; i < sizeof selftest_output; i++)
1153 1.1 riastrad printf("%02hhx",
1154 1.1 riastrad ((const uint8_t *)selftest->cs_out.cb_kva)[i]);
1155 1.1 riastrad printf("\n");
1156 1.1 riastrad ok = false;
1157 1.1 riastrad }
1158 1.1 riastrad
1159 1.1 riastrad /* XXX Disable the RNG and other stuff if this fails... */
1160 1.1 riastrad if (ok)
1161 1.1 riastrad device_printf(sc->sc_dev, "AES-128 self-test passed\n");
1162 1.1 riastrad
1163 1.1 riastrad out: sun8i_crypto_task_put(sc, task);
1164 1.1 riastrad sun8i_crypto_freebuf(sc, sizeof selftest_output, &selftest->cs_out);
1165 1.1 riastrad sun8i_crypto_freebuf(sc, sizeof selftest_key, &selftest->cs_key);
1166 1.1 riastrad sun8i_crypto_freebuf(sc, sizeof selftest_input, &selftest->cs_in);
1167 1.1 riastrad }
1168 1.1 riastrad
1169 1.1 riastrad /*
1170 1.1 riastrad * Sysctl for testing
1171 1.1 riastrad */
1172 1.1 riastrad
1173 1.1 riastrad struct sun8i_crypto_userreq {
1174 1.1 riastrad kmutex_t cu_lock;
1175 1.1 riastrad kcondvar_t cu_cv;
1176 1.1 riastrad size_t cu_size;
1177 1.1 riastrad struct sun8i_crypto_buf cu_buf;
1178 1.1 riastrad struct sun8i_crypto_task *cu_task;
1179 1.1 riastrad int cu_error;
1180 1.1 riastrad bool cu_done;
1181 1.1 riastrad bool cu_cancel;
1182 1.1 riastrad };
1183 1.1 riastrad
1184 1.1 riastrad static void
1185 1.1 riastrad sun8i_crypto_sysctl_attach(struct sun8i_crypto_softc *sc)
1186 1.1 riastrad {
1187 1.1 riastrad struct sun8i_crypto_sysctl *cy = &sc->sc_sysctl;
1188 1.1 riastrad int error;
1189 1.1 riastrad
1190 1.1 riastrad error = sysctl_createv(&cy->cy_log, 0, NULL, &cy->cy_root_node,
1191 1.1 riastrad CTLFLAG_PERMANENT, CTLTYPE_NODE, device_xname(sc->sc_dev),
1192 1.1 riastrad SYSCTL_DESCR("sun8i crypto engine knobs"),
1193 1.1 riastrad NULL, 0, NULL, 0,
1194 1.1 riastrad CTL_HW, CTL_CREATE, CTL_EOL);
1195 1.1 riastrad if (error) {
1196 1.1 riastrad aprint_error_dev(sc->sc_dev,
1197 1.1 riastrad "failed to set up sysctl hw.%s: %d\n",
1198 1.1 riastrad device_xname(sc->sc_dev), error);
1199 1.1 riastrad return;
1200 1.1 riastrad }
1201 1.1 riastrad
1202 1.1 riastrad sysctl_createv(&cy->cy_log, 0, &cy->cy_root_node, NULL,
1203 1.1 riastrad CTLFLAG_PERMANENT|CTLFLAG_READONLY|CTLFLAG_PRIVATE, CTLTYPE_STRUCT,
1204 1.1 riastrad "rng", SYSCTL_DESCR("Read up to 1024 bytes out of the TRNG"),
1205 1.1 riastrad &sun8i_crypto_sysctl_rng, 0, sc, 0, CTL_CREATE, CTL_EOL);
1206 1.1 riastrad if (error) {
1207 1.1 riastrad aprint_error_dev(sc->sc_dev,
1208 1.1 riastrad "failed to set up sysctl hw.%s.rng: %d\n",
1209 1.1 riastrad device_xname(sc->sc_dev), error);
1210 1.1 riastrad return;
1211 1.1 riastrad }
1212 1.1 riastrad }
1213 1.1 riastrad
1214 1.1 riastrad static int
1215 1.1 riastrad sun8i_crypto_sysctl_rng(SYSCTLFN_ARGS)
1216 1.1 riastrad {
1217 1.1 riastrad struct sysctlnode node = *rnode;
1218 1.1 riastrad struct sun8i_crypto_softc *sc = node.sysctl_data;
1219 1.1 riastrad struct sun8i_crypto_userreq *req;
1220 1.1 riastrad size_t size;
1221 1.1 riastrad int error;
1222 1.1 riastrad
1223 1.1 riastrad /* If oldp == NULL, the caller wants to learn the size. */
1224 1.1 riastrad if (oldp == NULL) {
1225 1.1 riastrad *oldlenp = 1024;
1226 1.1 riastrad return 0;
1227 1.1 riastrad }
1228 1.1 riastrad
1229 1.1 riastrad /* Verify the output buffer size is reasonable. */
1230 1.1 riastrad size = *oldlenp;
1231 1.1 riastrad if (size > 1024) /* size_t, so never negative */
1232 1.1 riastrad return E2BIG;
1233 1.1 riastrad if (size == 0)
1234 1.1 riastrad return 0; /* nothing to do */
1235 1.1 riastrad
1236 1.1 riastrad /* Allocate a request context. */
1237 1.1 riastrad req = kmem_alloc(sizeof(*req), KM_NOSLEEP);
1238 1.1 riastrad if (req == NULL)
1239 1.1 riastrad return ENOMEM;
1240 1.1 riastrad
1241 1.1 riastrad /* Initialize the request context. */
1242 1.1 riastrad mutex_init(&req->cu_lock, MUTEX_DEFAULT, IPL_NONE);
1243 1.1 riastrad cv_init(&req->cu_cv, "sun8isy");
1244 1.1 riastrad req->cu_size = size;
1245 1.1 riastrad req->cu_error = EIO;
1246 1.1 riastrad req->cu_done = false;
1247 1.1 riastrad req->cu_cancel = false;
1248 1.1 riastrad
1249 1.1 riastrad /* Allocate a buffer for the RNG output. */
1250 1.1 riastrad error = sun8i_crypto_allocbuf(sc, size, &req->cu_buf);
1251 1.1 riastrad if (error)
1252 1.1 riastrad goto out0;
1253 1.1 riastrad
1254 1.1 riastrad /* Allocate a task. */
1255 1.1 riastrad req->cu_task = sun8i_crypto_task_get(sc, sun8i_crypto_sysctl_rng_done,
1256 1.1 riastrad req);
1257 1.1 riastrad if (req->cu_task == NULL)
1258 1.1 riastrad goto out1;
1259 1.1 riastrad
1260 1.1 riastrad /* Prepare for a DMA read into the buffer. */
1261 1.1 riastrad bus_dmamap_sync(sc->sc_dmat, req->cu_buf.cb_map, 0, size,
1262 1.1 riastrad BUS_DMASYNC_PREREAD);
1263 1.1 riastrad
1264 1.1 riastrad /* Set the task up for TRNG to our buffer. */
1265 1.1 riastrad sun8i_crypto_task_reset(req->cu_task);
1266 1.1 riastrad sun8i_crypto_task_set_output(req->cu_task, req->cu_buf.cb_map);
1267 1.1 riastrad
1268 1.1 riastrad /* Submit the TRNG task. */
1269 1.1 riastrad error = sun8i_crypto_submit_trng(sc, req->cu_task, size);
1270 1.1 riastrad if (error)
1271 1.1 riastrad goto out2;
1272 1.1 riastrad
1273 1.1 riastrad /* Wait for the request to complete. */
1274 1.1 riastrad mutex_enter(&req->cu_lock);
1275 1.1 riastrad while (!req->cu_done) {
1276 1.1 riastrad error = cv_wait_sig(&req->cu_cv, &req->cu_lock);
1277 1.1 riastrad if (error) {
1278 1.1 riastrad /*
1279 1.1 riastrad * Never mind -- notify the callback that it
1280 1.1 riastrad * has to clean up after itself.
1281 1.1 riastrad */
1282 1.1 riastrad req->cu_cancel = true;
1283 1.1 riastrad break;
1284 1.1 riastrad }
1285 1.1 riastrad }
1286 1.1 riastrad mutex_exit(&req->cu_lock);
1287 1.1 riastrad
1288 1.1 riastrad /*
1289 1.1 riastrad * Return early on error from cv_wait_sig, which means
1290 1.1 riastrad * interruption; the callback will clean up instead.
1291 1.1 riastrad */
1292 1.1 riastrad if (error)
1293 1.1 riastrad return error;
1294 1.1 riastrad
1295 1.1 riastrad /* Check for error from the device. */
1296 1.1 riastrad error = req->cu_error;
1297 1.1 riastrad if (error)
1298 1.1 riastrad goto out2;
1299 1.1 riastrad
1300 1.1 riastrad /* Finished the DMA read into the buffer. */
1301 1.1 riastrad bus_dmamap_sync(sc->sc_dmat, req->cu_buf.cb_map, 0, req->cu_size,
1302 1.1 riastrad BUS_DMASYNC_POSTREAD);
1303 1.1 riastrad
1304 1.1 riastrad /* Copy out the data. */
1305 1.1 riastrad node.sysctl_data = req->cu_buf.cb_kva;
1306 1.1 riastrad node.sysctl_size = size;
1307 1.1 riastrad error = sysctl_lookup(SYSCTLFN_CALL(&node));
1308 1.1 riastrad
1309 1.1 riastrad /* Clear the buffer. */
1310 1.1 riastrad explicit_memset(req->cu_buf.cb_kva, 0, size);
1311 1.1 riastrad
1312 1.1 riastrad out2: sun8i_crypto_task_put(sc, req->cu_task);
1313 1.1 riastrad out1: sun8i_crypto_freebuf(sc, req->cu_size, &req->cu_buf);
1314 1.1 riastrad out0: cv_destroy(&req->cu_cv);
1315 1.1 riastrad mutex_destroy(&req->cu_lock);
1316 1.1 riastrad return error;
1317 1.1 riastrad }
1318 1.1 riastrad
1319 1.1 riastrad static void
1320 1.1 riastrad sun8i_crypto_sysctl_rng_done(struct sun8i_crypto_softc *sc,
1321 1.1 riastrad struct sun8i_crypto_task *task, void *cookie, int error)
1322 1.1 riastrad {
1323 1.1 riastrad struct sun8i_crypto_userreq *req = cookie;
1324 1.1 riastrad bool cancel;
1325 1.1 riastrad
1326 1.1 riastrad /*
1327 1.1 riastrad * Notify the waiting thread of the error, and find out whether
1328 1.1 riastrad * that thread cancelled.
1329 1.1 riastrad */
1330 1.1 riastrad mutex_enter(&req->cu_lock);
1331 1.1 riastrad cancel = req->cu_cancel;
1332 1.1 riastrad req->cu_error = error;
1333 1.1 riastrad req->cu_done = true;
1334 1.1 riastrad cv_broadcast(&req->cu_cv);
1335 1.1 riastrad mutex_exit(&req->cu_lock);
1336 1.1 riastrad
1337 1.1 riastrad /*
1338 1.1 riastrad * If it wasn't cancelled, we're done -- the main thread will
1339 1.1 riastrad * clean up after itself.
1340 1.1 riastrad */
1341 1.1 riastrad if (!cancel)
1342 1.1 riastrad return;
1343 1.1 riastrad
1344 1.1 riastrad /* Clean up. */
1345 1.1 riastrad sun8i_crypto_task_put(sc, req->cu_task);
1346 1.1 riastrad sun8i_crypto_freebuf(sc, req->cu_size, &req->cu_buf);
1347 1.1 riastrad cv_destroy(&req->cu_cv);
1348 1.1 riastrad mutex_destroy(&req->cu_lock);
1349 1.1 riastrad }
1350