Changes in uspace/lib/ieee80211/src/ieee80211.c [a35b458:1b20da0] in mainline

File:

• uspace/lib/ieee80211/src/ieee80211.c (modified) (92 diffs)

uspace/lib/ieee80211/src/ieee80211.c

@@ -72 +72 @@
 {
         frame_ctrl = uint16_t_le2host(frame_ctrl);
-
+        
         return (frame_ctrl & IEEE80211_FRAME_CTRL_FRAME_TYPE) ==
             IEEE80211_DATA_FRAME;
@@ -87 +87 @@
 {
         frame_ctrl = uint16_t_le2host(frame_ctrl);
-
+        
         return (frame_ctrl & IEEE80211_FRAME_CTRL_FRAME_TYPE) ==
             IEEE80211_MGMT_FRAME;
@@ -102 +102 @@
 {
         frame_ctrl = uint16_t_le2host(frame_ctrl);
-
+        
         return (frame_ctrl & IEEE80211_FRAME_CTRL_FRAME_SUBTYPE) ==
             IEEE80211_MGMT_BEACON_FRAME;
@@ -117 +117 @@
 {
         frame_ctrl = uint16_t_le2host(frame_ctrl);
-
+        
         return (frame_ctrl & IEEE80211_FRAME_CTRL_FRAME_SUBTYPE) ==
             IEEE80211_MGMT_PROBE_RESP_FRAME;
@@ -132 +132 @@
 {
         frame_ctrl = uint16_t_le2host(frame_ctrl);
-
+        
         return (frame_ctrl & IEEE80211_FRAME_CTRL_FRAME_SUBTYPE) ==
             IEEE80211_MGMT_AUTH_FRAME;
@@ -147 +147 @@
 {
         frame_ctrl = uint16_t_le2host(frame_ctrl);
-
+        
         return (frame_ctrl & IEEE80211_FRAME_CTRL_FRAME_SUBTYPE) ==
             IEEE80211_MGMT_ASSOC_RESP_FRAME;
@@ -162 +162 @@
 {
         frame_ctrl = uint16_t_le2host(frame_ctrl);
-
+        
         return (frame_ctrl & IEEE80211_FRAME_CTRL_TODS);
 }
@@ -176 +176 @@
 {
         frame_ctrl = uint16_t_le2host(frame_ctrl);
-
+        
         return (frame_ctrl & IEEE80211_FRAME_CTRL_FROMDS);
 }
@@ -190 +190 @@
 {
         frame_ctrl = uint16_t_le2host(frame_ctrl);
-
+        
         return (frame_ctrl & (IEEE80211_FRAME_CTRL_FRAME_TYPE | 0x40)) ==
             IEEE80211_DATA_FRAME;
@@ -205 +205 @@
 {
         frame_ctrl = uint16_t_le2host(frame_ctrl);
-
+        
         return (frame_ctrl & IEEE80211_FRAME_CTRL_PROTECTED);
 }
@@ -233 +233 @@
         uint16_t ret_val = ieee80211_dev->sequence_number;
         ieee80211_dev->sequence_number += (1 << 4);
-
+        
         return ret_val;
 }
@@ -286 +286 @@
         ieee80211_operating_mode_t op_mode = ieee80211_dev->current_op_mode;
         fibril_mutex_unlock(&ieee80211_dev->gen_mutex);
-
+        
         return op_mode;
 }
@@ -302 +302 @@
         uint16_t current_freq = ieee80211_dev->current_freq;
         fibril_mutex_unlock(&ieee80211_dev->gen_mutex);
-
+        
         return current_freq;
 }
@@ -318 +318 @@
 {
         fibril_mutex_lock(&ieee80211_dev->gen_mutex);
-
+        
         if (bssid) {
                 ieee80211_scan_result_link_t *res_link =
                     ieee80211_dev->bssid_info.res_link;
-
+                
                 if (res_link) {
                         memcpy(bssid, &res_link->scan_result.bssid,
@@ -333 +333 @@
                 }
         }
-
+        
         fibril_mutex_unlock(&ieee80211_dev->gen_mutex);
 }
@@ -349 +349 @@
         uint16_t aid = ieee80211_dev->bssid_info.aid;
         fibril_mutex_unlock(&ieee80211_dev->gen_mutex);
-
+        
         return aid;
 }
@@ -367 +367 @@
         int suite = auth_link->scan_result.security.pair_alg;
         fibril_mutex_unlock(&ieee80211_dev->gen_mutex);
-
+        
         return suite;
 }
@@ -384 +384 @@
             ieee80211_dev->current_auth_phase == IEEE80211_AUTH_CONNECTED;
         fibril_mutex_unlock(&ieee80211_dev->gen_mutex);
-
+        
         return conn_state;
 }
@@ -401 +401 @@
         ieee80211_auth_phase_t conn_state = ieee80211_dev->current_auth_phase;
         fibril_mutex_unlock(&ieee80211_dev->gen_mutex);
-
+        
         return conn_state;
 }
@@ -418 +418 @@
         ieee80211_dev->pending_conn_req = false;
         fibril_mutex_unlock(&ieee80211_dev->gen_mutex);
-
+        
         return conn_request;
 }
