1*4882a593Smuzhiyun /* Orinoco MIC helpers
2*4882a593Smuzhiyun *
3*4882a593Smuzhiyun * See copyright notice in main.c
4*4882a593Smuzhiyun */
5*4882a593Smuzhiyun #include <linux/kernel.h>
6*4882a593Smuzhiyun #include <linux/string.h>
7*4882a593Smuzhiyun #include <linux/if_ether.h>
8*4882a593Smuzhiyun #include <linux/scatterlist.h>
9*4882a593Smuzhiyun #include <crypto/hash.h>
10*4882a593Smuzhiyun
11*4882a593Smuzhiyun #include "orinoco.h"
12*4882a593Smuzhiyun #include "mic.h"
13*4882a593Smuzhiyun
14*4882a593Smuzhiyun /********************************************************************/
15*4882a593Smuzhiyun /* Michael MIC crypto setup */
16*4882a593Smuzhiyun /********************************************************************/
orinoco_mic_init(struct orinoco_private * priv)17*4882a593Smuzhiyun int orinoco_mic_init(struct orinoco_private *priv)
18*4882a593Smuzhiyun {
19*4882a593Smuzhiyun priv->tx_tfm_mic = crypto_alloc_shash("michael_mic", 0, 0);
20*4882a593Smuzhiyun if (IS_ERR(priv->tx_tfm_mic)) {
21*4882a593Smuzhiyun printk(KERN_DEBUG "%s: could not allocate "
22*4882a593Smuzhiyun "crypto API michael_mic\n", __func__);
23*4882a593Smuzhiyun priv->tx_tfm_mic = NULL;
24*4882a593Smuzhiyun return -ENOMEM;
25*4882a593Smuzhiyun }
26*4882a593Smuzhiyun
27*4882a593Smuzhiyun priv->rx_tfm_mic = crypto_alloc_shash("michael_mic", 0, 0);
28*4882a593Smuzhiyun if (IS_ERR(priv->rx_tfm_mic)) {
29*4882a593Smuzhiyun printk(KERN_DEBUG "%s: could not allocate "
30*4882a593Smuzhiyun "crypto API michael_mic\n", __func__);
31*4882a593Smuzhiyun priv->rx_tfm_mic = NULL;
32*4882a593Smuzhiyun return -ENOMEM;
33*4882a593Smuzhiyun }
34*4882a593Smuzhiyun
35*4882a593Smuzhiyun return 0;
36*4882a593Smuzhiyun }
37*4882a593Smuzhiyun
orinoco_mic_free(struct orinoco_private * priv)38*4882a593Smuzhiyun void orinoco_mic_free(struct orinoco_private *priv)
39*4882a593Smuzhiyun {
40*4882a593Smuzhiyun if (priv->tx_tfm_mic)
41*4882a593Smuzhiyun crypto_free_shash(priv->tx_tfm_mic);
42*4882a593Smuzhiyun if (priv->rx_tfm_mic)
43*4882a593Smuzhiyun crypto_free_shash(priv->rx_tfm_mic);
44*4882a593Smuzhiyun }
45*4882a593Smuzhiyun
orinoco_mic(struct crypto_shash * tfm_michael,u8 * key,u8 * da,u8 * sa,u8 priority,u8 * data,size_t data_len,u8 * mic)46*4882a593Smuzhiyun int orinoco_mic(struct crypto_shash *tfm_michael, u8 *key,
47*4882a593Smuzhiyun u8 *da, u8 *sa, u8 priority,
48*4882a593Smuzhiyun u8 *data, size_t data_len, u8 *mic)
49*4882a593Smuzhiyun {
50*4882a593Smuzhiyun SHASH_DESC_ON_STACK(desc, tfm_michael);
51*4882a593Smuzhiyun u8 hdr[ETH_HLEN + 2]; /* size of header + padding */
52*4882a593Smuzhiyun int err;
53*4882a593Smuzhiyun
54*4882a593Smuzhiyun if (tfm_michael == NULL) {
55*4882a593Smuzhiyun printk(KERN_WARNING "%s: tfm_michael == NULL\n", __func__);
56*4882a593Smuzhiyun return -1;
57*4882a593Smuzhiyun }
58*4882a593Smuzhiyun
59*4882a593Smuzhiyun /* Copy header into buffer. We need the padding on the end zeroed */
60*4882a593Smuzhiyun memcpy(&hdr[0], da, ETH_ALEN);
61*4882a593Smuzhiyun memcpy(&hdr[ETH_ALEN], sa, ETH_ALEN);
62*4882a593Smuzhiyun hdr[ETH_ALEN * 2] = priority;
63*4882a593Smuzhiyun hdr[ETH_ALEN * 2 + 1] = 0;
64*4882a593Smuzhiyun hdr[ETH_ALEN * 2 + 2] = 0;
65*4882a593Smuzhiyun hdr[ETH_ALEN * 2 + 3] = 0;
66*4882a593Smuzhiyun
67*4882a593Smuzhiyun desc->tfm = tfm_michael;
68*4882a593Smuzhiyun
69*4882a593Smuzhiyun err = crypto_shash_setkey(tfm_michael, key, MIC_KEYLEN);
70*4882a593Smuzhiyun if (err)
71*4882a593Smuzhiyun return err;
72*4882a593Smuzhiyun
73*4882a593Smuzhiyun err = crypto_shash_init(desc);
74*4882a593Smuzhiyun if (err)
75*4882a593Smuzhiyun return err;
76*4882a593Smuzhiyun
77*4882a593Smuzhiyun err = crypto_shash_update(desc, hdr, sizeof(hdr));
78*4882a593Smuzhiyun if (err)
79*4882a593Smuzhiyun return err;
80*4882a593Smuzhiyun
81*4882a593Smuzhiyun err = crypto_shash_update(desc, data, data_len);
82*4882a593Smuzhiyun if (err)
83*4882a593Smuzhiyun return err;
84*4882a593Smuzhiyun
85*4882a593Smuzhiyun err = crypto_shash_final(desc, mic);
86*4882a593Smuzhiyun shash_desc_zero(desc);
87*4882a593Smuzhiyun
88*4882a593Smuzhiyun return err;
89*4882a593Smuzhiyun }
90