/*
|
/*
|
* rc4.c
|
* rc4.c
|
*
|
*
|
* Copyright (c) 1996-2000 Whistle Communications, Inc.
|
* Copyright (c) 1996-2000 Whistle Communications, Inc.
|
* All rights reserved.
|
* All rights reserved.
|
*
|
*
|
* Subject to the following obligations and disclaimer of warranty, use and
|
* Subject to the following obligations and disclaimer of warranty, use and
|
* redistribution of this software, in source or object code forms, with or
|
* redistribution of this software, in source or object code forms, with or
|
* without modifications are expressly permitted by Whistle Communications;
|
* without modifications are expressly permitted by Whistle Communications;
|
* provided, however, that:
|
* provided, however, that:
|
* 1. Any and all reproductions of the source or object code must include the
|
* 1. Any and all reproductions of the source or object code must include the
|
* copyright notice above and the following disclaimer of warranties; and
|
* copyright notice above and the following disclaimer of warranties; and
|
* 2. No rights are granted, in any manner or form, to use Whistle
|
* 2. No rights are granted, in any manner or form, to use Whistle
|
* Communications, Inc. trademarks, including the mark "WHISTLE
|
* Communications, Inc. trademarks, including the mark "WHISTLE
|
* COMMUNICATIONS" on advertising, endorsements, or otherwise except as
|
* COMMUNICATIONS" on advertising, endorsements, or otherwise except as
|
* such appears in the above copyright notice or in the software.
|
* such appears in the above copyright notice or in the software.
|
*
|
*
|
* THIS SOFTWARE IS BEING PROVIDED BY WHISTLE COMMUNICATIONS "AS IS", AND
|
* THIS SOFTWARE IS BEING PROVIDED BY WHISTLE COMMUNICATIONS "AS IS", AND
|
* TO THE MAXIMUM EXTENT PERMITTED BY LAW, WHISTLE COMMUNICATIONS MAKES NO
|
* TO THE MAXIMUM EXTENT PERMITTED BY LAW, WHISTLE COMMUNICATIONS MAKES NO
|
* REPRESENTATIONS OR WARRANTIES, EXPRESS OR IMPLIED, REGARDING THIS SOFTWARE,
|
* REPRESENTATIONS OR WARRANTIES, EXPRESS OR IMPLIED, REGARDING THIS SOFTWARE,
|
* INCLUDING WITHOUT LIMITATION, ANY AND ALL IMPLIED WARRANTIES OF
|
* INCLUDING WITHOUT LIMITATION, ANY AND ALL IMPLIED WARRANTIES OF
|
* MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE, OR NON-INFRINGEMENT.
|
* MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE, OR NON-INFRINGEMENT.
|
* WHISTLE COMMUNICATIONS DOES NOT WARRANT, GUARANTEE, OR MAKE ANY
|
* WHISTLE COMMUNICATIONS DOES NOT WARRANT, GUARANTEE, OR MAKE ANY
|
* REPRESENTATIONS REGARDING THE USE OF, OR THE RESULTS OF THE USE OF THIS
|
* REPRESENTATIONS REGARDING THE USE OF, OR THE RESULTS OF THE USE OF THIS
|
* SOFTWARE IN TERMS OF ITS CORRECTNESS, ACCURACY, RELIABILITY OR OTHERWISE.
|
* SOFTWARE IN TERMS OF ITS CORRECTNESS, ACCURACY, RELIABILITY OR OTHERWISE.
|
* IN NO EVENT SHALL WHISTLE COMMUNICATIONS BE LIABLE FOR ANY DAMAGES
|
* IN NO EVENT SHALL WHISTLE COMMUNICATIONS BE LIABLE FOR ANY DAMAGES
|
* RESULTING FROM OR ARISING OUT OF ANY USE OF THIS SOFTWARE, INCLUDING
|
* RESULTING FROM OR ARISING OUT OF ANY USE OF THIS SOFTWARE, INCLUDING
|
* WITHOUT LIMITATION, ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY,
|
* WITHOUT LIMITATION, ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY,
|
* PUNITIVE, OR CONSEQUENTIAL DAMAGES, PROCUREMENT OF SUBSTITUTE GOODS OR
|
* PUNITIVE, OR CONSEQUENTIAL DAMAGES, PROCUREMENT OF SUBSTITUTE GOODS OR
|
* SERVICES, LOSS OF USE, DATA OR PROFITS, HOWEVER CAUSED AND UNDER ANY
|
* SERVICES, LOSS OF USE, DATA OR PROFITS, HOWEVER CAUSED AND UNDER ANY
|
* THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
|
* THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
|
* (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF
|
* (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF
|
* THIS SOFTWARE, EVEN IF WHISTLE COMMUNICATIONS IS ADVISED OF THE POSSIBILITY
|
* THIS SOFTWARE, EVEN IF WHISTLE COMMUNICATIONS IS ADVISED OF THE POSSIBILITY
|
* OF SUCH DAMAGE.
|
* OF SUCH DAMAGE.
|
*/
|
*/
|
|
|
#include <rc4.h>
|
#include <rc4.h>
|
|
|
void swap_bytes(uint8_t *a, uint8_t *b)
|
void swap_bytes(uint8_t *a, uint8_t *b)
|
{
|
{
|
/*
|
/*
|
_asm
|
_asm
|
ld d,4(ix)
|
ld d,4(ix)
|
ld e,5(ix)
|
ld e,5(ix)
|
ld h,6(ix)
|
ld h,6(ix)
|
ld l,7(ix)
|
ld l,7(ix)
|
ld a, (de)
|
ld a, (de)
|
ld b, a
|
ld b, a
|
ld a, (hl)
|
ld a, (hl)
|
ld (de), a
|
ld (de), a
|
ld (hl), b
|
ld (hl), b
|
_endasm;
|
_endasm;
|
*/
|
*/
|
uint8_t temp;
|
uint8_t temp;
|
|
|
temp = *a;
|
temp = *a;
|
*a = *b;
|
*a = *b;
|
*b = temp;
|
*b = temp;
|
}
|
}
|
|
|
/*
|
/*
|
* Initialize an RC4 state buffer using the supplied key,
|
* Initialize an RC4 state buffer using the supplied key,
|
* which can have arbitrary length.
|
* which can have arbitrary length.
|
*/
|
*/
|
void rc4_init(struct rc4_state *const state, const uint8_t *key, int keylen)
|
void rc4_init(struct rc4_state *const state, const uint8_t *key, int keylen)
|
{
|
{
|
uint8_t j;
|
uint8_t j;
|
int i;
|
int i;
|
|
|
/* Initialize state with identity permutation */
|
/* Initialize state with identity permutation */
|
#ifndef ORIGINAL_C
|
#ifndef ORIGINAL_C
|
_asm
|
_asm
|
ld d, 4(ix)
|
ld d, 4(ix)
|
ld e, 5(ix)
|
ld e, 5(ix)
|
ld b, #255
|
ld b, #255
|
state_init:
|
state_init:
|
ld h, #0
|
ld h, #0
|
ld l, b
|
ld l, b
|
add hl, de
|
add hl, de
|
ld (hl), b
|
ld (hl), b
|
djnz state_init
|
djnz state_init
|
ex de, hl
|
ex de, hl
|
ld (hl), #0
|
ld (hl), #0
|
ex de, hl
|
ex de, hl
|
ld l, #0
|
ld l, #0
|
ld h, #1
|
ld h, #1
|
add hl, de
|
add hl, de
|
ld (hl), #0
|
ld (hl), #0
|
inc hl
|
inc hl
|
ld (hl), #0
|
ld (hl), #0
|
_endasm;
|
_endasm;
|
#else
|
#else
|
for (i = 0; i < 256; i++)
|
for (i = 0; i < 256; i++)
|
state->perm[i] = (uint8_t)i;
|
state->perm[i] = (uint8_t)i;
|
state->index1 = 0;
|
state->index1 = 0;
|
state->index2 = 0;
|
state->index2 = 0;
|
#endif
|
#endif
|
|
|
/* Randomize the permutation using key data */
|
/* Randomize the permutation using key data */
|
for (j = i = 0; i < 256; i++) {
|
for (j = i = 0; i < 256; i++) {
|
uint8_t tmp;
|
uint8_t tmp;
|
j += state->perm[i] + key[i % keylen];
|
j += state->perm[i] + key[i % keylen];
|
tmp = state->perm[i];
|
tmp = state->perm[i];
|
state->perm[i] = state->perm[j];
|
state->perm[i] = state->perm[j];
|
state->perm[j] = tmp;
|
state->perm[j] = tmp;
|
//swap_bytes(&state->perm[i], &state->perm[j]);
|
//swap_bytes(&state->perm[i], &state->perm[j]);
|
}
|
}
|
}
|
}
|
|
|
/*
|
/*
|
* Encrypt some data using the supplied RC4 state buffer.
|
* Encrypt some data using the supplied RC4 state buffer.
|
* The input and output buffers may be the same buffer.
|
* The input and output buffers may be the same buffer.
|
* Since RC4 is a stream cypher, this function is used
|
* Since RC4 is a stream cypher, this function is used
|
* for both encryption and decryption.
|
* for both encryption and decryption.
|
*/
|
*/
|
void rc4_crypt(struct rc4_state *const state,
|
void rc4_crypt(struct rc4_state *const state,
|
const uint8_t *inbuf, uint8_t *outbuf, int buflen)
|
const uint8_t *inbuf, uint8_t *outbuf, int buflen)
|
{
|
{
|
int i;
|
int i;
|
uint8_t j;
|
uint8_t j;
|
|
|
for (i = 0; i < buflen; i++) {
|
for (i = 0; i < buflen; i++) {
|
|
|
/* Update modification indicies */
|
/* Update modification indicies */
|
state->index1++;
|
state->index1++;
|
state->index2 += state->perm[state->index1];
|
state->index2 += state->perm[state->index1];
|
|
|
/* Modify permutation */
|
/* Modify permutation */
|
swap_bytes(&state->perm[state->index1],
|
swap_bytes(&state->perm[state->index1],
|
&state->perm[state->index2]);
|
&state->perm[state->index2]);
|
|
|
/* Encrypt/decrypt next byte */
|
/* Encrypt/decrypt next byte */
|
j = state->perm[state->index1] + state->perm[state->index2];
|
j = state->perm[state->index1] + state->perm[state->index2];
|
outbuf[i] = inbuf[i] ^ state->perm[j];
|
outbuf[i] = inbuf[i] ^ state->perm[j];
|
}
|
}
|
}
|
}
|
|
|