@@ -462 +462 @@
         bool ready_state = ieee80211_dev->ready;
         fibril_mutex_unlock(&ieee80211_dev->gen_mutex);
-
+        
         return ready_state;
 }
@@ -484 +484 @@
         bool using_key = ieee80211_dev->using_hw_key;
         fibril_mutex_unlock(&ieee80211_dev->gen_mutex);
-
+        
         return using_key;
 }
@@ -499 +499 @@
 {
         assert(arg);
-
+        
         ieee80211_dev_t *ieee80211_dev = (ieee80211_dev_t *) arg;
-
+        
         while (true) {
                 ieee80211_dev->ops->scan(ieee80211_dev);
                 async_usleep(SCAN_PERIOD_USEC);
         }
-
+        
         return EOK;
 }
@@ -521 +521 @@
         nic_t *nic_data = nic_get_from_ddf_fun(fun);
         ieee80211_dev_t *ieee80211_dev = nic_get_specific(nic_data);
-
+        
         if (ieee80211_dev->started)
                 return EOK;
-
+        
         ieee80211_dev->started = true;
-
+        
         errno_t rc = ieee80211_dev->ops->start(ieee80211_dev);
         if (rc != EOK)
                 return rc;
-
+        
         /* Add scanning fibril. */
         fid_t fibril = fibril_create(ieee80211_scan, ieee80211_dev);
         if (fibril == 0)
                 return ENOMEM;
-
+        
         fibril_add_ready(fibril);
-
+        
         return EOK;
 }
@@ -552 +552 @@
         ieee80211_dev_t *ieee80211_dev = (ieee80211_dev_t *)
             nic_get_specific(nic);
-
+        
         ieee80211_auth_phase_t auth_phase =
             ieee80211_get_auth_phase(ieee80211_dev);
@@ -558 +558 @@
             (auth_phase != IEEE80211_AUTH_CONNECTED))
                 return;
-
+        
         ieee80211_scan_result_t *auth_data =
             &ieee80211_dev->bssid_info.res_link->scan_result;
-
+        
         /* We drop part of IEEE 802.3 ethernet header. */
         size_t drop_bytes = sizeof(eth_header_t) - 2;
-
+        
         size_t complete_size = (size - drop_bytes) +
             sizeof(ieee80211_data_header_t) +
             ARRAY_SIZE(rfc1042_header);
-
+        
         /* Init crypto data. */
         bool add_mic = false;
@@ -575 +575 @@
         uint8_t head_data[head_space];
         memset(head_data, 0, head_space);
-
+        
         // TODO: Distinguish used key (pair/group) by dest address ?
         if (ieee80211_query_using_key(ieee80211_dev)) {
@@ -592 +592 @@
                         break;
                 }
-
+                
                 crypto = uint16_t_le2host(IEEE80211_FRAME_CTRL_PROTECTED);
         }
-
+        
         complete_size += head_space + mic_space;
-
+        
         void *complete_buffer = malloc(complete_size);
         if (!complete_buffer)
                 return;
-
+        
         memset(complete_buffer, 0, complete_size);
-
+        
         if (head_space)
                 memcpy(complete_buffer + sizeof(ieee80211_data_header_t),
                     head_data, head_space);
-
+        
         memcpy(complete_buffer + sizeof(ieee80211_data_header_t) + head_space,
             rfc1042_header, ARRAY_SIZE(rfc1042_header));
-
+        
         memcpy(complete_buffer + sizeof(ieee80211_data_header_t) +
             ARRAY_SIZE(rfc1042_header) + head_space,
             data + drop_bytes, size - drop_bytes);
-
+        
         ieee80211_data_header_t *data_header =
             (ieee80211_data_header_t *) complete_buffer;
@@ -623 +623 @@
             crypto;
         data_header->seq_ctrl = ieee80211_get_sequence_number(ieee80211_dev);
-
+        
         /* BSSID, SA, DA. */
         memcpy(data_header->address1, auth_data->bssid.address, ETH_ADDR);
         memcpy(data_header->address2, data + ETH_ADDR, ETH_ADDR);
         memcpy(data_header->address3, data, ETH_ADDR);
-
+        
         if (add_mic) {
                 size_t size_wo_mic = complete_size - MIC_LENGTH;
@@ -636 +636 @@
                     complete_buffer + size_wo_mic);
         }
-
+        
         ieee80211_dev->ops->tx_handler(ieee80211_dev,
             complete_buffer, complete_size);
-
+        
         free(complete_buffer);
 }
@@ -662 +662 @@
                 if (!ieee80211_ops->start)
                         ieee80211_ops->start = ieee80211_start_impl;
-
+                
                 if (!ieee80211_ops->tx_handler)
                         ieee80211_ops->tx_handler = ieee80211_tx_handler_impl;
-
+                
                 if (!ieee80211_ops->set_freq)
                         ieee80211_ops->set_freq = ieee80211_set_freq_impl;
-
+                
                 if (!ieee80211_ops->bssid_change)
                         ieee80211_ops->bssid_change = ieee80211_bssid_change_impl;
