2 * carl9170 firmware - used by the ar9170 wireless device
4 * DMA descriptor handling functions
6 * Copyright (c) 2000-2005 ZyDAS Technology Corporation
7 * Copyright (c) 2007-2009 Atheros Communications, Inc.
8 * Copyright 2009 Johannes Berg <johannes@sipsolutions.net>
9 * Copyright 2009-2011 Christian Lamparter <chunkeey@googlemail.com>
11 * This program is free software; you can redistribute it and/or modify
12 * it under the terms of the GNU General Public License as published by
13 * the Free Software Foundation; either version 2 of the License, or
14 * (at your option) any later version.
16 * This program is distributed in the hope that it will be useful,
17 * but WITHOUT ANY WARRANTY; without even the implied warranty of
18 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
19 * GNU General Public License for more details.
21 * You should have received a copy of the GNU General Public License along
22 * with this program; if not, write to the Free Software Foundation, Inc.,
23 * 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301 USA.
30 struct ar9170_dma_memory dma_mem __section(sram);
32 static void copy_dma_desc(struct dma_desc *dst,
35 memcpy(dst, src, sizeof(struct dma_desc));
38 static void clear_descriptor(struct dma_desc *d)
40 d->status = AR9170_OWN_BITS_SW;
49 static void fill_descriptor(struct dma_desc *d, uint16_t size, uint8_t *data)
51 d->status = AR9170_OWN_BITS_SW;
61 * - Init up_queue, down_queue, tx_queue[5], rx_queue.
62 * - Setup descriptors and data buffer address.
63 * - Ring descriptors rx_queue and down_queue by dma_reclaim().
65 * NOTE: LastAddr tempary point (same) to nextAddr after initialize.
66 * Because LastAddr is don't care in function dma_reclaim().
68 void dma_init_descriptors(void)
72 for (i = 0; i < ARRAY_SIZE(dma_mem.terminator); i++)
73 clear_descriptor(&dma_mem.terminator[i]);
75 /* Assign terminators to DMA queues */
77 fw.pta.up_queue.head = fw.pta.up_queue.terminator = &dma_mem.terminator[i++];
78 fw.pta.down_queue.head = fw.pta.down_queue.terminator = &dma_mem.terminator[i++];
79 for (j = 0; j < __AR9170_NUM_TX_QUEUES; j++)
80 fw.wlan.tx_queue[j].head = fw.wlan.tx_queue[j].terminator = &dma_mem.terminator[i++];
81 fw.wlan.tx_retry.head = fw.wlan.tx_retry.terminator = &dma_mem.terminator[i++];
82 fw.wlan.rx_queue.head = fw.wlan.rx_queue.terminator = &dma_mem.terminator[i++];
83 fw.usb.int_desc = &dma_mem.terminator[i++];
84 fw.wlan.fw_desc = &dma_mem.terminator[i++];
86 #ifdef CONFIG_CARL9170FW_CAB_QUEUE
88 # if (CARL9170_INTF_NUM != 2)
89 for (j = 0; j < CARL9170_INTF_NUM; j++)
90 fw.wlan.cab_queue[j].head = fw.wlan.cab_queue[j].terminator = &dma_mem.terminator[i++];
92 fw.wlan.cab_queue[0].head = fw.wlan.cab_queue[0].terminator = &dma_mem.terminator[i++];
93 fw.wlan.cab_queue[1].head = fw.wlan.cab_queue[1].terminator = &dma_mem.terminator[i++];
95 #endif /* CONFIG_CARL9170FW_CAB_QUEUE */
97 BUILD_BUG_ON(AR9170_TERMINATOR_NUMBER != j);
99 DBG("Blocks:%d [tx:%d, rx:%d] Terminators:%d/%d\n",
100 AR9170_BLOCK_NUMBER, AR9170_TX_BLOCK_NUMBER,
101 AR9170_RX_BLOCK_NUMBER, AR9170_TERMINATOR_NUMBER, i);
103 /* Init descriptors and memory blocks */
104 for (i = 0; i < AR9170_BLOCK_NUMBER; i++) {
105 fill_descriptor(&dma_mem.block[i], AR9170_BLOCK_SIZE, dma_mem.data[i].data);
107 if (i < AR9170_TX_BLOCK_NUMBER)
108 dma_reclaim(&fw.pta.down_queue, &dma_mem.block[i]);
110 dma_reclaim(&fw.wlan.rx_queue, &dma_mem.block[i]);
113 /* Set DMA address registers */
114 set(AR9170_PTA_REG_DN_DMA_ADDRH, (uint32_t) fw.pta.down_queue.head >> 16);
115 set(AR9170_PTA_REG_DN_DMA_ADDRL, (uint32_t) fw.pta.down_queue.head & 0xffff);
116 set(AR9170_PTA_REG_UP_DMA_ADDRH, (uint32_t) fw.pta.up_queue.head >> 16);
117 set(AR9170_PTA_REG_UP_DMA_ADDRL, (uint32_t) fw.pta.up_queue.head & 0xffff);
119 for (i = 0; i < __AR9170_NUM_TX_QUEUES; i++)
120 set_wlan_txq_dma_addr(i, (uint32_t) fw.wlan.tx_queue[i].head);
122 set(AR9170_MAC_REG_DMA_RXQ_ADDR, (uint32_t) fw.wlan.rx_queue.head);
123 fw.usb.int_desc->dataSize = AR9170_BLOCK_SIZE;
124 fw.usb.int_desc->dataAddr = (void *) &dma_mem.reserved.rsp;
126 memset(DESC_PAYLOAD(fw.usb.int_desc), 0xff,
127 AR9170_INT_MAGIC_HEADER_SIZE);
128 memset(DESC_PAYLOAD_OFF(fw.usb.int_desc, AR9170_INT_MAGIC_HEADER_SIZE),
129 0, AR9170_BLOCK_SIZE - AR9170_INT_MAGIC_HEADER_SIZE);
131 /* rsp is now available for use */
132 fw.usb.int_desc_available = 1;
134 memset(DESC_PAYLOAD(fw.wlan.fw_desc), 0, 128);
135 fw.wlan.fw_desc_available = 1;
141 * Exchange the terminator and the first descriptor of the packet
142 * for hardware ascy...
144 void dma_reclaim(struct dma_queue *q, struct dma_desc *desc)
146 struct dma_desc *tmpDesc, *last;
147 struct dma_desc tdesc;
149 /* 1. Set OWN bit to HW for all TDs to be added, clear ctrl and size */
151 last = desc->lastAddr;
154 tmpDesc->status = AR9170_OWN_BITS_HW;
156 tmpDesc->totalLen = 0;
157 tmpDesc->dataSize = AR9170_BLOCK_SIZE;
159 /* TODO : Exception handle */
161 tmpDesc->lastAddr = tmpDesc;
166 tmpDesc = tmpDesc->nextAddr;
169 /* 2. Next address of Last TD to be added = first TD */
170 tmpDesc->nextAddr = desc;
172 /* Link first TD to self */
173 desc->lastAddr = q->terminator;
175 /* 3. Copy first TD to be added to TTD */
176 copy_dma_desc(&tdesc, desc);
178 /* 4. Initialize new terminator */
179 clear_descriptor(desc);
181 /* 5. Copy TTD to last TD */
183 copy_dma_desc((void *)q->terminator, (void *)&tdesc);
184 q->terminator->status |= AR9170_OWN_BITS_HW;
186 /* Update terminator pointer */
187 q->terminator = desc;
191 * Put a complete packet into the tail of the Queue q.
192 * Exchange the terminator and the first descriptor of the packet
193 * for hardware ascy...
195 void dma_put(struct dma_queue *q, struct dma_desc *desc)
197 struct dma_desc *tmpDesc;
198 struct dma_desc tdesc;
203 /* update totalLen */
204 tmpDesc->totalLen = desc->totalLen;
206 /* 1. Set OWN bit to HW for all TDs to be added */
207 tmpDesc->status = AR9170_OWN_BITS_HW;
208 /* TODO : Exception handle */
210 tmpDesc->lastAddr = desc->lastAddr;
212 if (desc->lastAddr == tmpDesc)
215 tmpDesc = tmpDesc->nextAddr;
218 /* 2. Next address of Last TD to be added = first TD */
219 desc->lastAddr->nextAddr = desc;
221 /* If there is only one descriptor, update pointer of last descriptor */
222 if (desc->lastAddr == desc)
223 desc->lastAddr = q->terminator;
225 /* 3. Copy first TD to be added to TTD */
226 copy_dma_desc(&tdesc, desc);
228 /* 4. Initialize new terminator */
229 clear_descriptor(desc);
231 /* 5. Copy TTD to last TD */
232 tdesc.status &= (~AR9170_OWN_BITS);
233 copy_dma_desc((void *)q->terminator, (void *)&tdesc);
234 q->terminator->status |= AR9170_OWN_BITS_HW;
236 /* Update terminator pointer */
237 q->terminator = desc;
240 struct dma_desc *dma_unlink_head(struct dma_queue *queue)
242 struct dma_desc *desc;
244 if (queue_empty(queue))
249 queue->head = desc->lastAddr->nextAddr;
251 /* poison nextAddr address */
252 desc->lastAddr->nextAddr = desc->lastAddr;
253 desc->lastAddr->lastAddr = desc->lastAddr;