forked from Qortal/Brooklyn
You can not select more than 25 topics
Topics must start with a letter or number, can include dashes ('-') and can be up to 35 characters long.
89 lines
2.1 KiB
89 lines
2.1 KiB
/* Orinoco MIC helpers |
|
* |
|
* See copyright notice in main.c |
|
*/ |
|
#include <linux/kernel.h> |
|
#include <linux/string.h> |
|
#include <linux/if_ether.h> |
|
#include <linux/scatterlist.h> |
|
#include <crypto/hash.h> |
|
|
|
#include "orinoco.h" |
|
#include "mic.h" |
|
|
|
/********************************************************************/ |
|
/* Michael MIC crypto setup */ |
|
/********************************************************************/ |
|
int orinoco_mic_init(struct orinoco_private *priv) |
|
{ |
|
priv->tx_tfm_mic = crypto_alloc_shash("michael_mic", 0, 0); |
|
if (IS_ERR(priv->tx_tfm_mic)) { |
|
printk(KERN_DEBUG "%s: could not allocate " |
|
"crypto API michael_mic\n", __func__); |
|
priv->tx_tfm_mic = NULL; |
|
return -ENOMEM; |
|
} |
|
|
|
priv->rx_tfm_mic = crypto_alloc_shash("michael_mic", 0, 0); |
|
if (IS_ERR(priv->rx_tfm_mic)) { |
|
printk(KERN_DEBUG "%s: could not allocate " |
|
"crypto API michael_mic\n", __func__); |
|
priv->rx_tfm_mic = NULL; |
|
return -ENOMEM; |
|
} |
|
|
|
return 0; |
|
} |
|
|
|
void orinoco_mic_free(struct orinoco_private *priv) |
|
{ |
|
if (priv->tx_tfm_mic) |
|
crypto_free_shash(priv->tx_tfm_mic); |
|
if (priv->rx_tfm_mic) |
|
crypto_free_shash(priv->rx_tfm_mic); |
|
} |
|
|
|
int orinoco_mic(struct crypto_shash *tfm_michael, u8 *key, |
|
u8 *da, u8 *sa, u8 priority, |
|
u8 *data, size_t data_len, u8 *mic) |
|
{ |
|
SHASH_DESC_ON_STACK(desc, tfm_michael); |
|
u8 hdr[ETH_HLEN + 2]; /* size of header + padding */ |
|
int err; |
|
|
|
if (tfm_michael == NULL) { |
|
printk(KERN_WARNING "%s: tfm_michael == NULL\n", __func__); |
|
return -1; |
|
} |
|
|
|
/* Copy header into buffer. We need the padding on the end zeroed */ |
|
memcpy(&hdr[0], da, ETH_ALEN); |
|
memcpy(&hdr[ETH_ALEN], sa, ETH_ALEN); |
|
hdr[ETH_ALEN * 2] = priority; |
|
hdr[ETH_ALEN * 2 + 1] = 0; |
|
hdr[ETH_ALEN * 2 + 2] = 0; |
|
hdr[ETH_ALEN * 2 + 3] = 0; |
|
|
|
desc->tfm = tfm_michael; |
|
|
|
err = crypto_shash_setkey(tfm_michael, key, MIC_KEYLEN); |
|
if (err) |
|
return err; |
|
|
|
err = crypto_shash_init(desc); |
|
if (err) |
|
return err; |
|
|
|
err = crypto_shash_update(desc, hdr, sizeof(hdr)); |
|
if (err) |
|
return err; |
|
|
|
err = crypto_shash_update(desc, data, data_len); |
|
if (err) |
|
return err; |
|
|
|
err = crypto_shash_final(desc, mic); |
|
shash_desc_zero(desc); |
|
|
|
return err; |
|
}
|
|
|