-
+                
                 if (!ieee80211_ops->key_config)
                         ieee80211_ops->key_config = ieee80211_key_config_impl;
-
+                
                 if (!ieee80211_ops->scan)
                         ieee80211_ops->scan = ieee80211_scan_impl;
         } else
                 return EINVAL;
-
+        
         ieee80211_dev->ops = ieee80211_ops;
-
+        
         if (ieee80211_iface) {
                 if (nic_dev_ops)
@@ -687 +687 @@
                                 nic_dev_ops->interfaces[IEEE80211_DEV_IFACE] =
                                     ieee80211_iface;
-
+                
                 if (!ieee80211_iface->get_scan_results)
                         ieee80211_iface->get_scan_results =
                             ieee80211_get_scan_results_impl;
-
+                
                 if (!ieee80211_iface->connect)
                         ieee80211_iface->connect = ieee80211_connect_impl;
-
+                
                 if (!ieee80211_iface->disconnect)
                         ieee80211_iface->disconnect = ieee80211_disconnect_impl;
         } else
                 return EINVAL;
-
+        
         if (nic_dev_ops) {
                 if (!nic_dev_ops->open)
@@ -705 +705 @@
         } else
                 return EINVAL;
-
+        
         ieee80211_dev->iface = ieee80211_iface;
-
+        
         nic_driver_implement(NULL, nic_dev_ops, nic_iface);
-
+        
         return EOK;
 }
@@ -740 +740 @@
         ieee80211_dev->current_op_mode = IEEE80211_OPMODE_STATION;
         ieee80211_dev->current_auth_phase = IEEE80211_AUTH_DISCONNECTED;
-
+        
         memcpy(ieee80211_dev->bssid_mask.address, ieee80211_broadcast_mac_addr,
             ETH_ADDR);
-
+        
         ieee80211_scan_result_list_init(&ieee80211_dev->ap_list);
-
+        
         fibril_mutex_initialize(&ieee80211_dev->scan_mutex);
         fibril_mutex_initialize(&ieee80211_dev->gen_mutex);
         fibril_condvar_initialize(&ieee80211_dev->gen_cond);
-
+        
         /* Bind NIC to device */
         nic_t *nic = nic_create_and_bind(ddf_dev);
         if (!nic)
                 return ENOMEM;
-
+        
         nic_set_specific(nic, ieee80211_dev);
-
+        
         return EOK;
 }
@@ -780 +780 @@
         if (rc != EOK)
                 return rc;
-
+        
         nic_t *nic = nic_get_from_ddf_dev(ieee80211_dev->ddf_dev);
-
+        
         /* TODO: Set NIC handlers here. */
         nic_set_send_frame_handler(nic, ieee80211_send_frame);
-
+        
         ddf_fun_t *fun = ddf_fun_create(ieee80211_dev->ddf_dev, fun_exposed,
             "port0");
         if (fun == NULL)
                 return EINVAL;
-
+        
         nic_set_ddf_fun(nic, fun);
         ddf_fun_set_ops(fun, ieee80211_nic_dev_ops);
-
+        
         rc = ddf_fun_bind(fun);
         if (rc != EOK) {
@@ -799 +799 @@
                 return rc;
         }
-
+        
         rc = ddf_fun_add_to_category(fun, DEVICE_CATEGORY_NIC);
         if (rc != EOK) {
@@ -805 +805 @@
                 return rc;
         }
-
+        
         rc = ddf_fun_add_to_category(fun, DEVICE_CATEGORY_IEEE80211);
         if (rc != EOK) {
@@ -811 +811 @@
                 return rc;
         }
-
+        
         return EOK;
 }
@@ -832 +832 @@
         ieee80211_ie_header_t *header =
             (ieee80211_ie_header_t *) *ie_header;
-
+        
         header->element_id = id;
         header->length = length;
-
+        
         memcpy(*ie_header + sizeof(ieee80211_ie_header_t), data, length);
-
+        
         *ie_header = (void *) ((void *) header +
             sizeof(ieee80211_ie_header_t) + length);
@@ -855 +855 @@
         nic_address_t nic_address;
         nic_query_address(nic, &nic_address);
-
+        
         size_t ssid_data_size = (ssid != NULL) ? str_size(ssid) : 0;
         size_t channel_data_size = 1;
-
+        
         uint8_t channel =
             ieee80211_freq_to_channel(ieee80211_dev->current_freq);
-
+        
         /*
          * 4 headers - (ssid, rates, ext rates, current channel)
@@ -871 +871 @@
             IEEE80211_DATA_RATES_SIZE + IEEE80211_EXT_DATA_RATES_SIZE +
             channel_data_size;
-
+        
         size_t buffer_size = sizeof(ieee80211_mgmt_header_t) + payload_size;
         void *buffer = malloc(buffer_size);
         if (!buffer)
                 return ENOMEM;
-
+        
         memset(buffer, 0, buffer_size);
-
+        
         ieee80211_mgmt_header_t *mgmt_header =
             (ieee80211_mgmt_header_t *) buffer;
-
+        
         mgmt_header->frame_ctrl =
             host2uint16_t_le(IEEE80211_MGMT_FRAME |
@@ -890 +890 @@
         mgmt_header->seq_ctrl =
             host2uint16_t_le(ieee80211_get_sequence_number(ieee80211_dev));
-
+        
         /* Jump to payload. */
         void *it = (void *) buffer + sizeof(ieee80211_mgmt_header_t);
