drivers/staging/wilc1000/coreconfigurator.c

   1 #include "coreconfigurator.h"
   2 #include "wilc_wlan_if.h"
   3 #include "wilc_wlan.h"
   4 #include <linux/errno.h>
   5 #include <linux/slab.h>
   6 #define TAG_PARAM_OFFSET        (MAC_HDR_LEN + TIME_STAMP_LEN + \
   7                                  BEACON_INTERVAL_LEN + CAP_INFO_LEN)
   8
   9 enum basic_frame_type {
  10         FRAME_TYPE_CONTROL     = 0x04,
  11         FRAME_TYPE_DATA        = 0x08,
  12         FRAME_TYPE_MANAGEMENT  = 0x00,
  13         FRAME_TYPE_RESERVED    = 0x0C,
  14         FRAME_TYPE_FORCE_32BIT = 0xFFFFFFFF
  15 };
  16
  17 enum sub_frame_type {
  18         ASSOC_REQ             = 0x00,
  19         ASSOC_RSP             = 0x10,
  20         REASSOC_REQ           = 0x20,
  21         REASSOC_RSP           = 0x30,
  22         PROBE_REQ             = 0x40,
  23         PROBE_RSP             = 0x50,
  24         BEACON                = 0x80,
  25         ATIM                  = 0x90,
  26         DISASOC               = 0xA0,
  27         AUTH                  = 0xB0,
  28         DEAUTH                = 0xC0,
  29         ACTION                = 0xD0,
  30         PS_POLL               = 0xA4,
  31         RTS                   = 0xB4,
  32         CTS                   = 0xC4,
  33         ACK                   = 0xD4,
  34         CFEND                 = 0xE4,
  35         CFEND_ACK             = 0xF4,
  36         DATA                  = 0x08,
  37         DATA_ACK              = 0x18,
  38         DATA_POLL             = 0x28,
  39         DATA_POLL_ACK         = 0x38,
  40         NULL_FRAME            = 0x48,
  41         CFACK                 = 0x58,
  42         CFPOLL                = 0x68,
  43         CFPOLL_ACK            = 0x78,
  44         QOS_DATA              = 0x88,
  45         QOS_DATA_ACK          = 0x98,
  46         QOS_DATA_POLL         = 0xA8,
  47         QOS_DATA_POLL_ACK     = 0xB8,
  48         QOS_NULL_FRAME        = 0xC8,
  49         QOS_CFPOLL            = 0xE8,
  50         QOS_CFPOLL_ACK        = 0xF8,
  51         BLOCKACK_REQ          = 0x84,
  52         BLOCKACK              = 0x94,
  53         FRAME_SUBTYPE_FORCE_32BIT  = 0xFFFFFFFF
  54 };
  55
  56 enum info_element_id {
  57         ISSID               = 0,   /* Service Set Identifier         */
  58         ISUPRATES           = 1,   /* Supported Rates                */
  59         IFHPARMS            = 2,   /* FH parameter set               */
  60         IDSPARMS            = 3,   /* DS parameter set               */
  61         ICFPARMS            = 4,   /* CF parameter set               */
  62         ITIM                = 5,   /* Traffic Information Map        */
  63         IIBPARMS            = 6,   /* IBSS parameter set             */
  64         ICOUNTRY            = 7,   /* Country element                */
  65         IEDCAPARAMS         = 12,  /* EDCA parameter set             */
  66         ITSPEC              = 13,  /* Traffic Specification          */
  67         ITCLAS              = 14,  /* Traffic Classification         */
  68         ISCHED              = 15,  /* Schedule                       */
  69         ICTEXT              = 16,  /* Challenge Text                 */
  70         IPOWERCONSTRAINT    = 32,  /* Power Constraint               */
  71         IPOWERCAPABILITY    = 33,  /* Power Capability               */
  72         ITPCREQUEST         = 34,  /* TPC Request                    */
  73         ITPCREPORT          = 35,  /* TPC Report                     */
  74         ISUPCHANNEL         = 36,  /* Supported channel list         */
  75         ICHSWANNOUNC        = 37,  /* Channel Switch Announcement    */
  76         IMEASUREMENTREQUEST = 38,  /* Measurement request            */
  77         IMEASUREMENTREPORT  = 39,  /* Measurement report             */
  78         IQUIET              = 40,  /* Quiet element Info             */
  79         IIBSSDFS            = 41,  /* IBSS DFS                       */
  80         IERPINFO            = 42,  /* ERP Information                */
  81         ITSDELAY            = 43,  /* TS Delay                       */
  82         ITCLASPROCESS       = 44,  /* TCLAS Processing               */
  83         IHTCAP              = 45,  /* HT Capabilities                */
  84         IQOSCAP             = 46,  /* QoS Capability                 */
  85         IRSNELEMENT         = 48,  /* RSN Information Element        */
  86         IEXSUPRATES         = 50,  /* Extended Supported Rates       */
  87         IEXCHSWANNOUNC      = 60,  /* Extended Ch Switch Announcement*/
  88         IHTOPERATION        = 61,  /* HT Information                 */
  89         ISECCHOFF           = 62,  /* Secondary Channel Offeset      */
  90         I2040COEX           = 72,  /* 20/40 Coexistence IE           */
  91         I2040INTOLCHREPORT  = 73,  /* 20/40 Intolerant channel report*/
  92         IOBSSSCAN           = 74,  /* OBSS Scan parameters           */
  93         IEXTCAP             = 127, /* Extended capability            */
  94         IWMM                = 221, /* WMM parameters                 */
  95         IWPAELEMENT         = 221, /* WPA Information Element        */
  96         INFOELEM_ID_FORCE_32BIT  = 0xFFFFFFFF
  97 };
  98
  99 static inline u16 get_beacon_period(u8 *data)
 100 {
 101         u16 bcn_per;
 102
 103         bcn_per  = data[0];
 104         bcn_per |= (data[1] << 8);
 105
 106         return bcn_per;
 107 }
 108
 109 static inline u32 get_beacon_timestamp_lo(u8 *data)
 110 {
 111         u32 time_stamp = 0;
 112         u32 index    = MAC_HDR_LEN;
 113
 114         time_stamp |= data[index++];
 115         time_stamp |= (data[index++] << 8);
 116         time_stamp |= (data[index++] << 16);
 117         time_stamp |= (data[index]   << 24);
 118
 119         return time_stamp;
 120 }
 121
 122 static inline u32 get_beacon_timestamp_hi(u8 *data)
 123 {
 124         u32 time_stamp = 0;
 125         u32 index    = (MAC_HDR_LEN + 4);
 126
 127         time_stamp |= data[index++];
 128         time_stamp |= (data[index++] << 8);
 129         time_stamp |= (data[index++] << 16);
 130         time_stamp |= (data[index]   << 24);
 131
 132         return time_stamp;
 133 }
 134
 135 static inline enum sub_frame_type get_sub_type(u8 *header)
 136 {
 137         return ((enum sub_frame_type)(header[0] & 0xFC));
 138 }
 139
 140 static inline u8 get_to_ds(u8 *header)
 141 {
 142         return (header[1] & 0x01);
 143 }
 144
 145 static inline u8 get_from_ds(u8 *header)
 146 {
 147         return ((header[1] & 0x02) >> 1);
 148 }
 149
 150 static inline void get_address1(u8 *pu8msa, u8 *addr)
 151 {
 152         memcpy(addr, pu8msa + 4, 6);
 153 }
 154
 155 static inline void get_address2(u8 *pu8msa, u8 *addr)
 156 {
 157         memcpy(addr, pu8msa + 10, 6);
 158 }
 159
 160 static inline void get_address3(u8 *pu8msa, u8 *addr)
 161 {
 162         memcpy(addr, pu8msa + 16, 6);
 163 }
 164
 165 static inline void get_BSSID(u8 *data, u8 *bssid)
 166 {
 167         if (get_from_ds(data) == 1)
 168                 get_address2(data, bssid);
 169         else if (get_to_ds(data) == 1)
 170                 get_address1(data, bssid);
 171         else
 172                 get_address3(data, bssid);
 173 }
 174
 175 static inline void get_ssid(u8 *data, u8 *ssid, u8 *p_ssid_len)
 176 {
 177         u8 len = 0;
 178         u8 i   = 0;
 179         u8 j   = 0;
 180
 181         len = data[MAC_HDR_LEN + TIME_STAMP_LEN + BEACON_INTERVAL_LEN +
 182                    CAP_INFO_LEN + 1];
 183         j   = MAC_HDR_LEN + TIME_STAMP_LEN + BEACON_INTERVAL_LEN +
 184                 CAP_INFO_LEN + 2;
 185
 186         if (len >= MAX_SSID_LEN)
 187                 len = 0;
 188
 189         for (i = 0; i < len; i++, j++)
 190                 ssid[i] = data[j];
 191
 192         ssid[len] = '\0';
 193
 194         *p_ssid_len = len;
 195 }
 196
 197 static inline u16 get_cap_info(u8 *data)
 198 {
 199         u16 cap_info = 0;
 200         u16 index    = MAC_HDR_LEN;
 201         enum sub_frame_type st;
 202
 203         st = get_sub_type(data);
 204
 205         if ((st == BEACON) || (st == PROBE_RSP))
 206                 index += TIME_STAMP_LEN + BEACON_INTERVAL_LEN;
 207
 208         cap_info  = data[index];
 209         cap_info |= (data[index + 1] << 8);
 210
 211         return cap_info;
 212 }
 213
 214 static inline u16 get_assoc_resp_cap_info(u8 *data)
 215 {
 216         u16 cap_info;
 217
 218         cap_info  = data[0];
 219         cap_info |= (data[1] << 8);
 220
 221         return cap_info;
 222 }
 223
 224 static inline u16 get_asoc_status(u8 *data)
 225 {
 226         u16 asoc_status;
 227
 228         asoc_status = data[3];
 229         asoc_status = (asoc_status << 8) | data[2];
 230
 231         return asoc_status;
 232 }
 233
 234 static inline u16 get_asoc_id(u8 *data)
 235 {
 236         u16 asoc_id;
 237
 238         asoc_id  = data[4];
 239         asoc_id |= (data[5] << 8);
 240
 241         return asoc_id;
 242 }
 243
 244 static u8 *get_tim_elm(u8 *pu8msa, u16 rx_len, u16 tag_param_offset)
 245 {
 246         u16 index;
 247
 248         index = tag_param_offset;
 249
 250         while (index < (rx_len - FCS_LEN)) {
 251                 if (pu8msa[index] == ITIM)
 252                         return &pu8msa[index];
 253                 index += (IE_HDR_LEN + pu8msa[index + 1]);
 254         }
 255
 256         return NULL;
 257 }
 258
 259 static u8 get_current_channel_802_11n(u8 *pu8msa, u16 rx_len)
 260 {
 261         u16 index;
 262
 263         index = TAG_PARAM_OFFSET;
 264         while (index < (rx_len - FCS_LEN)) {
 265                 if (pu8msa[index] == IDSPARMS)
 266                         return pu8msa[index + 2];
 267                 index += pu8msa[index + 1] + IE_HDR_LEN;
 268         }
 269
 270         return 0;
 271 }
 272
 273 s32 wilc_parse_network_info(u8 *msg_buffer,
 274                             struct network_info **ret_network_info)
 275 {
 276         struct network_info *network_info = NULL;
 277         u8 msg_type = 0;
 278         u8 msg_id = 0;
 279         u16 msg_len = 0;
 280
 281         u16 wid_id = (u16)WID_NIL;
 282         u16 wid_len  = 0;
 283         u8 *wid_val = NULL;
 284
 285         msg_type = msg_buffer[0];
 286
 287         if ('N' != msg_type) {
 288                 PRINT_ER("Received Message format incorrect.\n");
 289                 return -EFAULT;
 290         }
 291
 292         msg_id = msg_buffer[1];
 293         msg_len = MAKE_WORD16(msg_buffer[2], msg_buffer[3]);
 294         wid_id = MAKE_WORD16(msg_buffer[4], msg_buffer[5]);
 295         wid_len = MAKE_WORD16(msg_buffer[6], msg_buffer[7]);
 296         wid_val = &msg_buffer[8];
 297
 298         {
 299                 u8 *msa = NULL;
 300                 u16 rx_len = 0;
 301                 u8 *tim_elm = NULL;
 302                 u8 *ies = NULL;
 303                 u16 ies_len = 0;
 304                 u8 index = 0;
 305                 u32 tsf_lo;
 306                 u32 tsf_hi;
 307
 308                 network_info = kzalloc(sizeof(*network_info), GFP_KERNEL);
 309                 if (!network_info)
 310                         return -ENOMEM;
 311
 312                 network_info->rssi = wid_val[0];
 313
 314                 msa = &wid_val[1];
 315
 316                 rx_len = wid_len - 1;
 317                 network_info->cap_info = get_cap_info(msa);
 318                 network_info->tsf_lo = get_beacon_timestamp_lo(msa);
 319
 320                 tsf_lo = get_beacon_timestamp_lo(msa);
 321                 tsf_hi = get_beacon_timestamp_hi(msa);
 322
 323                 network_info->tsf_hi = tsf_lo | ((u64)tsf_hi << 32);
 324
 325                 get_ssid(msa, network_info->ssid, &network_info->ssid_len);
 326                 get_BSSID(msa, network_info->bssid);
 327
 328                 network_info->ch = get_current_channel_802_11n(msa,
 329                                                         rx_len + FCS_LEN);
 330
 331                 index = MAC_HDR_LEN + TIME_STAMP_LEN;
 332
 333                 network_info->beacon_period = get_beacon_period(msa + index);
 334
 335                 index += BEACON_INTERVAL_LEN + CAP_INFO_LEN;
 336
 337                 tim_elm = get_tim_elm(msa, rx_len + FCS_LEN, index);
 338                 if (tim_elm)
 339                         network_info->dtim_period = tim_elm[3];
 340                 ies = &msa[MAC_HDR_LEN + TIME_STAMP_LEN + BEACON_INTERVAL_LEN +
 341                            CAP_INFO_LEN];
 342                 ies_len = rx_len - (MAC_HDR_LEN + TIME_STAMP_LEN +
 343                                     BEACON_INTERVAL_LEN + CAP_INFO_LEN);
 344
 345                 if (ies_len > 0) {
 346                         network_info->ies = kmemdup(ies, ies_len, GFP_KERNEL);
 347                         if (!network_info->ies)
 348                                 return -ENOMEM;
 349                 }
 350                 network_info->ies_len = ies_len;
 351         }
 352
 353         *ret_network_info = network_info;
 354
 355         return 0;
 356 }
 357
 358 s32 wilc_parse_assoc_resp_info(u8 *buffer, u32 buffer_len,
 359                                struct connect_resp_info **ret_connect_resp_info)
 360 {
 361         struct connect_resp_info *connect_resp_info = NULL;
 362         u16 assoc_resp_len = 0;
 363         u8 *ies = NULL;
 364         u16 ies_len = 0;
 365
 366         connect_resp_info = kzalloc(sizeof(*connect_resp_info), GFP_KERNEL);
 367         if (!connect_resp_info)
 368                 return -ENOMEM;
 369
 370         assoc_resp_len = (u16)buffer_len;
 371
 372         connect_resp_info->status = get_asoc_status(buffer);
 373         if (connect_resp_info->status == SUCCESSFUL_STATUSCODE) {
 374                 connect_resp_info->capability = get_assoc_resp_cap_info(buffer);
 375                 connect_resp_info->assoc_id = get_asoc_id(buffer);
 376
 377                 ies = &buffer[CAP_INFO_LEN + STATUS_CODE_LEN + AID_LEN];
 378                 ies_len = assoc_resp_len - (CAP_INFO_LEN + STATUS_CODE_LEN +
 379                                             AID_LEN);
 380
 381                 connect_resp_info->ies = kmemdup(ies, ies_len, GFP_KERNEL);
 382                 if (!connect_resp_info->ies)
 383                         return -ENOMEM;
 384
 385                 connect_resp_info->ies_len = ies_len;
 386         }
 387
 388         *ret_connect_resp_info = connect_resp_info;
 389
 390         return 0;
 391 }