iscan_buf_t * dhd_iscan_allocate_buf(dhd_pub_t *dhd, iscan_buf_t **iscanbuf) { iscan_buf_t *iscanbuf_alloc = 0; iscan_buf_t *iscanbuf_head; DHD_TRACE(("%s: Entered\n", __FUNCTION__)); dhd_iscan_lock(); iscanbuf_alloc = (iscan_buf_t*)MALLOC(dhd->osh, sizeof(iscan_buf_t)); if (iscanbuf_alloc == NULL) goto fail; iscanbuf_alloc->next = NULL; iscanbuf_head = *iscanbuf; DHD_ISCAN(("%s: addr of allocated node = 0x%X" "addr of iscanbuf_head = 0x%X dhd = 0x%X\n", __FUNCTION__, iscanbuf_alloc, iscanbuf_head, dhd)); if (iscanbuf_head == NULL) { *iscanbuf = iscanbuf_alloc; DHD_ISCAN(("%s: Head is allocated\n", __FUNCTION__)); goto fail; } while (iscanbuf_head->next) iscanbuf_head = iscanbuf_head->next; iscanbuf_head->next = iscanbuf_alloc; fail: dhd_iscan_unlock(); return iscanbuf_alloc; }
iscan_buf_t *dhd_iscan_allocate_buf(dhd_pub_t *dhd, iscan_buf_t **iscanbuf) { iscan_buf_t *iscanbuf_alloc = 0; iscan_buf_t *iscanbuf_head; dhd_iscan_lock(); iscanbuf_alloc = kmalloc(sizeof(iscan_buf_t), GFP_ATOMIC); if (iscanbuf_alloc == NULL) goto fail; iscanbuf_alloc->next = NULL; iscanbuf_head = *iscanbuf; DHD_ISCAN(("%s: addr of allocated node = 0x%X" "addr of iscanbuf_head = 0x%X dhd = 0x%X\n", __func__, iscanbuf_alloc, iscanbuf_head, dhd)); if (iscanbuf_head == NULL) { *iscanbuf = iscanbuf_alloc; DHD_ISCAN(("%s: Head is allocated\n", __func__)); goto fail; } while (iscanbuf_head->next) iscanbuf_head = iscanbuf_head->next; iscanbuf_head->next = iscanbuf_alloc; fail: dhd_iscan_unlock(); return iscanbuf_alloc; }
int dhd_iscan_remove_duplicates(void *dhdp, iscan_buf_t *iscan_cur) { int i = 0; wl_iscan_results_t *list; wl_scan_results_t *results; wl_bss_info_t UNALIGNED *bi, *bi_new, *bi_next; dhd_iscan_lock(); DHD_ISCAN(("%s: Scan cache before delete\n", __func__)); dhd_iscan_print_cache(iscan_cur); if (!iscan_cur) goto done; list = (wl_iscan_results_t *)iscan_cur->iscan_buf; if (!list) goto done; results = (wl_scan_results_t *)&list->results; if (!results) goto done; if (results->version != WL_BSS_INFO_VERSION) { DHD_ERROR(("%s: results->version %d != WL_BSS_INFO_VERSION\n", __func__, results->version)); goto done; } bi = results->bss_info; for (i = 0; i < results->count; i++) { if (!bi) break; DHD_ISCAN(("%s: Find dups for BSS[%2.2d] %X:%X:%X:%X:%X:%X\n", __func__, i, bi->BSSID.octet[0], bi->BSSID.octet[1], bi->BSSID.octet[2], bi->BSSID.octet[3], bi->BSSID.octet[4], bi->BSSID.octet[5])); dhd_iscan_delete_bss(dhdp, bi->BSSID.octet, iscan_cur); bi = (wl_bss_info_t *)((unsigned long)bi + bi->length); } done: DHD_ISCAN(("%s: Scan cache after delete\n", __func__)); dhd_iscan_print_cache(iscan_cur); dhd_iscan_unlock(); return 0; }
/* * print scan cache * print partial iscan_skip list differently */ int dhd_iscan_print_cache(iscan_buf_t *iscan_skip) { int i = 0, l = 0; iscan_buf_t *iscan_cur; wl_iscan_results_t *list; wl_scan_results_t *results; wl_bss_info_t UNALIGNED *bi; dhd_iscan_lock(); iscan_cur = dhd_iscan_result_buf(); while (iscan_cur) { list = (wl_iscan_results_t *)iscan_cur->iscan_buf; if (!list) break; results = (wl_scan_results_t *)&list->results; if (!results) break; if (results->version != WL_BSS_INFO_VERSION) { DHD_ISCAN(("%s: results->version %d != " "WL_BSS_INFO_VERSION\n", __func__, results->version)); goto done; } bi = results->bss_info; for (i = 0; i < results->count; i++) { if (!bi) break; DHD_ISCAN(("%s[%2.2d:%2.2d] %X:%X:%X:%X:%X:%X\n", iscan_cur != iscan_skip ? "BSS" : "bss", l, i, bi->BSSID.octet[0], bi->BSSID.octet[1], bi->BSSID.octet[2], bi->BSSID.octet[3], bi->BSSID.octet[4], bi->BSSID.octet[5])); bi = (wl_bss_info_t *)((unsigned long)bi + bi->length); } iscan_cur = iscan_cur->next; l++; } done: dhd_iscan_unlock(); return 0; }
/* * delete disappeared AP from specific scan cache but skip partial * list in iscan_skip */ int dhd_iscan_delete_bss(void *dhdp, void *addr, iscan_buf_t *iscan_skip) { int i = 0, j = 0, l = 0; iscan_buf_t *iscan_cur; wl_iscan_results_t *list; wl_scan_results_t *results; wl_bss_info_t UNALIGNED *bi, *bi_new, *bi_next; unsigned char *s_addr = addr; dhd_iscan_lock(); DHD_ISCAN(("%s: BSS to remove %X:%X:%X:%X:%X:%X\n", __func__, s_addr[0], s_addr[1], s_addr[2], s_addr[3], s_addr[4], s_addr[5])); iscan_cur = dhd_iscan_result_buf(); while (iscan_cur) { if (iscan_cur != iscan_skip) { list = (wl_iscan_results_t *)iscan_cur->iscan_buf; if (!list) break; results = (wl_scan_results_t *)&list->results; if (!results) break; if (results->version != WL_BSS_INFO_VERSION) { DHD_ERROR(("%s: results->version %d != " "WL_BSS_INFO_VERSION\n", __func__, results->version)); goto done; } bi = results->bss_info; for (i = 0; i < results->count; i++) { if (!bi) break; if (!memcmp (bi->BSSID.octet, addr, ETH_ALEN)) { DHD_ISCAN(("%s: Del BSS[%2.2d:%2.2d] " "%X:%X:%X:%X:%X:%X\n", __func__, l, i, bi->BSSID.octet[0], bi->BSSID.octet[1], bi->BSSID.octet[2], bi->BSSID.octet[3], bi->BSSID.octet[4], bi->BSSID.octet[5])); bi_new = bi; bi = (wl_bss_info_t *)((unsigned long) bi + bi->length); /* if(bi && bi_new) { memcpy(bi_new, bi, results->buflen - bi_new->length); results->buflen -= bi_new->length; } */ results->buflen -= bi_new->length; results->count--; for (j = i; j < results->count; j++) { if (bi && bi_new) { DHD_ISCAN(("%s: Moved up BSS[%2.2d:%2.2d]" "%X:%X:%X:%X:%X:%X\n", __func__, l, j, bi->BSSID.octet[0], bi->BSSID.octet[1], bi->BSSID.octet[2], bi->BSSID.octet[3], bi->BSSID.octet[4], bi->BSSID.octet[5])); bi_next = (wl_bss_info_t *)((unsigned long)bi + bi->length); memcpy(bi_new, bi, bi->length); bi_new = (wl_bss_info_t *)((unsigned long)bi_new + bi_new-> length); bi = bi_next; } } if (results->count == 0) { /* Prune now empty partial scan list */ dhd_iscan_free_buf(dhdp, iscan_cur); goto done; } break; } bi = (wl_bss_info_t *)((unsigned long)bi + bi->length); } } iscan_cur = iscan_cur->next; l++; } done: dhd_iscan_unlock(); return 0; }