@@ -902 +902 @@
         ieee80211_prepare_ie_header(&it, IEEE80211_CHANNEL_IE,
             channel_data_size, (void *) &channel);
-
+        
         ieee80211_dev->ops->tx_handler(ieee80211_dev, buffer, buffer_size);
-
+        
         free(buffer);
-
+        
         return EOK;
 }
@@ -922 +922 @@
         nic_address_t nic_address;
         nic_query_address(nic, &nic_address);
-
+        
         ieee80211_scan_result_t *auth_data =
             &ieee80211_dev->bssid_info.res_link->scan_result;
-
+        
         size_t buffer_size = sizeof(ieee80211_mgmt_header_t) +
             sizeof(ieee80211_auth_body_t);
-
+        
         void *buffer = malloc(buffer_size);
         if (!buffer)
                 return ENOMEM;
-
+        
         memset(buffer, 0, buffer_size);
-
+        
         ieee80211_mgmt_header_t *mgmt_header =
             (ieee80211_mgmt_header_t *) buffer;
-
+        
         mgmt_header->frame_ctrl =
             host2uint16_t_le(IEEE80211_MGMT_FRAME |
@@ -944 +944 @@
         memcpy(mgmt_header->src_addr, nic_address.address, ETH_ADDR);
         memcpy(mgmt_header->bssid, auth_data->bssid.address, ETH_ADDR);
-
+        
         ieee80211_auth_body_t *auth_body =
             (ieee80211_auth_body_t *)
@@ -950 +950 @@
         auth_body->auth_alg = host2uint16_t_le(0);
         auth_body->auth_trans_no = host2uint16_t_le(1);
-
+        
         ieee80211_dev->ops->tx_handler(ieee80211_dev, buffer, buffer_size);
-
+        
         free(buffer);
-
+        
         return EOK;
 }
@@ -972 +972 @@
         nic_address_t nic_address;
         nic_query_address(nic, &nic_address);
-
+        
         ieee80211_scan_result_link_t *auth_link =
             ieee80211_dev->bssid_info.res_link;
-
+        
         ieee80211_scan_result_t *auth_data = &auth_link->scan_result;
-
+        
         size_t ssid_data_size = str_size(auth_data->ssid);
-
+        
         size_t payload_size =
             sizeof(ieee80211_ie_header_t) * 3 +
@@ -985 +985 @@
             IEEE80211_DATA_RATES_SIZE +
             IEEE80211_EXT_DATA_RATES_SIZE;
-
+        
         size_t buffer_size =
             sizeof(ieee80211_mgmt_header_t) +
             sizeof(ieee80211_assoc_req_body_t) +
             payload_size;
-
+        
         if ((auth_data->security.type == IEEE80211_SECURITY_WPA) ||
             (auth_data->security.type == IEEE80211_SECURITY_WPA2))
                 buffer_size += auth_link->auth_ie_len;
-
+        
         void *buffer = malloc(buffer_size);
         if (!buffer)
                 return ENOMEM;
-
+        
         memset(buffer, 0, buffer_size);
-
+        
         ieee80211_mgmt_header_t *mgmt_header =
             (ieee80211_mgmt_header_t *) buffer;
-
+        
         mgmt_header->frame_ctrl =
             host2uint16_t_le(IEEE80211_MGMT_FRAME |
@@ -1010 +1010 @@
         memcpy(mgmt_header->src_addr, nic_address.address, ETH_ADDR);
         memcpy(mgmt_header->bssid, auth_data->bssid.address, ETH_ADDR);
-
+        
         ieee80211_assoc_req_body_t *assoc_body =
             (ieee80211_assoc_req_body_t *)
             (buffer + sizeof(ieee80211_mgmt_header_t));
         assoc_body->listen_interval = host2uint16_t_le(1);
-
+        
         /* Jump to payload. */
         void *it = buffer + sizeof(ieee80211_mgmt_header_t) +
@@ -1026 +1026 @@
             IEEE80211_EXT_DATA_RATES_SIZE,
             (void *) &ieee80211bg_data_rates[IEEE80211_DATA_RATES_SIZE]);
-
+        
         if (auth_data->security.type != IEEE80211_SECURITY_OPEN)
                 assoc_body->capability |= host2uint16_t_le(CAP_SECURITY);
-
+        
         if ((auth_data->security.type == IEEE80211_SECURITY_WPA) ||
             (auth_data->security.type == IEEE80211_SECURITY_WPA2))
                 memcpy(it, auth_link->auth_ie, auth_link->auth_ie_len);
-
+        
         ieee80211_dev->ops->tx_handler(ieee80211_dev, buffer, buffer_size);
