1160582Spjd/*- 2160582Spjd * Copyright (c) 2005-2006 Pawel Jakub Dawidek <pjd@FreeBSD.org> 3160582Spjd * Copyright (c) 2004 Mark R V Murray 4160582Spjd * All rights reserved. 5160582Spjd * 6160582Spjd * Redistribution and use in source and binary forms, with or without 7160582Spjd * modification, are permitted provided that the following conditions 8160582Spjd * are met: 9160582Spjd * 1. Redistributions of source code must retain the above copyright 10160582Spjd * notice, this list of conditions and the following disclaimer. 11160582Spjd * 2. Redistributions in binary form must reproduce the above copyright 12160582Spjd * notice, this list of conditions and the following disclaimer in the 13160582Spjd * documentation and/or other materials provided with the distribution. 14160674Spjd * 15160582Spjd * THIS SOFTWARE IS PROVIDED BY THE AUTHORS AND CONTRIBUTORS ``AS IS'' AND 16160582Spjd * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE 17160582Spjd * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE 18160582Spjd * ARE DISCLAIMED. IN NO EVENT SHALL THE AUTHORS OR CONTRIBUTORS BE LIABLE 19160582Spjd * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL 20160582Spjd * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS 21160582Spjd * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) 22160582Spjd * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT 23160582Spjd * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY 24160582Spjd * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF 25160582Spjd * SUCH DAMAGE. 26160582Spjd */ 27160582Spjd 28160582Spjd/* $OpenBSD: via.c,v 1.3 2004/06/15 23:36:55 deraadt Exp $ */ 29160582Spjd/*- 30160582Spjd * Copyright (c) 2003 Jason Wright 31160582Spjd * Copyright (c) 2003, 2004 Theo de Raadt 32160582Spjd * All rights reserved. 33160582Spjd * 34160582Spjd * Permission to use, copy, modify, and distribute this software for any 35160582Spjd * purpose with or without fee is hereby granted, provided that the above 36160582Spjd * copyright notice and this permission notice appear in all copies. 37160582Spjd * 38160582Spjd * THE SOFTWARE IS PROVIDED "AS IS" AND THE AUTHOR DISCLAIMS ALL WARRANTIES 39160582Spjd * WITH REGARD TO THIS SOFTWARE INCLUDING ALL IMPLIED WARRANTIES OF 40160582Spjd * MERCHANTABILITY AND FITNESS. IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR 41160582Spjd * ANY SPECIAL, DIRECT, INDIRECT, OR CONSEQUENTIAL DAMAGES OR ANY DAMAGES 42160582Spjd * WHATSOEVER RESULTING FROM LOSS OF USE, DATA OR PROFITS, WHETHER IN AN 43160582Spjd * ACTION OF CONTRACT, NEGLIGENCE OR OTHER TORTIOUS ACTION, ARISING OUT OF 44160582Spjd * OR IN CONNECTION WITH THE USE OR PERFORMANCE OF THIS SOFTWARE. 45160582Spjd */ 46160582Spjd 47160582Spjd#include <sys/cdefs.h> 48160582Spjd__FBSDID("$FreeBSD$"); 49160582Spjd 50160582Spjd#include <sys/param.h> 51160582Spjd#include <sys/systm.h> 52160582Spjd#include <sys/kernel.h> 53160582Spjd#include <sys/module.h> 54160582Spjd#include <sys/malloc.h> 55160582Spjd#include <sys/libkern.h> 56208834Skib#include <sys/pcpu.h> 57160676Spjd#include <sys/uio.h> 58160582Spjd 59160582Spjd#include <opencrypto/cryptodev.h> 60160582Spjd#include <crypto/rijndael/rijndael.h> 61160582Spjd 62160582Spjd#include <crypto/via/padlock.h> 63160582Spjd 64160582Spjd#define PADLOCK_ROUND_COUNT_AES128 10 65160582Spjd#define PADLOCK_ROUND_COUNT_AES192 12 66160582Spjd#define PADLOCK_ROUND_COUNT_AES256 14 67160582Spjd 68160582Spjd#define PADLOCK_ALGORITHM_TYPE_AES 0 69160582Spjd 70160582Spjd#define PADLOCK_KEY_GENERATION_HW 0 71160582Spjd#define PADLOCK_KEY_GENERATION_SW 1 72160582Spjd 73160582Spjd#define PADLOCK_DIRECTION_ENCRYPT 0 74160582Spjd#define PADLOCK_DIRECTION_DECRYPT 1 75160582Spjd 76160582Spjd#define PADLOCK_KEY_SIZE_128 0 77160582Spjd#define PADLOCK_KEY_SIZE_192 1 78160582Spjd#define PADLOCK_KEY_SIZE_256 2 79160582Spjd 80160582SpjdMALLOC_DECLARE(M_PADLOCK); 81160582Spjd 82160582Spjdstatic __inline void 83160582Spjdpadlock_cbc(void *in, void *out, size_t count, void *key, union padlock_cw *cw, 84160582Spjd void *iv) 85160582Spjd{ 86160582Spjd#ifdef __GNUCLIKE_ASM 87160582Spjd /* The .byte line is really VIA C3 "xcrypt-cbc" instruction */ 88160582Spjd __asm __volatile( 89160582Spjd "pushf \n\t" 90160582Spjd "popf \n\t" 91160582Spjd "rep \n\t" 92160582Spjd ".byte 0x0f, 0xa7, 0xd0" 93160582Spjd : "+a" (iv), "+c" (count), "+D" (out), "+S" (in) 94160582Spjd : "b" (key), "d" (cw) 95160582Spjd : "cc", "memory" 96160582Spjd ); 97160582Spjd#endif 98160582Spjd} 99160582Spjd 100160582Spjdstatic void 101160582Spjdpadlock_cipher_key_setup(struct padlock_session *ses, caddr_t key, int klen) 102160582Spjd{ 103160582Spjd union padlock_cw *cw; 104160582Spjd int i; 105160582Spjd 106160582Spjd cw = &ses->ses_cw; 107160582Spjd if (cw->cw_key_generation == PADLOCK_KEY_GENERATION_SW) { 108160582Spjd /* Build expanded keys for both directions */ 109160582Spjd rijndaelKeySetupEnc(ses->ses_ekey, key, klen); 110160582Spjd rijndaelKeySetupDec(ses->ses_dkey, key, klen); 111160582Spjd for (i = 0; i < 4 * (RIJNDAEL_MAXNR + 1); i++) { 112160582Spjd ses->ses_ekey[i] = ntohl(ses->ses_ekey[i]); 113160582Spjd ses->ses_dkey[i] = ntohl(ses->ses_dkey[i]); 114160582Spjd } 115160582Spjd } else { 116160582Spjd bcopy(key, ses->ses_ekey, klen); 117160582Spjd bcopy(key, ses->ses_dkey, klen); 118160582Spjd } 119160582Spjd} 120160582Spjd 121160582Spjdint 122160582Spjdpadlock_cipher_setup(struct padlock_session *ses, struct cryptoini *encini) 123160582Spjd{ 124160582Spjd union padlock_cw *cw; 125160582Spjd 126160582Spjd if (encini->cri_klen != 128 && encini->cri_klen != 192 && 127160582Spjd encini->cri_klen != 256) { 128160582Spjd return (EINVAL); 129160582Spjd } 130160582Spjd 131160582Spjd cw = &ses->ses_cw; 132160582Spjd bzero(cw, sizeof(*cw)); 133160582Spjd cw->cw_algorithm_type = PADLOCK_ALGORITHM_TYPE_AES; 134160582Spjd cw->cw_key_generation = PADLOCK_KEY_GENERATION_SW; 135160582Spjd cw->cw_intermediate = 0; 136160582Spjd switch (encini->cri_klen) { 137160582Spjd case 128: 138160582Spjd cw->cw_round_count = PADLOCK_ROUND_COUNT_AES128; 139160582Spjd cw->cw_key_size = PADLOCK_KEY_SIZE_128; 140160582Spjd#ifdef HW_KEY_GENERATION 141160582Spjd /* This doesn't buy us much, that's why it is commented out. */ 142160582Spjd cw->cw_key_generation = PADLOCK_KEY_GENERATION_HW; 143160582Spjd#endif 144160582Spjd break; 145160582Spjd case 192: 146160582Spjd cw->cw_round_count = PADLOCK_ROUND_COUNT_AES192; 147160582Spjd cw->cw_key_size = PADLOCK_KEY_SIZE_192; 148160582Spjd break; 149160582Spjd case 256: 150160582Spjd cw->cw_round_count = PADLOCK_ROUND_COUNT_AES256; 151160582Spjd cw->cw_key_size = PADLOCK_KEY_SIZE_256; 152160582Spjd break; 153160582Spjd } 154160582Spjd if (encini->cri_key != NULL) { 155160582Spjd padlock_cipher_key_setup(ses, encini->cri_key, 156160582Spjd encini->cri_klen); 157160582Spjd } 158160582Spjd 159160582Spjd arc4rand(ses->ses_iv, sizeof(ses->ses_iv), 0); 160160582Spjd return (0); 161160582Spjd} 162160582Spjd 163160676Spjd/* 164160676Spjd * Function checks if the given buffer is already 16 bytes aligned. 165160676Spjd * If it is there is no need to allocate new buffer. 166160676Spjd * If it isn't, new buffer is allocated. 167160676Spjd */ 168160676Spjdstatic u_char * 169160676Spjdpadlock_cipher_alloc(struct cryptodesc *enccrd, struct cryptop *crp, 170160676Spjd int *allocated) 171160676Spjd{ 172160676Spjd u_char *addr; 173160676Spjd 174160676Spjd if (crp->crp_flags & CRYPTO_F_IMBUF) 175160676Spjd goto alloc; 176160676Spjd else { 177160676Spjd if (crp->crp_flags & CRYPTO_F_IOV) { 178160676Spjd struct uio *uio; 179160676Spjd struct iovec *iov; 180160676Spjd 181160676Spjd uio = (struct uio *)crp->crp_buf; 182160676Spjd if (uio->uio_iovcnt != 1) 183160676Spjd goto alloc; 184160676Spjd iov = uio->uio_iov; 185160676Spjd addr = (u_char *)iov->iov_base + enccrd->crd_skip; 186160676Spjd } else { 187160676Spjd addr = (u_char *)crp->crp_buf; 188160676Spjd } 189160676Spjd if (((uintptr_t)addr & 0xf) != 0) /* 16 bytes aligned? */ 190160676Spjd goto alloc; 191160676Spjd *allocated = 0; 192160676Spjd return (addr); 193160676Spjd } 194160676Spjdalloc: 195160676Spjd *allocated = 1; 196160676Spjd addr = malloc(enccrd->crd_len + 16, M_PADLOCK, M_NOWAIT); 197160676Spjd return (addr); 198160676Spjd} 199160676Spjd 200160582Spjdint 201160582Spjdpadlock_cipher_process(struct padlock_session *ses, struct cryptodesc *enccrd, 202160582Spjd struct cryptop *crp) 203160582Spjd{ 204160582Spjd union padlock_cw *cw; 205208834Skib struct thread *td; 206160582Spjd u_char *buf, *abuf; 207160582Spjd uint32_t *key; 208268033Skib int allocated, error; 209160582Spjd 210160676Spjd buf = padlock_cipher_alloc(enccrd, crp, &allocated); 211160582Spjd if (buf == NULL) 212160582Spjd return (ENOMEM); 213160582Spjd /* Buffer has to be 16 bytes aligned. */ 214160582Spjd abuf = PADLOCK_ALIGN(buf); 215160582Spjd 216160582Spjd if ((enccrd->crd_flags & CRD_F_KEY_EXPLICIT) != 0) { 217160582Spjd padlock_cipher_key_setup(ses, enccrd->crd_key, 218160582Spjd enccrd->crd_klen); 219160582Spjd } 220160582Spjd 221160582Spjd cw = &ses->ses_cw; 222160582Spjd cw->cw_filler0 = 0; 223160582Spjd cw->cw_filler1 = 0; 224160582Spjd cw->cw_filler2 = 0; 225160582Spjd cw->cw_filler3 = 0; 226160582Spjd if ((enccrd->crd_flags & CRD_F_ENCRYPT) != 0) { 227160582Spjd cw->cw_direction = PADLOCK_DIRECTION_ENCRYPT; 228160582Spjd key = ses->ses_ekey; 229160582Spjd if ((enccrd->crd_flags & CRD_F_IV_EXPLICIT) != 0) 230162316Spjd bcopy(enccrd->crd_iv, ses->ses_iv, AES_BLOCK_LEN); 231160582Spjd 232160582Spjd if ((enccrd->crd_flags & CRD_F_IV_PRESENT) == 0) { 233160582Spjd crypto_copyback(crp->crp_flags, crp->crp_buf, 234160582Spjd enccrd->crd_inject, AES_BLOCK_LEN, ses->ses_iv); 235160582Spjd } 236160582Spjd } else { 237160582Spjd cw->cw_direction = PADLOCK_DIRECTION_DECRYPT; 238160582Spjd key = ses->ses_dkey; 239160582Spjd if ((enccrd->crd_flags & CRD_F_IV_EXPLICIT) != 0) 240160582Spjd bcopy(enccrd->crd_iv, ses->ses_iv, AES_BLOCK_LEN); 241160582Spjd else { 242160582Spjd crypto_copydata(crp->crp_flags, crp->crp_buf, 243160582Spjd enccrd->crd_inject, AES_BLOCK_LEN, ses->ses_iv); 244160582Spjd } 245160582Spjd } 246160582Spjd 247160676Spjd if (allocated) { 248160676Spjd crypto_copydata(crp->crp_flags, crp->crp_buf, enccrd->crd_skip, 249160676Spjd enccrd->crd_len, abuf); 250160676Spjd } 251160582Spjd 252208834Skib td = curthread; 253268033Skib error = fpu_kern_enter(td, ses->ses_fpu_ctx, FPU_KERN_NORMAL | 254268033Skib FPU_KERN_KTHR); 255208834Skib if (error != 0) 256208834Skib goto out; 257162316Spjd padlock_cbc(abuf, abuf, enccrd->crd_len / AES_BLOCK_LEN, key, cw, 258162316Spjd ses->ses_iv); 259268033Skib fpu_kern_leave(td, ses->ses_fpu_ctx); 260160582Spjd 261160676Spjd if (allocated) { 262160676Spjd crypto_copyback(crp->crp_flags, crp->crp_buf, enccrd->crd_skip, 263160676Spjd enccrd->crd_len, abuf); 264160676Spjd } 265160582Spjd 266160582Spjd /* copy out last block for use as next session IV */ 267160582Spjd if ((enccrd->crd_flags & CRD_F_ENCRYPT) != 0) { 268160582Spjd crypto_copydata(crp->crp_flags, crp->crp_buf, 269160582Spjd enccrd->crd_skip + enccrd->crd_len - AES_BLOCK_LEN, 270160582Spjd AES_BLOCK_LEN, ses->ses_iv); 271160582Spjd } 272160582Spjd 273208834Skib out: 274160676Spjd if (allocated) { 275160582Spjd bzero(buf, enccrd->crd_len + 16); 276160582Spjd free(buf, M_PADLOCK); 277160582Spjd } 278208834Skib return (error); 279160582Spjd} 280