| /* |
| * Copyright (c) 2017-2018 The Linux Foundation. All rights reserved. |
| */ |
| /* |
| * Wired Equivalent Privacy (WEP) |
| * Copyright (c) 2010, Jouni Malinen <j@w1.fi> |
| * |
| * This software may be distributed under the terms of the BSD license. |
| * See README for more details. |
| */ |
| |
| #include <qdf_types.h> |
| #include <qdf_mem.h> |
| #include <qdf_util.h> |
| #include "wlan_crypto_aes_i.h" |
| #include "wlan_crypto_def_i.h" |
| |
| void wlan_crypto_wep_crypt(uint8_t *key, uint8_t *buf, size_t plen) |
| { |
| uint32_t i, j, k; |
| uint8_t S[256]; |
| #define S_SWAP(a, b) do { uint8_t t = S[a]; S[a] = S[b]; S[b] = t; } while (0) |
| uint8_t *pos; |
| |
| /* Setup RC4 state */ |
| for (i = 0; i < 256; i++) |
| S[i] = i; |
| j = 0; |
| for (i = 0; i < 256; i++) { |
| j = (j + S[i] + key[i & 0x0f]) & 0xff; |
| S_SWAP(i, j); |
| } |
| |
| /* Apply RC4 to data */ |
| pos = buf; |
| i = j = 0; |
| for (k = 0; k < plen; k++) { |
| i = (i + 1) & 0xff; |
| j = (j + S[i]) & 0xff; |
| S_SWAP(i, j); |
| *pos ^= S[(S[i] + S[j]) & 0xff]; |
| pos++; |
| } |
| } |
| |
| |
| void wlan_crypto_try_wep(const uint8_t *key, size_t key_len, |
| uint8_t *data, size_t data_len, |
| uint32_t *icv){ |
| uint8_t k[16]; |
| int i, j; |
| |
| for (i = 0, j = 0; i < sizeof(k); i++) { |
| k[i] = key[j]; |
| j++; |
| if (j >= key_len) |
| j = 0; |
| } |
| |
| wlan_crypto_wep_crypt(k, data, data_len); |
| *icv = wlan_crypto_crc32(data, data_len - 4); |
| } |
| |
| uint8_t *wlan_crypto_wep_encrypt(const uint8_t *key, uint16_t key_len, |
| uint8_t *data, size_t data_len){ |
| uint8_t k[16]; |
| uint32_t icv; |
| |
| if (data_len < 4 + 4) { |
| crypto_err("invalid len"); |
| return NULL; |
| } |
| |
| qdf_mem_copy(k, data, 3); |
| qdf_mem_copy(k + 3, key, key_len); |
| wlan_crypto_try_wep(k, 3 + key_len, data + 4, data_len - 4, &icv); |
| |
| return data; |
| } |
| |
| uint8_t *wlan_crypto_wep_decrypt(const uint8_t *key, uint16_t key_len, |
| uint8_t *data, size_t data_len){ |
| uint8_t k[16]; |
| uint32_t icv, rx_icv; |
| |
| if (data_len < 4 + 4) { |
| crypto_err("invalid len"); |
| return NULL; |
| } |
| |
| qdf_mem_copy(k, data, 3); |
| qdf_mem_copy(k + 3, key, key_len); |
| |
| rx_icv = wlan_crypto_get_le32(data + data_len - 4); |
| |
| wlan_crypto_try_wep(k, 3 + key_len, data + 4, data_len - 4, &icv); |
| |
| if (icv != rx_icv) { |
| crypto_err("iv mismatch"); |
| return NULL; |
| } |
| |
| return data; |
| } |