-
+        
         /*
          * Save password to be used in eventual authentication handshake.
@@ -1042 +1042 @@
         memcpy(ieee80211_dev->bssid_info.password, password,
             str_size(password));
-
+        
         free(buffer);
-
+        
         return EOK;
 }
@@ -1061 +1061 @@
         ieee80211_scan_result_t *auth_data =
             &ieee80211_dev->bssid_info.res_link->scan_result;
-
+        
         nic_t *nic = nic_get_from_ddf_dev(ieee80211_dev->ddf_dev);
         nic_address_t nic_address;
         nic_query_address(nic, &nic_address);
-
+        
         size_t buffer_size = sizeof(ieee80211_mgmt_header_t) +
             sizeof(ieee80211_deauth_body_t);
-
+        
         void *buffer = malloc(buffer_size);
         if (!buffer)
                 return ENOMEM;
-
+        
         memset(buffer, 0, buffer_size);
-
+        
         ieee80211_mgmt_header_t *mgmt_header =
             (ieee80211_mgmt_header_t *) buffer;
-
+        
         mgmt_header->frame_ctrl =
             host2uint16_t_le(IEEE80211_MGMT_FRAME |
@@ -1084 +1084 @@
         memcpy(mgmt_header->src_addr, nic_address.address, ETH_ADDR);
         memcpy(mgmt_header->bssid, auth_data->bssid.address, ETH_ADDR);
-
+        
         ieee80211_dev->ops->tx_handler(ieee80211_dev, buffer, buffer_size);
-
+        
         free(buffer);
-
+        
         ieee80211_dev->bssid_info.res_link = NULL;
         ieee80211_dev->ops->bssid_change(ieee80211_dev, false);
-
+        
         if (ieee80211_query_using_key(ieee80211_dev))
                 ieee80211_dev->ops->key_config(ieee80211_dev, NULL, false);
-
+        
         ieee80211_set_auth_phase(ieee80211_dev, IEEE80211_AUTH_DISCONNECTED);
-
+        
         return EOK;
 }
@@ -1104 +1104 @@
 {
         uint8_t *it = (uint8_t *) buffer;
-
+        
         uint16_t *version = (uint16_t *) it;
         if (uint16_t_le2host(*version) != 0x1) {
@@ -1110 +1110 @@
                 return;
         }
-
+        
         it += sizeof(uint16_t);
-
+        
         uint32_t group_cipher = *(it + 3);
         switch (group_cipher) {
@@ -1126 +1126 @@
                 ap_data->scan_result.security.group_alg = -1;
         }
-
+        
         it += 4 * sizeof(uint8_t);
-
+        
         uint16_t *pairwise_count = (uint16_t *) it;
         uint32_t pairwise_cipher = *(it + sizeof(uint16_t) + 3);
@@ -1143 +1143 @@
                 ap_data->scan_result.security.pair_alg = -1;
         }
-
+        
         it += 2 * sizeof(uint16_t) +
             uint16_t_le2host(*pairwise_count) * sizeof(uint32_t);
-
+        
         uint32_t auth_suite = *(it + 3);
         switch (auth_suite) {
@@ -1167 +1167 @@
         ap_data->auth_ie_len = ie_header->length +
             sizeof(ieee80211_ie_header_t);
-
+        
         memcpy(ap_data->auth_ie, it, ap_data->auth_ie_len);
 }
@@ -1180 +1180 @@
                 uint8_t *channel;
                 uint32_t oui;
-
+                
                 switch (ie_header->element_id) {
                 case IEEE80211_CHANNEL_IE:
                         if (!ap_data)
                                 break;
-
+                        
                         channel = (uint8_t *)
                             (it + sizeof(ieee80211_ie_header_t));
@@ -1193 +1193 @@
                         if (!ap_data)
                                 break;
-
+                        
                         ap_data->scan_result.security.type =
                             IEEE80211_SECURITY_WPA2;
@@ -1203 +1203 @@
                         oui = uint32be_from_seq(it +
                             sizeof(ieee80211_ie_header_t));
-
+                        
                         if (oui == WPA_OUI) {
                                 if (!ap_data)
                                         break;
-
+                                
                                 /* Prefering WPA2. */
                                 if (ap_data->scan_result.security.type ==
                                     IEEE80211_SECURITY_WPA2)
                                         break;
-
+                                
                                 ap_data->scan_result.security.type =
                                     IEEE80211_SECURITY_WPA;
-
+                                
                                 ieee80211_process_auth_info(ap_data,
                                     it + sizeof(ieee80211_ie_header_t) +
@@ -1226 +1226 @@
                         }
                 }
-
+                
                 it += sizeof(ieee80211_ie_header_t) + ie_header->length;
         }
-
+        
         return NULL;
 }
@@ -1246 +1246 @@
         ieee80211_beacon_start_t *beacon_body = (ieee80211_beacon_start_t *)
             ((void *) mgmt_header + sizeof(ieee80211_mgmt_header_t));
-
+        
         ieee80211_ie_header_t *ssid_ie_header = (ieee80211_ie_header_t *)
             ((void *) beacon_body + sizeof(ieee80211_beacon_start_t));
