drivers/staging/vt6656/rc4.c

   1 /*
   2  * Copyright (c) 1996, 2003 VIA Networking Technologies, Inc.
   3  * All rights reserved.
   4  *
   5  * This program is free software; you can redistribute it and/or modify
   6  * it under the terms of the GNU General Public License as published by
   7  * the Free Software Foundation; either version 2 of the License, or
   8  * (at your option) any later version.
   9  *
  10  * This program is distributed in the hope that it will be useful,
  11  * but WITHOUT ANY WARRANTY; without even the implied warranty of
  12  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
  13  * GNU General Public License for more details.
  14  *
  15  * You should have received a copy of the GNU General Public License along
  16  * with this program; if not, write to the Free Software Foundation, Inc.,
  17  * 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301 USA.
  18  *
  19  * File: rc4.c
  20  *
  21  * Purpose:
  22  *
  23  * Functions:
  24  *
  25  * Revision History:
  26  *
  27  * Author: Kyle Hsu
  28  *
  29  * Date: Sep 4, 2002
  30  *
  31  */
  32
  33 #include "rc4.h"
  34
  35 VOID rc4_init(PRC4Ext pRC4, PBYTE pbyKey, UINT cbKey_len)
  36 {
  37     UINT  ust1, ust2;
  38     UINT  keyindex;
  39     UINT  stateindex;
  40     PBYTE pbyst;
  41     UINT  idx;
  42
  43     pbyst = pRC4->abystate;
  44     pRC4->ux = 0;
  45     pRC4->uy = 0;
  46     for (idx = 0; idx < 256; idx++)
  47         pbyst[idx] = (BYTE)idx;
  48     keyindex = 0;
  49     stateindex = 0;
  50     for (idx = 0; idx < 256; idx++) {
  51         ust1 = pbyst[idx];
  52         stateindex = (stateindex + pbyKey[keyindex] + ust1) & 0xff;
  53         ust2 = pbyst[stateindex];
  54         pbyst[stateindex] = (BYTE)ust1;
  55         pbyst[idx] = (BYTE)ust2;
  56         if (++keyindex >= cbKey_len)
  57             keyindex = 0;
  58     }
  59 }
  60
  61 UINT rc4_byte(PRC4Ext pRC4)
  62 {
  63     UINT ux;
  64     UINT uy;
  65     UINT ustx, usty;
  66     PBYTE pbyst;
  67
  68     pbyst = pRC4->abystate;
  69     ux = (pRC4->ux + 1) & 0xff;
  70     ustx = pbyst[ux];
  71     uy = (ustx + pRC4->uy) & 0xff;
  72     usty = pbyst[uy];
  73     pRC4->ux = ux;
  74     pRC4->uy = uy;
  75     pbyst[uy] = (BYTE)ustx;
  76     pbyst[ux] = (BYTE)usty;
  77
  78     return pbyst[(ustx + usty) & 0xff];
  79 }
  80
  81 VOID rc4_encrypt(PRC4Ext pRC4, PBYTE pbyDest,
  82                      PBYTE pbySrc, UINT cbData_len)
  83 {
  84     UINT ii;
  85     for (ii = 0; ii < cbData_len; ii++)
  86         pbyDest[ii] = (BYTE)(pbySrc[ii] ^ rc4_byte(pRC4));
  87 }