修改内核路径

hc

2024-05-14 bedbef8ad3e75a304af6361af235302bcc61d06b

1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
/* 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;
}