-
+        
         /* Not empty SSID. */
         if (ssid_ie_header->length > 0) {
                 ieee80211_scan_result_list_t *result_list =
                     &ieee80211_dev->ap_list;
-
+                
                 uint8_t *ssid_start = (uint8_t *) ((void *) ssid_ie_header +
                     sizeof(ieee80211_ie_header_t));
                 char ssid[IEEE80211_MAX_SSID_LENGTH];
-
+                
                 memcpy(ssid, ssid_start, ssid_ie_header->length);
                 ssid[ssid_ie_header->length] = '\0';
-
+                
                 /* Check whether SSID is already in results. */
                 ieee80211_scan_result_list_foreach(*result_list, result) {
@@ -1269 +1269 @@
                         }
                 }
-
+                
                 /* Results are full. */
                 if (result_list->size == IEEE80211_MAX_RESULTS_LENGTH - 1)
                         return EOK;
-
+                
                 ieee80211_scan_result_link_t *ap_data =
                     malloc(sizeof(ieee80211_scan_result_link_t));
                 if (!ap_data)
                         return ENOMEM;
-
+                
                 memset(ap_data, 0, sizeof(ieee80211_scan_result_link_t));
                 link_initialize(&ap_data->link);
-
+                
                 memcpy(ap_data->scan_result.bssid.address,
                     mgmt_header->bssid, ETH_ADDR);
                 memcpy(ap_data->scan_result.ssid, ssid,
                     ssid_ie_header->length + 1);
-
+                
                 if (uint16_t_le2host(beacon_body->capability) & CAP_SECURITY) {
                         ap_data->scan_result.security.type =
@@ -1297 +1297 @@
                         ap_data->scan_result.security.group_alg = -1;
                 }
-
+                
                 void *rest_ies_start = ssid_start + ssid_ie_header->length;
                 size_t rest_buffer_size =
@@ -1305 +1305 @@
                     sizeof(ieee80211_ie_header_t) -
                     ssid_ie_header->length;
-
+                
                 ieee80211_process_ies(ieee80211_dev, ap_data, rest_ies_start,
                     rest_buffer_size);
-
+                
                 ap_data->last_beacon = time(NULL);
-
+                
                 fibril_mutex_lock(&ieee80211_dev->ap_list.results_mutex);
                 ieee80211_scan_result_list_append(result_list, ap_data);
                 fibril_mutex_unlock(&ieee80211_dev->ap_list.results_mutex);
         }
-
+        
         return EOK;
 }
@@ -1333 +1333 @@
             (ieee80211_auth_body_t *)
             ((void *) mgmt_header + sizeof(ieee80211_mgmt_header_t));
-
+        
         if (auth_body->status != 0)
                 ieee80211_set_auth_phase(ieee80211_dev,
@@ -1340 +1340 @@
                 ieee80211_set_auth_phase(ieee80211_dev,
                     IEEE80211_AUTH_AUTHENTICATED);
-
+        
         fibril_mutex_lock(&ieee80211_dev->gen_mutex);
         fibril_condvar_signal(&ieee80211_dev->gen_cond);
         fibril_mutex_unlock(&ieee80211_dev->gen_mutex);
-
+        
         return EOK;
 }
@@ -1362 +1362 @@
             (ieee80211_assoc_resp_body_t *) ((void *) mgmt_header +
             sizeof(ieee80211_mgmt_header_t));
-
+        
         if (assoc_resp->status != 0)
                 ieee80211_set_auth_phase(ieee80211_dev,
@@ -1373 +1373 @@
                 ieee80211_dev->ops->bssid_change(ieee80211_dev, true);
         }
-
+        
         fibril_mutex_lock(&ieee80211_dev->gen_mutex);
         fibril_condvar_signal(&ieee80211_dev->gen_cond);
         fibril_mutex_unlock(&ieee80211_dev->gen_mutex);
-
+        
         return EOK;
 }
@@ -1386 +1386 @@
         ieee80211_eapol_key_frame_t *key_frame =
             (ieee80211_eapol_key_frame_t *) buffer;
-
+        
         ieee80211_scan_result_link_t *auth_link =
             ieee80211_dev->bssid_info.res_link;
-
+        
         ieee80211_scan_result_t *auth_data = &auth_link->scan_result;
-
+        
         /* We don't support 802.1X authentication yet. */
         if (auth_data->security.auth == IEEE80211_AUTH_AKM_8021X)
                 return ENOTSUP;
-
+        
         uint8_t *ptk = ieee80211_dev->bssid_info.ptk;
         uint8_t *gtk = ieee80211_dev->bssid_info.gtk;
         uint8_t gtk_id = 1;
-
+        
         bool handshake_done = false;
-
+        
         bool old_wpa =
             auth_data->security.type == IEEE80211_SECURITY_WPA;
-
+        
         bool key_phase =
             uint16_t_be2host(key_frame->key_info) &
             IEEE80211_EAPOL_KEY_KEYINFO_MIC;
-
+        
         bool final_phase =
             uint16_t_be2host(key_frame->key_info) &
             IEEE80211_EAPOL_KEY_KEYINFO_SECURE;
-
+        
         bool ccmp_used =
             (auth_data->security.pair_alg == IEEE80211_SECURITY_SUITE_CCMP) ||
             (auth_data->security.group_alg == IEEE80211_SECURITY_SUITE_CCMP);
