tx.c revision 31627dc59b4a87c4198b4245a7de1b8ccf4424fa
1f5fc0f86b02afef1119b523623b4cde41475bc8cLuciano Coelho/* 2f5fc0f86b02afef1119b523623b4cde41475bc8cLuciano Coelho * This file is part of wl1271 3f5fc0f86b02afef1119b523623b4cde41475bc8cLuciano Coelho * 4f5fc0f86b02afef1119b523623b4cde41475bc8cLuciano Coelho * Copyright (C) 2009 Nokia Corporation 5f5fc0f86b02afef1119b523623b4cde41475bc8cLuciano Coelho * 6f5fc0f86b02afef1119b523623b4cde41475bc8cLuciano Coelho * Contact: Luciano Coelho <luciano.coelho@nokia.com> 7f5fc0f86b02afef1119b523623b4cde41475bc8cLuciano Coelho * 8f5fc0f86b02afef1119b523623b4cde41475bc8cLuciano Coelho * This program is free software; you can redistribute it and/or 9f5fc0f86b02afef1119b523623b4cde41475bc8cLuciano Coelho * modify it under the terms of the GNU General Public License 10f5fc0f86b02afef1119b523623b4cde41475bc8cLuciano Coelho * version 2 as published by the Free Software Foundation. 11f5fc0f86b02afef1119b523623b4cde41475bc8cLuciano Coelho * 12f5fc0f86b02afef1119b523623b4cde41475bc8cLuciano Coelho * This program is distributed in the hope that it will be useful, but 13f5fc0f86b02afef1119b523623b4cde41475bc8cLuciano Coelho * WITHOUT ANY WARRANTY; without even the implied warranty of 14f5fc0f86b02afef1119b523623b4cde41475bc8cLuciano Coelho * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU 15f5fc0f86b02afef1119b523623b4cde41475bc8cLuciano Coelho * General Public License for more details. 16f5fc0f86b02afef1119b523623b4cde41475bc8cLuciano Coelho * 17f5fc0f86b02afef1119b523623b4cde41475bc8cLuciano Coelho * You should have received a copy of the GNU General Public License 18f5fc0f86b02afef1119b523623b4cde41475bc8cLuciano Coelho * along with this program; if not, write to the Free Software 19f5fc0f86b02afef1119b523623b4cde41475bc8cLuciano Coelho * Foundation, Inc., 51 Franklin St, Fifth Floor, Boston, MA 20f5fc0f86b02afef1119b523623b4cde41475bc8cLuciano Coelho * 02110-1301 USA 21f5fc0f86b02afef1119b523623b4cde41475bc8cLuciano Coelho * 22f5fc0f86b02afef1119b523623b4cde41475bc8cLuciano Coelho */ 23f5fc0f86b02afef1119b523623b4cde41475bc8cLuciano Coelho 24f5fc0f86b02afef1119b523623b4cde41475bc8cLuciano Coelho#include <linux/kernel.h> 25f5fc0f86b02afef1119b523623b4cde41475bc8cLuciano Coelho#include <linux/module.h> 26f5fc0f86b02afef1119b523623b4cde41475bc8cLuciano Coelho 27f5fc0f86b02afef1119b523623b4cde41475bc8cLuciano Coelho#include "wl1271.h" 287b048c52d7283ebf07c826a45c631a6ba225c057Teemu Paasikivi#include "wl1271_io.h" 29f5fc0f86b02afef1119b523623b4cde41475bc8cLuciano Coelho#include "wl1271_reg.h" 30f5fc0f86b02afef1119b523623b4cde41475bc8cLuciano Coelho#include "wl1271_ps.h" 31f5fc0f86b02afef1119b523623b4cde41475bc8cLuciano Coelho#include "wl1271_tx.h" 32f5fc0f86b02afef1119b523623b4cde41475bc8cLuciano Coelho 33f5fc0f86b02afef1119b523623b4cde41475bc8cLuciano Coelhostatic int wl1271_tx_id(struct wl1271 *wl, struct sk_buff *skb) 34f5fc0f86b02afef1119b523623b4cde41475bc8cLuciano Coelho{ 35f5fc0f86b02afef1119b523623b4cde41475bc8cLuciano Coelho int i; 36be7078c21d826fbaab77f88440958019aab969afJuuso Oikarinen for (i = 0; i < ACX_TX_DESCRIPTORS; i++) 37f5fc0f86b02afef1119b523623b4cde41475bc8cLuciano Coelho if (wl->tx_frames[i] == NULL) { 38f5fc0f86b02afef1119b523623b4cde41475bc8cLuciano Coelho wl->tx_frames[i] = skb; 39f5fc0f86b02afef1119b523623b4cde41475bc8cLuciano Coelho return i; 40f5fc0f86b02afef1119b523623b4cde41475bc8cLuciano Coelho } 41f5fc0f86b02afef1119b523623b4cde41475bc8cLuciano Coelho 42f5fc0f86b02afef1119b523623b4cde41475bc8cLuciano Coelho return -EBUSY; 43f5fc0f86b02afef1119b523623b4cde41475bc8cLuciano Coelho} 44f5fc0f86b02afef1119b523623b4cde41475bc8cLuciano Coelho 45f5fc0f86b02afef1119b523623b4cde41475bc8cLuciano Coelhostatic int wl1271_tx_allocate(struct wl1271 *wl, struct sk_buff *skb, u32 extra) 46f5fc0f86b02afef1119b523623b4cde41475bc8cLuciano Coelho{ 47f5fc0f86b02afef1119b523623b4cde41475bc8cLuciano Coelho struct wl1271_tx_hw_descr *desc; 48f5fc0f86b02afef1119b523623b4cde41475bc8cLuciano Coelho u32 total_len = skb->len + sizeof(struct wl1271_tx_hw_descr) + extra; 495c9417f1656b0f415f4be5a7cd7195ecadd7dd1aJuuso Oikarinen u32 total_blocks; 50f5fc0f86b02afef1119b523623b4cde41475bc8cLuciano Coelho int id, ret = -EBUSY; 51f5fc0f86b02afef1119b523623b4cde41475bc8cLuciano Coelho 52f5fc0f86b02afef1119b523623b4cde41475bc8cLuciano Coelho /* allocate free identifier for the packet */ 53f5fc0f86b02afef1119b523623b4cde41475bc8cLuciano Coelho id = wl1271_tx_id(wl, skb); 54f5fc0f86b02afef1119b523623b4cde41475bc8cLuciano Coelho if (id < 0) 55f5fc0f86b02afef1119b523623b4cde41475bc8cLuciano Coelho return id; 56f5fc0f86b02afef1119b523623b4cde41475bc8cLuciano Coelho 57f5fc0f86b02afef1119b523623b4cde41475bc8cLuciano Coelho /* approximate the number of blocks required for this packet 58f5fc0f86b02afef1119b523623b4cde41475bc8cLuciano Coelho in the firmware */ 595c9417f1656b0f415f4be5a7cd7195ecadd7dd1aJuuso Oikarinen total_blocks = total_len + TX_HW_BLOCK_SIZE - 1; 605c9417f1656b0f415f4be5a7cd7195ecadd7dd1aJuuso Oikarinen total_blocks = total_blocks / TX_HW_BLOCK_SIZE + TX_HW_BLOCK_SPARE; 61f5fc0f86b02afef1119b523623b4cde41475bc8cLuciano Coelho if (total_blocks <= wl->tx_blocks_available) { 62f5fc0f86b02afef1119b523623b4cde41475bc8cLuciano Coelho desc = (struct wl1271_tx_hw_descr *)skb_push( 63f5fc0f86b02afef1119b523623b4cde41475bc8cLuciano Coelho skb, total_len - skb->len); 64f5fc0f86b02afef1119b523623b4cde41475bc8cLuciano Coelho 65f5fc0f86b02afef1119b523623b4cde41475bc8cLuciano Coelho desc->extra_mem_blocks = TX_HW_BLOCK_SPARE; 66f5fc0f86b02afef1119b523623b4cde41475bc8cLuciano Coelho desc->total_mem_blocks = total_blocks; 67f5fc0f86b02afef1119b523623b4cde41475bc8cLuciano Coelho desc->id = id; 68f5fc0f86b02afef1119b523623b4cde41475bc8cLuciano Coelho 69f5fc0f86b02afef1119b523623b4cde41475bc8cLuciano Coelho wl->tx_blocks_available -= total_blocks; 70f5fc0f86b02afef1119b523623b4cde41475bc8cLuciano Coelho 71f5fc0f86b02afef1119b523623b4cde41475bc8cLuciano Coelho ret = 0; 72f5fc0f86b02afef1119b523623b4cde41475bc8cLuciano Coelho 73f5fc0f86b02afef1119b523623b4cde41475bc8cLuciano Coelho wl1271_debug(DEBUG_TX, 74f5fc0f86b02afef1119b523623b4cde41475bc8cLuciano Coelho "tx_allocate: size: %d, blocks: %d, id: %d", 75f5fc0f86b02afef1119b523623b4cde41475bc8cLuciano Coelho total_len, total_blocks, id); 76f5fc0f86b02afef1119b523623b4cde41475bc8cLuciano Coelho } else 77f5fc0f86b02afef1119b523623b4cde41475bc8cLuciano Coelho wl->tx_frames[id] = NULL; 78f5fc0f86b02afef1119b523623b4cde41475bc8cLuciano Coelho 79f5fc0f86b02afef1119b523623b4cde41475bc8cLuciano Coelho return ret; 80f5fc0f86b02afef1119b523623b4cde41475bc8cLuciano Coelho} 81f5fc0f86b02afef1119b523623b4cde41475bc8cLuciano Coelho 82f5fc0f86b02afef1119b523623b4cde41475bc8cLuciano Coelhostatic int wl1271_tx_fill_hdr(struct wl1271 *wl, struct sk_buff *skb, 83f5fc0f86b02afef1119b523623b4cde41475bc8cLuciano Coelho u32 extra, struct ieee80211_tx_info *control) 84f5fc0f86b02afef1119b523623b4cde41475bc8cLuciano Coelho{ 85ac5e1e39c1eeaaff7e6f03bf7cf7a444b42fbc23Juuso Oikarinen struct timespec ts; 86f5fc0f86b02afef1119b523623b4cde41475bc8cLuciano Coelho struct wl1271_tx_hw_descr *desc; 87c6999d831ab9ae5e368b20f3bc11b0ca9c17a7ecKalle Valo int pad, ac; 88ac5e1e39c1eeaaff7e6f03bf7cf7a444b42fbc23Juuso Oikarinen s64 hosttime; 89d0f63b202146f3281800ee44823740c8bbf38f11Luciano Coelho u16 tx_attr; 90f5fc0f86b02afef1119b523623b4cde41475bc8cLuciano Coelho 91f5fc0f86b02afef1119b523623b4cde41475bc8cLuciano Coelho desc = (struct wl1271_tx_hw_descr *) skb->data; 92f5fc0f86b02afef1119b523623b4cde41475bc8cLuciano Coelho 931e2b79761d551c545225e1fa6e7d144f7e804898Juuso Oikarinen /* relocate space for security header */ 941e2b79761d551c545225e1fa6e7d144f7e804898Juuso Oikarinen if (extra) { 951e2b79761d551c545225e1fa6e7d144f7e804898Juuso Oikarinen void *framestart = skb->data + sizeof(*desc); 961e2b79761d551c545225e1fa6e7d144f7e804898Juuso Oikarinen u16 fc = *(u16 *)(framestart + extra); 97d0f63b202146f3281800ee44823740c8bbf38f11Luciano Coelho int hdrlen = ieee80211_hdrlen(cpu_to_le16(fc)); 981e2b79761d551c545225e1fa6e7d144f7e804898Juuso Oikarinen memmove(framestart, framestart + extra, hdrlen); 991e2b79761d551c545225e1fa6e7d144f7e804898Juuso Oikarinen } 1001e2b79761d551c545225e1fa6e7d144f7e804898Juuso Oikarinen 101f5fc0f86b02afef1119b523623b4cde41475bc8cLuciano Coelho /* configure packet life time */ 102ac5e1e39c1eeaaff7e6f03bf7cf7a444b42fbc23Juuso Oikarinen getnstimeofday(&ts); 103ac5e1e39c1eeaaff7e6f03bf7cf7a444b42fbc23Juuso Oikarinen hosttime = (timespec_to_ns(&ts) >> 10); 104ac5e1e39c1eeaaff7e6f03bf7cf7a444b42fbc23Juuso Oikarinen desc->start_time = cpu_to_le32(hosttime - wl->time_offset); 105d0f63b202146f3281800ee44823740c8bbf38f11Luciano Coelho desc->life_time = cpu_to_le16(TX_HW_MGMT_PKT_LIFETIME_TU); 106f5fc0f86b02afef1119b523623b4cde41475bc8cLuciano Coelho 107f5fc0f86b02afef1119b523623b4cde41475bc8cLuciano Coelho /* configure the tx attributes */ 108d0f63b202146f3281800ee44823740c8bbf38f11Luciano Coelho tx_attr = wl->session_counter << TX_HW_ATTR_OFST_SESSION_COUNTER; 109c6999d831ab9ae5e368b20f3bc11b0ca9c17a7ecKalle Valo 110c6999d831ab9ae5e368b20f3bc11b0ca9c17a7ecKalle Valo /* queue */ 111c6999d831ab9ae5e368b20f3bc11b0ca9c17a7ecKalle Valo ac = wl1271_tx_get_queue(skb_get_queue_mapping(skb)); 112c6999d831ab9ae5e368b20f3bc11b0ca9c17a7ecKalle Valo desc->tid = wl1271_tx_ac_to_tid(ac); 113c6999d831ab9ae5e368b20f3bc11b0ca9c17a7ecKalle Valo 114f5fc0f86b02afef1119b523623b4cde41475bc8cLuciano Coelho desc->aid = TX_HW_DEFAULT_AID; 115f5fc0f86b02afef1119b523623b4cde41475bc8cLuciano Coelho desc->reserved = 0; 116f5fc0f86b02afef1119b523623b4cde41475bc8cLuciano Coelho 117f5fc0f86b02afef1119b523623b4cde41475bc8cLuciano Coelho /* align the length (and store in terms of words) */ 118f5fc0f86b02afef1119b523623b4cde41475bc8cLuciano Coelho pad = WL1271_TX_ALIGN(skb->len); 119d0f63b202146f3281800ee44823740c8bbf38f11Luciano Coelho desc->length = cpu_to_le16(pad >> 2); 120f5fc0f86b02afef1119b523623b4cde41475bc8cLuciano Coelho 121f5fc0f86b02afef1119b523623b4cde41475bc8cLuciano Coelho /* calculate number of padding bytes */ 122f5fc0f86b02afef1119b523623b4cde41475bc8cLuciano Coelho pad = pad - skb->len; 123d0f63b202146f3281800ee44823740c8bbf38f11Luciano Coelho tx_attr |= pad << TX_HW_ATTR_OFST_LAST_WORD_PAD; 124d0f63b202146f3281800ee44823740c8bbf38f11Luciano Coelho 125830fb67b8e37fb03cf703b4e1217fe30ce32d579Juuso Oikarinen /* if the packets are destined for AP (have a STA entry) send them 126830fb67b8e37fb03cf703b4e1217fe30ce32d579Juuso Oikarinen with AP rate policies, otherwise use default basic rates */ 127830fb67b8e37fb03cf703b4e1217fe30ce32d579Juuso Oikarinen if (control->control.sta) 128830fb67b8e37fb03cf703b4e1217fe30ce32d579Juuso Oikarinen tx_attr |= ACX_TX_AP_FULL_RATE << TX_HW_ATTR_OFST_RATE_POLICY; 129830fb67b8e37fb03cf703b4e1217fe30ce32d579Juuso Oikarinen 130d0f63b202146f3281800ee44823740c8bbf38f11Luciano Coelho desc->tx_attr = cpu_to_le16(tx_attr); 131f5fc0f86b02afef1119b523623b4cde41475bc8cLuciano Coelho 132f5fc0f86b02afef1119b523623b4cde41475bc8cLuciano Coelho wl1271_debug(DEBUG_TX, "tx_fill_hdr: pad: %d", pad); 133f5fc0f86b02afef1119b523623b4cde41475bc8cLuciano Coelho return 0; 134f5fc0f86b02afef1119b523623b4cde41475bc8cLuciano Coelho} 135f5fc0f86b02afef1119b523623b4cde41475bc8cLuciano Coelho 136f5fc0f86b02afef1119b523623b4cde41475bc8cLuciano Coelhostatic int wl1271_tx_send_packet(struct wl1271 *wl, struct sk_buff *skb, 137f5fc0f86b02afef1119b523623b4cde41475bc8cLuciano Coelho struct ieee80211_tx_info *control) 138f5fc0f86b02afef1119b523623b4cde41475bc8cLuciano Coelho{ 139f5fc0f86b02afef1119b523623b4cde41475bc8cLuciano Coelho 140f5fc0f86b02afef1119b523623b4cde41475bc8cLuciano Coelho struct wl1271_tx_hw_descr *desc; 141f5fc0f86b02afef1119b523623b4cde41475bc8cLuciano Coelho int len; 142f5fc0f86b02afef1119b523623b4cde41475bc8cLuciano Coelho 143f5fc0f86b02afef1119b523623b4cde41475bc8cLuciano Coelho /* FIXME: This is a workaround for getting non-aligned packets. 144f5fc0f86b02afef1119b523623b4cde41475bc8cLuciano Coelho This happens at least with EAPOL packets from the user space. 145f5fc0f86b02afef1119b523623b4cde41475bc8cLuciano Coelho Our DMA requires packets to be aligned on a 4-byte boundary. 146f5fc0f86b02afef1119b523623b4cde41475bc8cLuciano Coelho */ 147f5fc0f86b02afef1119b523623b4cde41475bc8cLuciano Coelho if (unlikely((long)skb->data & 0x03)) { 148f5fc0f86b02afef1119b523623b4cde41475bc8cLuciano Coelho int offset = (4 - (long)skb->data) & 0x03; 149f5fc0f86b02afef1119b523623b4cde41475bc8cLuciano Coelho wl1271_debug(DEBUG_TX, "skb offset %d", offset); 150f5fc0f86b02afef1119b523623b4cde41475bc8cLuciano Coelho 151f5fc0f86b02afef1119b523623b4cde41475bc8cLuciano Coelho /* check whether the current skb can be used */ 152f5fc0f86b02afef1119b523623b4cde41475bc8cLuciano Coelho if (!skb_cloned(skb) && (skb_tailroom(skb) >= offset)) { 153f5fc0f86b02afef1119b523623b4cde41475bc8cLuciano Coelho unsigned char *src = skb->data; 154f5fc0f86b02afef1119b523623b4cde41475bc8cLuciano Coelho 155f5fc0f86b02afef1119b523623b4cde41475bc8cLuciano Coelho /* align the buffer on a 4-byte boundary */ 156f5fc0f86b02afef1119b523623b4cde41475bc8cLuciano Coelho skb_reserve(skb, offset); 157f5fc0f86b02afef1119b523623b4cde41475bc8cLuciano Coelho memmove(skb->data, src, skb->len); 158f5fc0f86b02afef1119b523623b4cde41475bc8cLuciano Coelho } else { 159f5fc0f86b02afef1119b523623b4cde41475bc8cLuciano Coelho wl1271_info("No handler, fixme!"); 160f5fc0f86b02afef1119b523623b4cde41475bc8cLuciano Coelho return -EINVAL; 161f5fc0f86b02afef1119b523623b4cde41475bc8cLuciano Coelho } 162f5fc0f86b02afef1119b523623b4cde41475bc8cLuciano Coelho } 163f5fc0f86b02afef1119b523623b4cde41475bc8cLuciano Coelho 164f5fc0f86b02afef1119b523623b4cde41475bc8cLuciano Coelho len = WL1271_TX_ALIGN(skb->len); 165f5fc0f86b02afef1119b523623b4cde41475bc8cLuciano Coelho 166f5fc0f86b02afef1119b523623b4cde41475bc8cLuciano Coelho /* perform a fixed address block write with the packet */ 1677b048c52d7283ebf07c826a45c631a6ba225c057Teemu Paasikivi wl1271_write(wl, WL1271_SLV_MEM_DATA, skb->data, len, true); 168f5fc0f86b02afef1119b523623b4cde41475bc8cLuciano Coelho 169f5fc0f86b02afef1119b523623b4cde41475bc8cLuciano Coelho /* write packet new counter into the write access register */ 170f5fc0f86b02afef1119b523623b4cde41475bc8cLuciano Coelho wl->tx_packets_count++; 171f5fc0f86b02afef1119b523623b4cde41475bc8cLuciano Coelho 172f5fc0f86b02afef1119b523623b4cde41475bc8cLuciano Coelho desc = (struct wl1271_tx_hw_descr *) skb->data; 173f5fc0f86b02afef1119b523623b4cde41475bc8cLuciano Coelho wl1271_debug(DEBUG_TX, "tx id %u skb 0x%p payload %u (%u words)", 174f5fc0f86b02afef1119b523623b4cde41475bc8cLuciano Coelho desc->id, skb, len, desc->length); 175f5fc0f86b02afef1119b523623b4cde41475bc8cLuciano Coelho 176f5fc0f86b02afef1119b523623b4cde41475bc8cLuciano Coelho return 0; 177f5fc0f86b02afef1119b523623b4cde41475bc8cLuciano Coelho} 178f5fc0f86b02afef1119b523623b4cde41475bc8cLuciano Coelho 179f5fc0f86b02afef1119b523623b4cde41475bc8cLuciano Coelho/* caller must hold wl->mutex */ 180f5fc0f86b02afef1119b523623b4cde41475bc8cLuciano Coelhostatic int wl1271_tx_frame(struct wl1271 *wl, struct sk_buff *skb) 181f5fc0f86b02afef1119b523623b4cde41475bc8cLuciano Coelho{ 182f5fc0f86b02afef1119b523623b4cde41475bc8cLuciano Coelho struct ieee80211_tx_info *info; 183f5fc0f86b02afef1119b523623b4cde41475bc8cLuciano Coelho u32 extra = 0; 184f5fc0f86b02afef1119b523623b4cde41475bc8cLuciano Coelho int ret = 0; 185f5fc0f86b02afef1119b523623b4cde41475bc8cLuciano Coelho u8 idx; 186f5fc0f86b02afef1119b523623b4cde41475bc8cLuciano Coelho 187f5fc0f86b02afef1119b523623b4cde41475bc8cLuciano Coelho if (!skb) 188f5fc0f86b02afef1119b523623b4cde41475bc8cLuciano Coelho return -EINVAL; 189f5fc0f86b02afef1119b523623b4cde41475bc8cLuciano Coelho 190f5fc0f86b02afef1119b523623b4cde41475bc8cLuciano Coelho info = IEEE80211_SKB_CB(skb); 191f5fc0f86b02afef1119b523623b4cde41475bc8cLuciano Coelho 192f5fc0f86b02afef1119b523623b4cde41475bc8cLuciano Coelho if (info->control.hw_key && 193f5fc0f86b02afef1119b523623b4cde41475bc8cLuciano Coelho info->control.hw_key->alg == ALG_TKIP) 194f5fc0f86b02afef1119b523623b4cde41475bc8cLuciano Coelho extra = WL1271_TKIP_IV_SPACE; 195f5fc0f86b02afef1119b523623b4cde41475bc8cLuciano Coelho 196f5fc0f86b02afef1119b523623b4cde41475bc8cLuciano Coelho if (info->control.hw_key) { 197f5fc0f86b02afef1119b523623b4cde41475bc8cLuciano Coelho idx = info->control.hw_key->hw_key_idx; 198f5fc0f86b02afef1119b523623b4cde41475bc8cLuciano Coelho 199f5fc0f86b02afef1119b523623b4cde41475bc8cLuciano Coelho /* FIXME: do we have to do this if we're not using WEP? */ 200f5fc0f86b02afef1119b523623b4cde41475bc8cLuciano Coelho if (unlikely(wl->default_key != idx)) { 201f5fc0f86b02afef1119b523623b4cde41475bc8cLuciano Coelho ret = wl1271_cmd_set_default_wep_key(wl, idx); 202f5fc0f86b02afef1119b523623b4cde41475bc8cLuciano Coelho if (ret < 0) 203f5fc0f86b02afef1119b523623b4cde41475bc8cLuciano Coelho return ret; 204ee444cf0501183df1640cd35bebd4250989bfe99Juuso Oikarinen wl->default_key = idx; 205f5fc0f86b02afef1119b523623b4cde41475bc8cLuciano Coelho } 206f5fc0f86b02afef1119b523623b4cde41475bc8cLuciano Coelho } 207f5fc0f86b02afef1119b523623b4cde41475bc8cLuciano Coelho 208f5fc0f86b02afef1119b523623b4cde41475bc8cLuciano Coelho ret = wl1271_tx_allocate(wl, skb, extra); 209f5fc0f86b02afef1119b523623b4cde41475bc8cLuciano Coelho if (ret < 0) 210f5fc0f86b02afef1119b523623b4cde41475bc8cLuciano Coelho return ret; 211f5fc0f86b02afef1119b523623b4cde41475bc8cLuciano Coelho 212f5fc0f86b02afef1119b523623b4cde41475bc8cLuciano Coelho ret = wl1271_tx_fill_hdr(wl, skb, extra, info); 213f5fc0f86b02afef1119b523623b4cde41475bc8cLuciano Coelho if (ret < 0) 214f5fc0f86b02afef1119b523623b4cde41475bc8cLuciano Coelho return ret; 215f5fc0f86b02afef1119b523623b4cde41475bc8cLuciano Coelho 216f5fc0f86b02afef1119b523623b4cde41475bc8cLuciano Coelho ret = wl1271_tx_send_packet(wl, skb, info); 217f5fc0f86b02afef1119b523623b4cde41475bc8cLuciano Coelho if (ret < 0) 218f5fc0f86b02afef1119b523623b4cde41475bc8cLuciano Coelho return ret; 219f5fc0f86b02afef1119b523623b4cde41475bc8cLuciano Coelho 220f5fc0f86b02afef1119b523623b4cde41475bc8cLuciano Coelho return ret; 221f5fc0f86b02afef1119b523623b4cde41475bc8cLuciano Coelho} 222f5fc0f86b02afef1119b523623b4cde41475bc8cLuciano Coelho 223830fb67b8e37fb03cf703b4e1217fe30ce32d579Juuso Oikarinenstatic u32 wl1271_tx_enabled_rates_get(struct wl1271 *wl, u32 rate_set) 224830fb67b8e37fb03cf703b4e1217fe30ce32d579Juuso Oikarinen{ 225830fb67b8e37fb03cf703b4e1217fe30ce32d579Juuso Oikarinen struct ieee80211_supported_band *band; 226830fb67b8e37fb03cf703b4e1217fe30ce32d579Juuso Oikarinen u32 enabled_rates = 0; 227830fb67b8e37fb03cf703b4e1217fe30ce32d579Juuso Oikarinen int bit; 228830fb67b8e37fb03cf703b4e1217fe30ce32d579Juuso Oikarinen 229830fb67b8e37fb03cf703b4e1217fe30ce32d579Juuso Oikarinen band = wl->hw->wiphy->bands[wl->band]; 230830fb67b8e37fb03cf703b4e1217fe30ce32d579Juuso Oikarinen for (bit = 0; bit < band->n_bitrates; bit++) { 231830fb67b8e37fb03cf703b4e1217fe30ce32d579Juuso Oikarinen if (rate_set & 0x1) 232830fb67b8e37fb03cf703b4e1217fe30ce32d579Juuso Oikarinen enabled_rates |= band->bitrates[bit].hw_value; 233830fb67b8e37fb03cf703b4e1217fe30ce32d579Juuso Oikarinen rate_set >>= 1; 234830fb67b8e37fb03cf703b4e1217fe30ce32d579Juuso Oikarinen } 235830fb67b8e37fb03cf703b4e1217fe30ce32d579Juuso Oikarinen 236830fb67b8e37fb03cf703b4e1217fe30ce32d579Juuso Oikarinen return enabled_rates; 237830fb67b8e37fb03cf703b4e1217fe30ce32d579Juuso Oikarinen} 238830fb67b8e37fb03cf703b4e1217fe30ce32d579Juuso Oikarinen 239f5fc0f86b02afef1119b523623b4cde41475bc8cLuciano Coelhovoid wl1271_tx_work(struct work_struct *work) 240f5fc0f86b02afef1119b523623b4cde41475bc8cLuciano Coelho{ 241f5fc0f86b02afef1119b523623b4cde41475bc8cLuciano Coelho struct wl1271 *wl = container_of(work, struct wl1271, tx_work); 242f5fc0f86b02afef1119b523623b4cde41475bc8cLuciano Coelho struct sk_buff *skb; 243f5fc0f86b02afef1119b523623b4cde41475bc8cLuciano Coelho bool woken_up = false; 244830fb67b8e37fb03cf703b4e1217fe30ce32d579Juuso Oikarinen u32 sta_rates = 0; 245ffb591cd0e32d817bdbd359dead3baa770b999f8Juuso Oikarinen u32 prev_tx_packets_count; 246f5fc0f86b02afef1119b523623b4cde41475bc8cLuciano Coelho int ret; 247f5fc0f86b02afef1119b523623b4cde41475bc8cLuciano Coelho 248830fb67b8e37fb03cf703b4e1217fe30ce32d579Juuso Oikarinen /* check if the rates supported by the AP have changed */ 249830fb67b8e37fb03cf703b4e1217fe30ce32d579Juuso Oikarinen if (unlikely(test_and_clear_bit(WL1271_FLAG_STA_RATES_CHANGED, 250830fb67b8e37fb03cf703b4e1217fe30ce32d579Juuso Oikarinen &wl->flags))) { 251830fb67b8e37fb03cf703b4e1217fe30ce32d579Juuso Oikarinen unsigned long flags; 252830fb67b8e37fb03cf703b4e1217fe30ce32d579Juuso Oikarinen spin_lock_irqsave(&wl->wl_lock, flags); 253830fb67b8e37fb03cf703b4e1217fe30ce32d579Juuso Oikarinen sta_rates = wl->sta_rate_set; 254830fb67b8e37fb03cf703b4e1217fe30ce32d579Juuso Oikarinen spin_unlock_irqrestore(&wl->wl_lock, flags); 255830fb67b8e37fb03cf703b4e1217fe30ce32d579Juuso Oikarinen } 256830fb67b8e37fb03cf703b4e1217fe30ce32d579Juuso Oikarinen 257f5fc0f86b02afef1119b523623b4cde41475bc8cLuciano Coelho mutex_lock(&wl->mutex); 258f5fc0f86b02afef1119b523623b4cde41475bc8cLuciano Coelho 259f5fc0f86b02afef1119b523623b4cde41475bc8cLuciano Coelho if (unlikely(wl->state == WL1271_STATE_OFF)) 260f5fc0f86b02afef1119b523623b4cde41475bc8cLuciano Coelho goto out; 261f5fc0f86b02afef1119b523623b4cde41475bc8cLuciano Coelho 262ffb591cd0e32d817bdbd359dead3baa770b999f8Juuso Oikarinen prev_tx_packets_count = wl->tx_packets_count; 263ffb591cd0e32d817bdbd359dead3baa770b999f8Juuso Oikarinen 264830fb67b8e37fb03cf703b4e1217fe30ce32d579Juuso Oikarinen /* if rates have changed, re-configure the rate policy */ 265830fb67b8e37fb03cf703b4e1217fe30ce32d579Juuso Oikarinen if (unlikely(sta_rates)) { 266830fb67b8e37fb03cf703b4e1217fe30ce32d579Juuso Oikarinen wl->rate_set = wl1271_tx_enabled_rates_get(wl, sta_rates); 267830fb67b8e37fb03cf703b4e1217fe30ce32d579Juuso Oikarinen wl1271_acx_rate_policies(wl); 268830fb67b8e37fb03cf703b4e1217fe30ce32d579Juuso Oikarinen } 269830fb67b8e37fb03cf703b4e1217fe30ce32d579Juuso Oikarinen 270f5fc0f86b02afef1119b523623b4cde41475bc8cLuciano Coelho while ((skb = skb_dequeue(&wl->tx_queue))) { 271f5fc0f86b02afef1119b523623b4cde41475bc8cLuciano Coelho if (!woken_up) { 272f5fc0f86b02afef1119b523623b4cde41475bc8cLuciano Coelho ret = wl1271_ps_elp_wakeup(wl, false); 273f5fc0f86b02afef1119b523623b4cde41475bc8cLuciano Coelho if (ret < 0) 274ffb591cd0e32d817bdbd359dead3baa770b999f8Juuso Oikarinen goto out_ack; 275f5fc0f86b02afef1119b523623b4cde41475bc8cLuciano Coelho woken_up = true; 276f5fc0f86b02afef1119b523623b4cde41475bc8cLuciano Coelho } 277f5fc0f86b02afef1119b523623b4cde41475bc8cLuciano Coelho 278f5fc0f86b02afef1119b523623b4cde41475bc8cLuciano Coelho ret = wl1271_tx_frame(wl, skb); 279f5fc0f86b02afef1119b523623b4cde41475bc8cLuciano Coelho if (ret == -EBUSY) { 28006f7bc7db79fabe6b2ec16eff0f59e4acc21eb72Juuso Oikarinen /* firmware buffer is full, lets stop transmitting. */ 281f5fc0f86b02afef1119b523623b4cde41475bc8cLuciano Coelho skb_queue_head(&wl->tx_queue, skb); 282ffb591cd0e32d817bdbd359dead3baa770b999f8Juuso Oikarinen goto out_ack; 283f5fc0f86b02afef1119b523623b4cde41475bc8cLuciano Coelho } else if (ret < 0) { 284f5fc0f86b02afef1119b523623b4cde41475bc8cLuciano Coelho dev_kfree_skb(skb); 285ffb591cd0e32d817bdbd359dead3baa770b999f8Juuso Oikarinen goto out_ack; 286f5fc0f86b02afef1119b523623b4cde41475bc8cLuciano Coelho } 287f5fc0f86b02afef1119b523623b4cde41475bc8cLuciano Coelho } 288f5fc0f86b02afef1119b523623b4cde41475bc8cLuciano Coelho 289ffb591cd0e32d817bdbd359dead3baa770b999f8Juuso Oikarinenout_ack: 290ffb591cd0e32d817bdbd359dead3baa770b999f8Juuso Oikarinen /* interrupt the firmware with the new packets */ 291ffb591cd0e32d817bdbd359dead3baa770b999f8Juuso Oikarinen if (prev_tx_packets_count != wl->tx_packets_count) 292ffb591cd0e32d817bdbd359dead3baa770b999f8Juuso Oikarinen wl1271_write32(wl, WL1271_HOST_WR_ACCESS, wl->tx_packets_count); 293ffb591cd0e32d817bdbd359dead3baa770b999f8Juuso Oikarinen 294f5fc0f86b02afef1119b523623b4cde41475bc8cLuciano Coelhoout: 295f5fc0f86b02afef1119b523623b4cde41475bc8cLuciano Coelho if (woken_up) 296f5fc0f86b02afef1119b523623b4cde41475bc8cLuciano Coelho wl1271_ps_elp_sleep(wl); 297f5fc0f86b02afef1119b523623b4cde41475bc8cLuciano Coelho 298f5fc0f86b02afef1119b523623b4cde41475bc8cLuciano Coelho mutex_unlock(&wl->mutex); 299f5fc0f86b02afef1119b523623b4cde41475bc8cLuciano Coelho} 300f5fc0f86b02afef1119b523623b4cde41475bc8cLuciano Coelho 301f5fc0f86b02afef1119b523623b4cde41475bc8cLuciano Coelhostatic void wl1271_tx_complete_packet(struct wl1271 *wl, 302f5fc0f86b02afef1119b523623b4cde41475bc8cLuciano Coelho struct wl1271_tx_hw_res_descr *result) 303f5fc0f86b02afef1119b523623b4cde41475bc8cLuciano Coelho{ 304f5fc0f86b02afef1119b523623b4cde41475bc8cLuciano Coelho struct ieee80211_tx_info *info; 305f5fc0f86b02afef1119b523623b4cde41475bc8cLuciano Coelho struct sk_buff *skb; 306f5fc0f86b02afef1119b523623b4cde41475bc8cLuciano Coelho int id = result->id; 30731627dc59b4a87c4198b4245a7de1b8ccf4424faJuuso Oikarinen int rate = -1; 30831627dc59b4a87c4198b4245a7de1b8ccf4424faJuuso Oikarinen u8 retries = 0; 309f5fc0f86b02afef1119b523623b4cde41475bc8cLuciano Coelho 310f5fc0f86b02afef1119b523623b4cde41475bc8cLuciano Coelho /* check for id legality */ 311ffb591cd0e32d817bdbd359dead3baa770b999f8Juuso Oikarinen if (unlikely(id >= ACX_TX_DESCRIPTORS || wl->tx_frames[id] == NULL)) { 312f5fc0f86b02afef1119b523623b4cde41475bc8cLuciano Coelho wl1271_warning("TX result illegal id: %d", id); 313f5fc0f86b02afef1119b523623b4cde41475bc8cLuciano Coelho return; 314f5fc0f86b02afef1119b523623b4cde41475bc8cLuciano Coelho } 315f5fc0f86b02afef1119b523623b4cde41475bc8cLuciano Coelho 316f5fc0f86b02afef1119b523623b4cde41475bc8cLuciano Coelho skb = wl->tx_frames[id]; 317f5fc0f86b02afef1119b523623b4cde41475bc8cLuciano Coelho info = IEEE80211_SKB_CB(skb); 318f5fc0f86b02afef1119b523623b4cde41475bc8cLuciano Coelho 31931627dc59b4a87c4198b4245a7de1b8ccf4424faJuuso Oikarinen /* update the TX status info */ 32031627dc59b4a87c4198b4245a7de1b8ccf4424faJuuso Oikarinen if (result->status == TX_SUCCESS) { 32131627dc59b4a87c4198b4245a7de1b8ccf4424faJuuso Oikarinen if (!(info->flags & IEEE80211_TX_CTL_NO_ACK)) 322f5fc0f86b02afef1119b523623b4cde41475bc8cLuciano Coelho info->flags |= IEEE80211_TX_STAT_ACK; 32331627dc59b4a87c4198b4245a7de1b8ccf4424faJuuso Oikarinen rate = wl1271_rate_to_idx(wl, result->rate_class_index); 32431627dc59b4a87c4198b4245a7de1b8ccf4424faJuuso Oikarinen retries = result->ack_failures; 32531627dc59b4a87c4198b4245a7de1b8ccf4424faJuuso Oikarinen } else if (result->status == TX_RETRY_EXCEEDED) { 32631627dc59b4a87c4198b4245a7de1b8ccf4424faJuuso Oikarinen wl->stats.excessive_retries++; 32731627dc59b4a87c4198b4245a7de1b8ccf4424faJuuso Oikarinen retries = result->ack_failures; 328f5fc0f86b02afef1119b523623b4cde41475bc8cLuciano Coelho } 329f5fc0f86b02afef1119b523623b4cde41475bc8cLuciano Coelho 33031627dc59b4a87c4198b4245a7de1b8ccf4424faJuuso Oikarinen info->status.rates[0].idx = rate; 33131627dc59b4a87c4198b4245a7de1b8ccf4424faJuuso Oikarinen info->status.rates[0].count = retries; 33231627dc59b4a87c4198b4245a7de1b8ccf4424faJuuso Oikarinen info->status.rates[0].flags = 0; 33331627dc59b4a87c4198b4245a7de1b8ccf4424faJuuso Oikarinen info->status.ack_signal = -1; 33431627dc59b4a87c4198b4245a7de1b8ccf4424faJuuso Oikarinen 335f5fc0f86b02afef1119b523623b4cde41475bc8cLuciano Coelho wl->stats.retry_count += result->ack_failures; 336f5fc0f86b02afef1119b523623b4cde41475bc8cLuciano Coelho 337ac4e4ce54eb9cb4963a1d3d91fc65536d882ffb2Juuso Oikarinen /* update security sequence number */ 33804e36fc5f1ff4e349ea21de8d15e4e1844d04197Juuso Oikarinen wl->tx_security_seq += (result->lsb_security_sequence_number - 33904e36fc5f1ff4e349ea21de8d15e4e1844d04197Juuso Oikarinen wl->tx_security_last_seq); 340ac4e4ce54eb9cb4963a1d3d91fc65536d882ffb2Juuso Oikarinen wl->tx_security_last_seq = result->lsb_security_sequence_number; 341ac4e4ce54eb9cb4963a1d3d91fc65536d882ffb2Juuso Oikarinen 3421e2b79761d551c545225e1fa6e7d144f7e804898Juuso Oikarinen /* remove private header from packet */ 3431e2b79761d551c545225e1fa6e7d144f7e804898Juuso Oikarinen skb_pull(skb, sizeof(struct wl1271_tx_hw_descr)); 3441e2b79761d551c545225e1fa6e7d144f7e804898Juuso Oikarinen 3451e2b79761d551c545225e1fa6e7d144f7e804898Juuso Oikarinen /* remove TKIP header space if present */ 346f5fc0f86b02afef1119b523623b4cde41475bc8cLuciano Coelho if (info->control.hw_key && 3471e2b79761d551c545225e1fa6e7d144f7e804898Juuso Oikarinen info->control.hw_key->alg == ALG_TKIP) { 3481e2b79761d551c545225e1fa6e7d144f7e804898Juuso Oikarinen int hdrlen = ieee80211_get_hdrlen_from_skb(skb); 3491e2b79761d551c545225e1fa6e7d144f7e804898Juuso Oikarinen memmove(skb->data + WL1271_TKIP_IV_SPACE, skb->data, hdrlen); 3501e2b79761d551c545225e1fa6e7d144f7e804898Juuso Oikarinen skb_pull(skb, WL1271_TKIP_IV_SPACE); 3511e2b79761d551c545225e1fa6e7d144f7e804898Juuso Oikarinen } 352f5fc0f86b02afef1119b523623b4cde41475bc8cLuciano Coelho 353f5fc0f86b02afef1119b523623b4cde41475bc8cLuciano Coelho wl1271_debug(DEBUG_TX, "tx status id %u skb 0x%p failures %u rate 0x%x" 354f5fc0f86b02afef1119b523623b4cde41475bc8cLuciano Coelho " status 0x%x", 355f5fc0f86b02afef1119b523623b4cde41475bc8cLuciano Coelho result->id, skb, result->ack_failures, 356f5fc0f86b02afef1119b523623b4cde41475bc8cLuciano Coelho result->rate_class_index, result->status); 357f5fc0f86b02afef1119b523623b4cde41475bc8cLuciano Coelho 358f5fc0f86b02afef1119b523623b4cde41475bc8cLuciano Coelho /* return the packet to the stack */ 359f5fc0f86b02afef1119b523623b4cde41475bc8cLuciano Coelho ieee80211_tx_status(wl->hw, skb); 360f5fc0f86b02afef1119b523623b4cde41475bc8cLuciano Coelho wl->tx_frames[result->id] = NULL; 361f5fc0f86b02afef1119b523623b4cde41475bc8cLuciano Coelho} 362f5fc0f86b02afef1119b523623b4cde41475bc8cLuciano Coelho 363f5fc0f86b02afef1119b523623b4cde41475bc8cLuciano Coelho/* Called upon reception of a TX complete interrupt */ 364ffb591cd0e32d817bdbd359dead3baa770b999f8Juuso Oikarinenvoid wl1271_tx_complete(struct wl1271 *wl) 365f5fc0f86b02afef1119b523623b4cde41475bc8cLuciano Coelho{ 366f5fc0f86b02afef1119b523623b4cde41475bc8cLuciano Coelho struct wl1271_acx_mem_map *memmap = 367f5fc0f86b02afef1119b523623b4cde41475bc8cLuciano Coelho (struct wl1271_acx_mem_map *)wl->target_mem_map; 368ffb591cd0e32d817bdbd359dead3baa770b999f8Juuso Oikarinen u32 count, fw_counter; 369f5fc0f86b02afef1119b523623b4cde41475bc8cLuciano Coelho u32 i; 370f5fc0f86b02afef1119b523623b4cde41475bc8cLuciano Coelho 371f5fc0f86b02afef1119b523623b4cde41475bc8cLuciano Coelho /* read the tx results from the chipset */ 3727b048c52d7283ebf07c826a45c631a6ba225c057Teemu Paasikivi wl1271_read(wl, le32_to_cpu(memmap->tx_result), 3737b048c52d7283ebf07c826a45c631a6ba225c057Teemu Paasikivi wl->tx_res_if, sizeof(*wl->tx_res_if), false); 374ffb591cd0e32d817bdbd359dead3baa770b999f8Juuso Oikarinen fw_counter = le32_to_cpu(wl->tx_res_if->tx_result_fw_counter); 375ffb591cd0e32d817bdbd359dead3baa770b999f8Juuso Oikarinen 376ffb591cd0e32d817bdbd359dead3baa770b999f8Juuso Oikarinen /* write host counter to chipset (to ack) */ 377ffb591cd0e32d817bdbd359dead3baa770b999f8Juuso Oikarinen wl1271_write32(wl, le32_to_cpu(memmap->tx_result) + 378ffb591cd0e32d817bdbd359dead3baa770b999f8Juuso Oikarinen offsetof(struct wl1271_tx_hw_res_if, 379ffb591cd0e32d817bdbd359dead3baa770b999f8Juuso Oikarinen tx_result_host_counter), fw_counter); 380ffb591cd0e32d817bdbd359dead3baa770b999f8Juuso Oikarinen 381ffb591cd0e32d817bdbd359dead3baa770b999f8Juuso Oikarinen count = fw_counter - wl->tx_results_count; 38206f7bc7db79fabe6b2ec16eff0f59e4acc21eb72Juuso Oikarinen wl1271_debug(DEBUG_TX, "tx_complete received, packets: %d", count); 383f5fc0f86b02afef1119b523623b4cde41475bc8cLuciano Coelho 384f5fc0f86b02afef1119b523623b4cde41475bc8cLuciano Coelho /* verify that the result buffer is not getting overrun */ 385ffb591cd0e32d817bdbd359dead3baa770b999f8Juuso Oikarinen if (unlikely(count > TX_HW_RESULT_QUEUE_LEN)) 386f5fc0f86b02afef1119b523623b4cde41475bc8cLuciano Coelho wl1271_warning("TX result overflow from chipset: %d", count); 387f5fc0f86b02afef1119b523623b4cde41475bc8cLuciano Coelho 388f5fc0f86b02afef1119b523623b4cde41475bc8cLuciano Coelho /* process the results */ 389f5fc0f86b02afef1119b523623b4cde41475bc8cLuciano Coelho for (i = 0; i < count; i++) { 390f5fc0f86b02afef1119b523623b4cde41475bc8cLuciano Coelho struct wl1271_tx_hw_res_descr *result; 391f5fc0f86b02afef1119b523623b4cde41475bc8cLuciano Coelho u8 offset = wl->tx_results_count & TX_HW_RESULT_QUEUE_LEN_MASK; 392f5fc0f86b02afef1119b523623b4cde41475bc8cLuciano Coelho 393f5fc0f86b02afef1119b523623b4cde41475bc8cLuciano Coelho /* process the packet */ 394f5fc0f86b02afef1119b523623b4cde41475bc8cLuciano Coelho result = &(wl->tx_res_if->tx_results_queue[offset]); 395f5fc0f86b02afef1119b523623b4cde41475bc8cLuciano Coelho wl1271_tx_complete_packet(wl, result); 396f5fc0f86b02afef1119b523623b4cde41475bc8cLuciano Coelho 397f5fc0f86b02afef1119b523623b4cde41475bc8cLuciano Coelho wl->tx_results_count++; 398f5fc0f86b02afef1119b523623b4cde41475bc8cLuciano Coelho } 39906f7bc7db79fabe6b2ec16eff0f59e4acc21eb72Juuso Oikarinen 40006f7bc7db79fabe6b2ec16eff0f59e4acc21eb72Juuso Oikarinen if (test_bit(WL1271_FLAG_TX_QUEUE_STOPPED, &wl->flags) && 40106f7bc7db79fabe6b2ec16eff0f59e4acc21eb72Juuso Oikarinen skb_queue_len(&wl->tx_queue) <= WL1271_TX_QUEUE_LOW_WATERMARK) { 40206f7bc7db79fabe6b2ec16eff0f59e4acc21eb72Juuso Oikarinen unsigned long flags; 40306f7bc7db79fabe6b2ec16eff0f59e4acc21eb72Juuso Oikarinen 40406f7bc7db79fabe6b2ec16eff0f59e4acc21eb72Juuso Oikarinen /* firmware buffer has space, restart queues */ 40506f7bc7db79fabe6b2ec16eff0f59e4acc21eb72Juuso Oikarinen wl1271_debug(DEBUG_TX, "tx_complete: waking queues"); 40606f7bc7db79fabe6b2ec16eff0f59e4acc21eb72Juuso Oikarinen spin_lock_irqsave(&wl->wl_lock, flags); 40706f7bc7db79fabe6b2ec16eff0f59e4acc21eb72Juuso Oikarinen ieee80211_wake_queues(wl->hw); 40806f7bc7db79fabe6b2ec16eff0f59e4acc21eb72Juuso Oikarinen clear_bit(WL1271_FLAG_TX_QUEUE_STOPPED, &wl->flags); 40906f7bc7db79fabe6b2ec16eff0f59e4acc21eb72Juuso Oikarinen spin_unlock_irqrestore(&wl->wl_lock, flags); 41006f7bc7db79fabe6b2ec16eff0f59e4acc21eb72Juuso Oikarinen ieee80211_queue_work(wl->hw, &wl->tx_work); 41106f7bc7db79fabe6b2ec16eff0f59e4acc21eb72Juuso Oikarinen } 412f5fc0f86b02afef1119b523623b4cde41475bc8cLuciano Coelho} 413f5fc0f86b02afef1119b523623b4cde41475bc8cLuciano Coelho 414f5fc0f86b02afef1119b523623b4cde41475bc8cLuciano Coelho/* caller must hold wl->mutex */ 415f5fc0f86b02afef1119b523623b4cde41475bc8cLuciano Coelhovoid wl1271_tx_flush(struct wl1271 *wl) 416f5fc0f86b02afef1119b523623b4cde41475bc8cLuciano Coelho{ 417f5fc0f86b02afef1119b523623b4cde41475bc8cLuciano Coelho int i; 418f5fc0f86b02afef1119b523623b4cde41475bc8cLuciano Coelho struct sk_buff *skb; 419f5fc0f86b02afef1119b523623b4cde41475bc8cLuciano Coelho struct ieee80211_tx_info *info; 420f5fc0f86b02afef1119b523623b4cde41475bc8cLuciano Coelho 421f5fc0f86b02afef1119b523623b4cde41475bc8cLuciano Coelho /* TX failure */ 422f5fc0f86b02afef1119b523623b4cde41475bc8cLuciano Coelho/* control->flags = 0; FIXME */ 423f5fc0f86b02afef1119b523623b4cde41475bc8cLuciano Coelho 424f5fc0f86b02afef1119b523623b4cde41475bc8cLuciano Coelho while ((skb = skb_dequeue(&wl->tx_queue))) { 425f5fc0f86b02afef1119b523623b4cde41475bc8cLuciano Coelho info = IEEE80211_SKB_CB(skb); 426f5fc0f86b02afef1119b523623b4cde41475bc8cLuciano Coelho 427f5fc0f86b02afef1119b523623b4cde41475bc8cLuciano Coelho wl1271_debug(DEBUG_TX, "flushing skb 0x%p", skb); 428f5fc0f86b02afef1119b523623b4cde41475bc8cLuciano Coelho 429f5fc0f86b02afef1119b523623b4cde41475bc8cLuciano Coelho if (!(info->flags & IEEE80211_TX_CTL_REQ_TX_STATUS)) 430f5fc0f86b02afef1119b523623b4cde41475bc8cLuciano Coelho continue; 431f5fc0f86b02afef1119b523623b4cde41475bc8cLuciano Coelho 432f5fc0f86b02afef1119b523623b4cde41475bc8cLuciano Coelho ieee80211_tx_status(wl->hw, skb); 433f5fc0f86b02afef1119b523623b4cde41475bc8cLuciano Coelho } 434f5fc0f86b02afef1119b523623b4cde41475bc8cLuciano Coelho 435be7078c21d826fbaab77f88440958019aab969afJuuso Oikarinen for (i = 0; i < ACX_TX_DESCRIPTORS; i++) 436f5fc0f86b02afef1119b523623b4cde41475bc8cLuciano Coelho if (wl->tx_frames[i] != NULL) { 437f5fc0f86b02afef1119b523623b4cde41475bc8cLuciano Coelho skb = wl->tx_frames[i]; 438f5fc0f86b02afef1119b523623b4cde41475bc8cLuciano Coelho info = IEEE80211_SKB_CB(skb); 439f5fc0f86b02afef1119b523623b4cde41475bc8cLuciano Coelho 440f5fc0f86b02afef1119b523623b4cde41475bc8cLuciano Coelho if (!(info->flags & IEEE80211_TX_CTL_REQ_TX_STATUS)) 441f5fc0f86b02afef1119b523623b4cde41475bc8cLuciano Coelho continue; 442f5fc0f86b02afef1119b523623b4cde41475bc8cLuciano Coelho 443f5fc0f86b02afef1119b523623b4cde41475bc8cLuciano Coelho ieee80211_tx_status(wl->hw, skb); 444f5fc0f86b02afef1119b523623b4cde41475bc8cLuciano Coelho wl->tx_frames[i] = NULL; 445f5fc0f86b02afef1119b523623b4cde41475bc8cLuciano Coelho } 446f5fc0f86b02afef1119b523623b4cde41475bc8cLuciano Coelho} 447