drivers/staging/wlags49_h2/wl_enc.c

   1
   2 /*******************************************************************************
   3  * Agere Systems Inc.
   4  * Wireless device driver for Linux (wlags49).
   5  *
   6  * Copyright (c) 1998-2003 Agere Systems Inc.
   7  * All rights reserved.
   8  *   http://www.agere.com
   9  *
  10  * Initially developed by TriplePoint, Inc.
  11  *   http://www.triplepoint.com
  12  *
  13  *------------------------------------------------------------------------------
  14  *
  15  *   This file defines functions related to WEP key coding/decoding.
  16  *
  17  *------------------------------------------------------------------------------
  18  *
  19  * SOFTWARE LICENSE
  20  *
  21  * This software is provided subject to the following terms and conditions,
  22  * which you should read carefully before using the software.  Using this
  23  * software indicates your acceptance of these terms and conditions.  If you do
  24  * not agree with these terms and conditions, do not use the software.
  25  *
  26  * Copyright � 2003 Agere Systems Inc.
  27  * All rights reserved.
  28  *
  29  * Redistribution and use in source or binary forms, with or without
  30  * modifications, are permitted provided that the following conditions are met:
  31  *
  32  * . Redistributions of source code must retain the above copyright notice, this
  33  *    list of conditions and the following Disclaimer as comments in the code as
  34  *    well as in the documentation and/or other materials provided with the
  35  *    distribution.
  36  *
  37  * . Redistributions in binary form must reproduce the above copyright notice,
  38  *    this list of conditions and the following Disclaimer in the documentation
  39  *    and/or other materials provided with the distribution.
  40  *
  41  * . Neither the name of Agere Systems Inc. nor the names of the contributors
  42  *    may be used to endorse or promote products derived from this software
  43  *    without specific prior written permission.
  44  *
  45  * Disclaimer
  46  *
  47  * THIS SOFTWARE IS PROVIDED �AS IS� AND ANY EXPRESS OR IMPLIED WARRANTIES,
  48  * INCLUDING, BUT NOT LIMITED TO, INFRINGEMENT AND THE IMPLIED WARRANTIES OF
  49  * MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.  ANY
  50  * USE, MODIFICATION OR DISTRIBUTION OF THIS SOFTWARE IS SOLELY AT THE USERS OWN
  51  * RISK. IN NO EVENT SHALL AGERE SYSTEMS INC. OR CONTRIBUTORS BE LIABLE FOR ANY
  52  * DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES
  53  * (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES;
  54  * LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND
  55  * ON ANY THEORY OF LIABILITY, INCLUDING, BUT NOT LIMITED TO, CONTRACT, STRICT
  56  * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT
  57  * OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH
  58  * DAMAGE.
  59  *
  60  ******************************************************************************/
  61
  62 /*******************************************************************************
  63  *  include files
  64  ******************************************************************************/
  65 #include <wl_version.h>
  66
  67 #include <debug.h>
  68 #include <hcf.h>
  69
  70 #include <wl_enc.h>
  71
  72
  73
  74
  75 /*******************************************************************************
  76  *  global definitions
  77  ******************************************************************************/
  78 #if DBG
  79
  80 extern dbg_info_t *DbgInfo;
  81
  82 #endif  /* DBG */
  83
  84
  85
  86
  87 /*******************************************************************************
  88  *      wl_wep_code()
  89  *******************************************************************************
  90  *
  91  *  DESCRIPTION:
  92  *
  93  *      This function encodes a set of wep keys for privacy
  94  *
  95  *  PARAMETERS:
  96  *
  97  *      szCrypt -
  98  *      szDest  -
  99  *      Data    -
 100  *      nLen    -
 101  *
 102  *  RETURNS:
 103  *
 104  *      OK
 105  *
 106  ******************************************************************************/
 107 int wl_wep_code( char *szCrypt, char *szDest, void *Data, int nLen )
 108 {
 109     int     i;
 110     int     t;
 111     int     k ;
 112     char    bits;
 113     char    *szData = (char *) Data;
 114     /*------------------------------------------------------------------------*/
 115
 116
 117     for( i = bits = 0 ; i < MACADDRESS_STR_LEN; i++ ) {
 118             bits ^= szCrypt[i];
 119             bits += szCrypt[i];
 120     }
 121
 122     for( i = t = *szDest = 0; i < nLen; i++, t++ ) {
 123             k = szData[i] ^ ( bits + i );
 124
 125
 126         switch( i % 3 ) {
 127
 128         case 0 :
 129
 130             szDest[t]   = ((k & 0xFC) >> 2) + CH_START ;
 131                         szDest[t+1] = ((k & 0x03) << 4) + CH_START ;
 132                 szDest[t+2] = '\0';
 133
 134             break;
 135
 136
 137         case 1 :
 138
 139             szDest[t]  += (( k & 0xF0 ) >> 4 );
 140                         szDest[t+1] = (( k & 0x0F ) << 2 ) + CH_START ;
 141                 szDest[t+2] = '\0';
 142
 143             break;
 144
 145
 146         case 2 :
 147
 148             szDest[t]  += (( k & 0xC0 ) >> 6 );
 149                         szDest[t+1] = ( k & 0x3F ) + CH_START ;
 150                 szDest[t+2] = '\0';
 151                 t++;
 152
 153             break;
 154         }
 155     }
 156
 157     return( strlen( szDest )) ;
 158
 159 }
 160 /*============================================================================*/
 161
 162
 163
 164
 165 /*******************************************************************************
 166  *      wl_wep_decode()
 167  *******************************************************************************
 168  *
 169  *  DESCRIPTION:
 170  *
 171  *      This function decodes a set of WEP keys for use by the card.
 172  *
 173  *  PARAMETERS:
 174  *
 175  *      szCrypt -
 176  *      szDest  -
 177  *      Data    -
 178  *
 179  *  RETURNS:
 180  *
 181  *      OK
 182  *
 183  ******************************************************************************/
 184 int wl_wep_decode( char *szCrypt, void *Dest, char *szData )
 185 {
 186     int     i;
 187     int     t;
 188     int     nLen;
 189     char    bits;
 190     char    *szDest = Dest;
 191   /*------------------------------------------------------------------------*/
 192
 193
 194   for( i = bits = 0 ; i < 12; i++ ) {
 195       bits ^= szCrypt[i] ;
 196       bits += szCrypt[i] ;
 197   }
 198
 199   nLen = ( strlen( szData ) * 3) / 4 ;
 200
 201   for( i = t = 0; i < nLen; i++, t++ ) {
 202       switch( i % 3 ) {
 203       case 0 :
 204
 205           szDest[i] = ((( szData[t]-CH_START ) & 0x3f ) << 2 ) +
 206                       ((( szData[t+1]-CH_START ) & 0x30 ) >> 4 );
 207               break;
 208
 209
 210       case 1 :
 211           szDest[i] = ((( szData[t]-CH_START ) & 0x0f ) << 4 ) +
 212                       ((( szData[t+1]-CH_START ) & 0x3c ) >> 2 );
 213               break;
 214
 215
 216       case 2 :
 217           szDest[i] = ((( szData[t]-CH_START ) & 0x03 ) << 6 ) +
 218                        (( szData[t+1]-CH_START ) & 0x3f );
 219               t++;
 220               break;
 221       }
 222
 223         szDest[i] ^= ( bits + i ) ;
 224
 225   }
 226
 227   return( i ) ;
 228
 229 }
 230 /*============================================================================*/
 231