-
+        
         size_t ptk_key_length, gtk_key_length;
         hash_func_t mic_hash;
@@ -1423 +1423 @@
         else
                 mic_hash = HASH_MD5;
-
+        
         if (auth_data->security.pair_alg == IEEE80211_SECURITY_SUITE_CCMP)
                 ptk_key_length = IEEE80211_PTK_CCMP_LENGTH;
         else
                 ptk_key_length = IEEE80211_PTK_TKIP_LENGTH;
-
+        
         if (auth_data->security.group_alg == IEEE80211_SECURITY_SUITE_CCMP)
                 gtk_key_length = IEEE80211_GTK_CCMP_LENGTH;
         else
                 gtk_key_length = IEEE80211_GTK_TKIP_LENGTH;
-
+        
         size_t output_size =
             sizeof(eth_header_t) +
             sizeof(ieee80211_eapol_key_frame_t);
-
+        
         if (!(uint16_t_be2host(key_frame->key_info) &
             IEEE80211_EAPOL_KEY_KEYINFO_MIC))
                 output_size += auth_link->auth_ie_len;
-
+        
         nic_t *nic = nic_get_from_ddf_dev(ieee80211_dev->ddf_dev);
         nic_address_t nic_address;
         nic_query_address(nic, &nic_address);
-
+        
         void *output_buffer = malloc(output_size);
         if (!output_buffer)
                 return ENOMEM;
-
+        
         memset(output_buffer, 0, output_size);
-
+        
         /* Setup ethernet header. */
         eth_header_t *eth_header = (eth_header_t *) output_buffer;
@@ -1457 +1457 @@
         memcpy(eth_header->src_addr, nic_address.address, ETH_ADDR);
         eth_header->proto = host2uint16_t_be(ETH_TYPE_PAE);
-
+        
         ieee80211_eapol_key_frame_t *output_key_frame =
             (ieee80211_eapol_key_frame_t *)
             (output_buffer + sizeof(eth_header_t));
-
+        
         /* Copy content of incoming EAPOL-Key frame. */
         memcpy((void *) output_key_frame, buffer,
             sizeof(ieee80211_eapol_key_frame_t));
-
+        
         output_key_frame->proto_version = 0x1;
         output_key_frame->body_length =
@@ -1471 +1471 @@
         output_key_frame->key_info &=
             ~host2uint16_t_be(IEEE80211_EAPOL_KEY_KEYINFO_ACK);
-
+        
         if (key_phase) {
                 output_key_frame->key_info &=
@@ -1482 +1482 @@
                 memset(output_key_frame->key_rsc, 0, 8);
                 memset(output_key_frame->eapol_key_iv, 0, 16);
-
+                
                 /* Derive GTK and save it. */
                 if (final_phase) {
@@ -1490 +1490 @@
                         uint8_t *data_ptr = (uint8_t *)
                             (buffer + sizeof(ieee80211_eapol_key_frame_t));
-
+                        
                         errno_t rc;
                         uint8_t work_key[32];
-
+                        
                         if (ccmp_used) {
                                 rc = ieee80211_aes_key_unwrap(ptk + KEK_OFFSET,
@@ -1503 +1503 @@
                                     data_ptr, key_data_length, key_data);
                         }
-
+                        
                         if (rc == EOK) {
                                 uint8_t *key_data_ptr = old_wpa ? key_data :
                                     ieee80211_process_ies(ieee80211_dev,
                                     NULL, key_data, key_data_length);
-
+                                
                                 if (key_data_ptr) {
                                         uint8_t *key_ptr;
-
+                                        
                                         if (old_wpa)
                                                 key_ptr = key_data_ptr;
@@ -1518 +1518 @@
                                                 key_ptr = key_data_ptr + 2;
                                         }
-
+                                        
                                         memcpy(gtk, key_ptr, gtk_key_length);
                                         handshake_done = true;
@@ -1532 +1532 @@
                     sizeof(ieee80211_eapol_key_frame_t),
                     auth_link->auth_ie, auth_link->auth_ie_len);
-
+                
                 /* Compute PMK. */
                 uint8_t pmk[PBKDF2_KEY_LENGTH];
@@ -1539 +1539 @@
                     (uint8_t *) auth_data->ssid,
                     str_size(auth_data->ssid), pmk);
-
+                
                 uint8_t *anonce = key_frame->key_nonce;
-
+                
                 /* Generate SNONCE. */
                 uint8_t snonce[32];
                 rnd_sequence(snonce, 32);
-
+                
                 memcpy(output_key_frame->key_nonce, snonce, 32);
-
+                
                 uint8_t *dest_addr = eth_header->dest_addr;
                 uint8_t *src_addr = eth_header->src_addr;
-
+                
                 /* Derive PTK and save it. */
                 uint8_t crypt_data[PRF_CRYPT_DATA_LENGTH];
@@ -1563 +1563 @@
                 ieee80211_prf(pmk, crypt_data, ptk, ptk_key_length);
         }
