Blame view
net/mac80211/michael.c
2.18 KB
f0706e828 [MAC80211]: Add m... |
1 2 3 4 5 6 7 8 |
/* * Michael MIC implementation - optimized for TKIP MIC operations * Copyright 2002-2003, Instant802 Networks, Inc. * * This program is free software; you can redistribute it and/or modify * it under the terms of the GNU General Public License version 2 as * published by the Free Software Foundation. */ |
f0706e828 [MAC80211]: Add m... |
9 |
#include <linux/types.h> |
1bd3dff54 mac80211: michael... |
10 |
#include <linux/bitops.h> |
8e8862b79 mac80211: remove ... |
11 |
#include <linux/ieee80211.h> |
1bd3dff54 mac80211: michael... |
12 |
#include <asm/unaligned.h> |
f0706e828 [MAC80211]: Add m... |
13 14 |
#include "michael.h" |
1b19ca396 mac80211: introdu... |
15 16 17 18 19 20 21 22 23 24 25 26 27 |
static void michael_block(struct michael_mic_ctx *mctx, u32 val) { mctx->l ^= val; mctx->r ^= rol32(mctx->l, 17); mctx->l += mctx->r; mctx->r ^= ((mctx->l & 0xff00ff00) >> 8) | ((mctx->l & 0x00ff00ff) << 8); mctx->l += mctx->r; mctx->r ^= rol32(mctx->l, 3); mctx->l += mctx->r; mctx->r ^= ror32(mctx->l, 2); mctx->l += mctx->r; } |
8e8862b79 mac80211: remove ... |
28 29 |
static void michael_mic_hdr(struct michael_mic_ctx *mctx, const u8 *key, struct ieee80211_hdr *hdr) |
1b19ca396 mac80211: introdu... |
30 |
{ |
8e8862b79 mac80211: remove ... |
31 32 33 34 35 36 37 38 |
u8 *da, *sa, tid; da = ieee80211_get_DA(hdr); sa = ieee80211_get_SA(hdr); if (ieee80211_is_data_qos(hdr->frame_control)) tid = *ieee80211_get_qos_ctl(hdr) & IEEE80211_QOS_CTL_TID_MASK; else tid = 0; |
1b19ca396 mac80211: introdu... |
39 40 41 42 43 44 45 46 47 48 49 |
mctx->l = get_unaligned_le32(key); mctx->r = get_unaligned_le32(key + 4); /* * A pseudo header (DA, SA, Priority, 0, 0, 0) is used in Michael MIC * calculation, but it is _not_ transmitted */ michael_block(mctx, get_unaligned_le32(da)); michael_block(mctx, get_unaligned_le16(&da[4]) | (get_unaligned_le16(sa) << 16)); michael_block(mctx, get_unaligned_le32(&sa[2])); |
8e8862b79 mac80211: remove ... |
50 |
michael_block(mctx, tid); |
1b19ca396 mac80211: introdu... |
51 |
} |
f0706e828 [MAC80211]: Add m... |
52 |
|
8e8862b79 mac80211: remove ... |
53 |
void michael_mic(const u8 *key, struct ieee80211_hdr *hdr, |
a7b6f0c55 mac80211: add con... |
54 |
const u8 *data, size_t data_len, u8 *mic) |
f0706e828 [MAC80211]: Add m... |
55 |
{ |
1b19ca396 mac80211: introdu... |
56 |
u32 val; |
f0706e828 [MAC80211]: Add m... |
57 |
size_t block, blocks, left; |
1b19ca396 mac80211: introdu... |
58 |
struct michael_mic_ctx mctx; |
f0706e828 [MAC80211]: Add m... |
59 |
|
8e8862b79 mac80211: remove ... |
60 |
michael_mic_hdr(&mctx, key, hdr); |
f0706e828 [MAC80211]: Add m... |
61 62 63 64 |
/* Real data */ blocks = data_len / 4; left = data_len % 4; |
1b19ca396 mac80211: introdu... |
65 66 |
for (block = 0; block < blocks; block++) michael_block(&mctx, get_unaligned_le32(&data[block * 4])); |
f0706e828 [MAC80211]: Add m... |
67 68 69 70 71 72 73 74 75 |
/* Partial block of 0..3 bytes and padding: 0x5a + 4..7 zeros to make * total length a multiple of 4. */ val = 0x5a; while (left > 0) { val <<= 8; left--; val |= data[blocks * 4 + left]; } |
f0706e828 [MAC80211]: Add m... |
76 |
|
1b19ca396 mac80211: introdu... |
77 78 79 80 81 |
michael_block(&mctx, val); michael_block(&mctx, 0); put_unaligned_le32(mctx.l, mic); put_unaligned_le32(mctx.r, mic + 4); |
f0706e828 [MAC80211]: Add m... |
82 |
} |