-
+        
         /* Compute MIC of key frame data from KCK part of PTK. */
         uint8_t mic[mic_hash];
         hmac(ptk, 16, (uint8_t *) output_key_frame,
             output_size - sizeof(eth_header_t), mic, mic_hash);
-
+        
         memcpy(output_key_frame->key_mic, mic, 16);
-
+        
         ieee80211_send_frame(nic, output_buffer, output_size);
-
+        
         free(output_buffer);
-
+        
         ieee80211_key_config_t key_config;
-
+        
         /* Insert Pairwise key. */
         if ((key_phase && old_wpa) || (final_phase && !old_wpa)) {
@@ -1584 +1584 @@
                 memcpy(key_config.data,
                     ptk + TK_OFFSET, ptk_key_length - TK_OFFSET);
-
+                
                 ieee80211_dev->ops->key_config(ieee80211_dev,
                     &key_config, true);
         }
-
+        
         /* Insert Group key. */
         if (final_phase) {
@@ -1595 +1595 @@
                 key_config.flags = IEEE80211_KEY_FLAG_TYPE_GROUP;
                 memcpy(key_config.data, gtk, gtk_key_length);
-
+                
                 ieee80211_dev->ops->key_config(ieee80211_dev,
                     &key_config, true);
         }
-
+        
         /* Signal successful handshake completion. */
         if (handshake_done) {
@@ -1606 +1606 @@
                 fibril_mutex_unlock(&ieee80211_dev->gen_mutex);
         }
-
+        
         return EOK;
 }
@@ -1615 +1615 @@
         ieee80211_eapol_key_frame_t *key_frame =
             (ieee80211_eapol_key_frame_t *) buffer;
-
+        
         if (ieee80211_is_eapol_key_frame(key_frame))
                 return ieee80211_process_4way_handshake(ieee80211_dev, buffer,
                     buffer_size);
-
+        
         return EOK;
 }
@@ -1637 +1637 @@
         ieee80211_data_header_t *data_header =
             (ieee80211_data_header_t *) buffer;
-
+        
         if (ieee80211_has_data_frame(data_header->frame_ctrl)) {
                 nic_t *nic = nic_get_from_ddf_dev(ieee80211_dev->ddf_dev);
                 size_t strip_length = sizeof(ieee80211_data_header_t) +
                     ARRAY_SIZE(rfc1042_header);
-
+                
                 /* TODO: Different by used security alg. */
                 /* TODO: Trim frame by used security alg. */
@@ -1648 +1648 @@
                 if (ieee80211_is_encrypted_frame(data_header->frame_ctrl))
                         strip_length += 8;
-
+                
                 /* Process 4-way authentication handshake. */
                 uint16_t *proto = (uint16_t *) (buffer + strip_length);
@@ -1655 +1655 @@
                             buffer + strip_length + sizeof(uint16_t),
                             buffer_size - strip_length - sizeof(uint16_t));
-
+                
                 /*
                  * Note: ETH protocol ID is already there, so we don't create
@@ -1663 +1663 @@
                     buffer_size - strip_length + sizeof(eth_header_t) - 2;
                 nic_frame_t *frame = nic_alloc_frame(nic, frame_size);
-
+                
                 if(frame == NULL)
                         return ENOMEM;
-
+                
                 uint8_t *src_addr =
                     ieee80211_is_fromds_frame(data_header->frame_ctrl) ?
@@ -1673 +1673 @@
                     ieee80211_is_tods_frame(data_header->frame_ctrl) ?
                     data_header->address3 : data_header->address1;
-
+                
                 eth_header_t *eth_header = (eth_header_t *) frame->data;
                 memcpy(eth_header->src_addr, src_addr, ETH_ADDR);
                 memcpy(eth_header->dest_addr, dest_addr, ETH_ADDR);
-
+                
                 memcpy(frame->data + sizeof(eth_header_t) - 2,
                     buffer + strip_length, buffer_size - strip_length);
-
+                
                 nic_received_frame(nic, frame);
         }
-
+        
         return EOK;
 }
@@ -1700 +1700 @@
 {
         uint16_t frame_ctrl = *((uint16_t *) buffer);
-
+        
         if (ieee80211_is_mgmt_frame(frame_ctrl)) {
                 ieee80211_mgmt_header_t *mgmt_header =
                     (ieee80211_mgmt_header_t *) buffer;
-
+                
                 if ((ieee80211_is_probe_response_frame(mgmt_header->frame_ctrl)) ||
                     (ieee80211_is_beacon_frame(mgmt_header->frame_ctrl)))
                         return ieee80211_process_probe_response(ieee80211_dev,
                             mgmt_header, buffer_size);
-
+                
                 if (ieee80211_is_auth_frame(mgmt_header->frame_ctrl))
                         return ieee80211_process_auth_response(ieee80211_dev,
                             mgmt_header);
-
+                
                 if (ieee80211_is_assoc_response_frame(mgmt_header->frame_ctrl))
                         return ieee80211_process_assoc_response(ieee80211_dev,
@@ -1720 +1720 @@
                 return ieee80211_process_data(ieee80211_dev, buffer,
                     buffer_size);
-
+        
         return EOK;
 }