1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16#include <linux/kernel.h>
17#include <linux/module.h>
18#include <linux/firmware.h>
19#include <linux/pci.h>
20#include <linux/vmalloc.h>
21#include <linux/delay.h>
22#include <linux/interrupt.h>
23#include <linux/bcma/bcma.h>
24#include <linux/sched.h>
25#include <asm/unaligned.h>
26
27#include <soc.h>
28#include <chipcommon.h>
29#include <brcmu_utils.h>
30#include <brcmu_wifi.h>
31#include <brcm_hw_ids.h>
32
33#include "debug.h"
34#include "bus.h"
35#include "commonring.h"
36#include "msgbuf.h"
37#include "pcie.h"
38#include "firmware.h"
39#include "chip.h"
40#include "core.h"
41#include "common.h"
42
43
44enum brcmf_pcie_state {
45 BRCMFMAC_PCIE_STATE_DOWN,
46 BRCMFMAC_PCIE_STATE_UP
47};
48
49BRCMF_FW_NVRAM_DEF(43602, "brcmfmac43602-pcie.bin", "brcmfmac43602-pcie.txt");
50BRCMF_FW_NVRAM_DEF(4350, "brcmfmac4350-pcie.bin", "brcmfmac4350-pcie.txt");
51BRCMF_FW_NVRAM_DEF(4350C, "brcmfmac4350c2-pcie.bin", "brcmfmac4350c2-pcie.txt");
52BRCMF_FW_NVRAM_DEF(4356, "brcmfmac4356-pcie.bin", "brcmfmac4356-pcie.txt");
53BRCMF_FW_NVRAM_DEF(43570, "brcmfmac43570-pcie.bin", "brcmfmac43570-pcie.txt");
54BRCMF_FW_NVRAM_DEF(4358, "brcmfmac4358-pcie.bin", "brcmfmac4358-pcie.txt");
55BRCMF_FW_NVRAM_DEF(4359, "brcmfmac4359-pcie.bin", "brcmfmac4359-pcie.txt");
56BRCMF_FW_NVRAM_DEF(4365B, "brcmfmac4365b-pcie.bin", "brcmfmac4365b-pcie.txt");
57BRCMF_FW_NVRAM_DEF(4365C, "brcmfmac4365c-pcie.bin", "brcmfmac4365c-pcie.txt");
58BRCMF_FW_NVRAM_DEF(4366B, "brcmfmac4366b-pcie.bin", "brcmfmac4366b-pcie.txt");
59BRCMF_FW_NVRAM_DEF(4366C, "brcmfmac4366c-pcie.bin", "brcmfmac4366c-pcie.txt");
60BRCMF_FW_NVRAM_DEF(4371, "brcmfmac4371-pcie.bin", "brcmfmac4371-pcie.txt");
61
62static struct brcmf_firmware_mapping brcmf_pcie_fwnames[] = {
63 BRCMF_FW_NVRAM_ENTRY(BRCM_CC_43602_CHIP_ID, 0xFFFFFFFF, 43602),
64 BRCMF_FW_NVRAM_ENTRY(BRCM_CC_43465_CHIP_ID, 0xFFFFFFF0, 4366C),
65 BRCMF_FW_NVRAM_ENTRY(BRCM_CC_4350_CHIP_ID, 0x000000FF, 4350C),
66 BRCMF_FW_NVRAM_ENTRY(BRCM_CC_4350_CHIP_ID, 0xFFFFFF00, 4350),
67 BRCMF_FW_NVRAM_ENTRY(BRCM_CC_43525_CHIP_ID, 0xFFFFFFF0, 4365C),
68 BRCMF_FW_NVRAM_ENTRY(BRCM_CC_4356_CHIP_ID, 0xFFFFFFFF, 4356),
69 BRCMF_FW_NVRAM_ENTRY(BRCM_CC_43567_CHIP_ID, 0xFFFFFFFF, 43570),
70 BRCMF_FW_NVRAM_ENTRY(BRCM_CC_43569_CHIP_ID, 0xFFFFFFFF, 43570),
71 BRCMF_FW_NVRAM_ENTRY(BRCM_CC_43570_CHIP_ID, 0xFFFFFFFF, 43570),
72 BRCMF_FW_NVRAM_ENTRY(BRCM_CC_4358_CHIP_ID, 0xFFFFFFFF, 4358),
73 BRCMF_FW_NVRAM_ENTRY(BRCM_CC_4359_CHIP_ID, 0xFFFFFFFF, 4359),
74 BRCMF_FW_NVRAM_ENTRY(BRCM_CC_4365_CHIP_ID, 0x0000000F, 4365B),
75 BRCMF_FW_NVRAM_ENTRY(BRCM_CC_4365_CHIP_ID, 0xFFFFFFF0, 4365C),
76 BRCMF_FW_NVRAM_ENTRY(BRCM_CC_4366_CHIP_ID, 0x0000000F, 4366B),
77 BRCMF_FW_NVRAM_ENTRY(BRCM_CC_4366_CHIP_ID, 0xFFFFFFF0, 4366C),
78 BRCMF_FW_NVRAM_ENTRY(BRCM_CC_4371_CHIP_ID, 0xFFFFFFFF, 4371),
79};
80
81#define BRCMF_PCIE_FW_UP_TIMEOUT 2000
82
83#define BRCMF_PCIE_REG_MAP_SIZE (32 * 1024)
84
85
86#define BRCMF_PCIE_BAR0_WINDOW 0x80
87#define BRCMF_PCIE_BAR0_REG_SIZE 0x1000
88#define BRCMF_PCIE_BAR0_WRAPPERBASE 0x70
89
90#define BRCMF_PCIE_BAR0_WRAPBASE_DMP_OFFSET 0x1000
91#define BRCMF_PCIE_BARO_PCIE_ENUM_OFFSET 0x2000
92
93#define BRCMF_PCIE_ARMCR4REG_BANKIDX 0x40
94#define BRCMF_PCIE_ARMCR4REG_BANKPDA 0x4C
95
96#define BRCMF_PCIE_REG_INTSTATUS 0x90
97#define BRCMF_PCIE_REG_INTMASK 0x94
98#define BRCMF_PCIE_REG_SBMBX 0x98
99
100#define BRCMF_PCIE_REG_LINK_STATUS_CTRL 0xBC
101
102#define BRCMF_PCIE_PCIE2REG_INTMASK 0x24
103#define BRCMF_PCIE_PCIE2REG_MAILBOXINT 0x48
104#define BRCMF_PCIE_PCIE2REG_MAILBOXMASK 0x4C
105#define BRCMF_PCIE_PCIE2REG_CONFIGADDR 0x120
106#define BRCMF_PCIE_PCIE2REG_CONFIGDATA 0x124
107#define BRCMF_PCIE_PCIE2REG_H2D_MAILBOX 0x140
108
109#define BRCMF_PCIE2_INTA 0x01
110#define BRCMF_PCIE2_INTB 0x02
111
112#define BRCMF_PCIE_INT_0 0x01
113#define BRCMF_PCIE_INT_1 0x02
114#define BRCMF_PCIE_INT_DEF (BRCMF_PCIE_INT_0 | \
115 BRCMF_PCIE_INT_1)
116
117#define BRCMF_PCIE_MB_INT_FN0_0 0x0100
118#define BRCMF_PCIE_MB_INT_FN0_1 0x0200
119#define BRCMF_PCIE_MB_INT_D2H0_DB0 0x10000
120#define BRCMF_PCIE_MB_INT_D2H0_DB1 0x20000
121#define BRCMF_PCIE_MB_INT_D2H1_DB0 0x40000
122#define BRCMF_PCIE_MB_INT_D2H1_DB1 0x80000
123#define BRCMF_PCIE_MB_INT_D2H2_DB0 0x100000
124#define BRCMF_PCIE_MB_INT_D2H2_DB1 0x200000
125#define BRCMF_PCIE_MB_INT_D2H3_DB0 0x400000
126#define BRCMF_PCIE_MB_INT_D2H3_DB1 0x800000
127
128#define BRCMF_PCIE_MB_INT_D2H_DB (BRCMF_PCIE_MB_INT_D2H0_DB0 | \
129 BRCMF_PCIE_MB_INT_D2H0_DB1 | \
130 BRCMF_PCIE_MB_INT_D2H1_DB0 | \
131 BRCMF_PCIE_MB_INT_D2H1_DB1 | \
132 BRCMF_PCIE_MB_INT_D2H2_DB0 | \
133 BRCMF_PCIE_MB_INT_D2H2_DB1 | \
134 BRCMF_PCIE_MB_INT_D2H3_DB0 | \
135 BRCMF_PCIE_MB_INT_D2H3_DB1)
136
137#define BRCMF_PCIE_MIN_SHARED_VERSION 5
138#define BRCMF_PCIE_MAX_SHARED_VERSION 6
139#define BRCMF_PCIE_SHARED_VERSION_MASK 0x00FF
140#define BRCMF_PCIE_SHARED_DMA_INDEX 0x10000
141#define BRCMF_PCIE_SHARED_DMA_2B_IDX 0x100000
142
143#define BRCMF_PCIE_FLAGS_HTOD_SPLIT 0x4000
144#define BRCMF_PCIE_FLAGS_DTOH_SPLIT 0x8000
145
146#define BRCMF_SHARED_MAX_RXBUFPOST_OFFSET 34
147#define BRCMF_SHARED_RING_BASE_OFFSET 52
148#define BRCMF_SHARED_RX_DATAOFFSET_OFFSET 36
149#define BRCMF_SHARED_CONSOLE_ADDR_OFFSET 20
150#define BRCMF_SHARED_HTOD_MB_DATA_ADDR_OFFSET 40
151#define BRCMF_SHARED_DTOH_MB_DATA_ADDR_OFFSET 44
152#define BRCMF_SHARED_RING_INFO_ADDR_OFFSET 48
153#define BRCMF_SHARED_DMA_SCRATCH_LEN_OFFSET 52
154#define BRCMF_SHARED_DMA_SCRATCH_ADDR_OFFSET 56
155#define BRCMF_SHARED_DMA_RINGUPD_LEN_OFFSET 64
156#define BRCMF_SHARED_DMA_RINGUPD_ADDR_OFFSET 68
157
158#define BRCMF_RING_H2D_RING_COUNT_OFFSET 0
159#define BRCMF_RING_D2H_RING_COUNT_OFFSET 1
160#define BRCMF_RING_H2D_RING_MEM_OFFSET 4
161#define BRCMF_RING_H2D_RING_STATE_OFFSET 8
162
163#define BRCMF_RING_MEM_BASE_ADDR_OFFSET 8
164#define BRCMF_RING_MAX_ITEM_OFFSET 4
165#define BRCMF_RING_LEN_ITEMS_OFFSET 6
166#define BRCMF_RING_MEM_SZ 16
167#define BRCMF_RING_STATE_SZ 8
168
169#define BRCMF_DEF_MAX_RXBUFPOST 255
170
171#define BRCMF_CONSOLE_BUFADDR_OFFSET 8
172#define BRCMF_CONSOLE_BUFSIZE_OFFSET 12
173#define BRCMF_CONSOLE_WRITEIDX_OFFSET 16
174
175#define BRCMF_DMA_D2H_SCRATCH_BUF_LEN 8
176#define BRCMF_DMA_D2H_RINGUPD_BUF_LEN 1024
177
178#define BRCMF_D2H_DEV_D3_ACK 0x00000001
179#define BRCMF_D2H_DEV_DS_ENTER_REQ 0x00000002
180#define BRCMF_D2H_DEV_DS_EXIT_NOTE 0x00000004
181
182#define BRCMF_H2D_HOST_D3_INFORM 0x00000001
183#define BRCMF_H2D_HOST_DS_ACK 0x00000002
184#define BRCMF_H2D_HOST_D0_INFORM_IN_USE 0x00000008
185#define BRCMF_H2D_HOST_D0_INFORM 0x00000010
186
187#define BRCMF_PCIE_MBDATA_TIMEOUT msecs_to_jiffies(2000)
188
189#define BRCMF_PCIE_CFGREG_STATUS_CMD 0x4
190#define BRCMF_PCIE_CFGREG_PM_CSR 0x4C
191#define BRCMF_PCIE_CFGREG_MSI_CAP 0x58
192#define BRCMF_PCIE_CFGREG_MSI_ADDR_L 0x5C
193#define BRCMF_PCIE_CFGREG_MSI_ADDR_H 0x60
194#define BRCMF_PCIE_CFGREG_MSI_DATA 0x64
195#define BRCMF_PCIE_CFGREG_LINK_STATUS_CTRL 0xBC
196#define BRCMF_PCIE_CFGREG_LINK_STATUS_CTRL2 0xDC
197#define BRCMF_PCIE_CFGREG_RBAR_CTRL 0x228
198#define BRCMF_PCIE_CFGREG_PML1_SUB_CTRL1 0x248
199#define BRCMF_PCIE_CFGREG_REG_BAR2_CONFIG 0x4E0
200#define BRCMF_PCIE_CFGREG_REG_BAR3_CONFIG 0x4F4
201#define BRCMF_PCIE_LINK_STATUS_CTRL_ASPM_ENAB 3
202
203
204#define BRCMF_RAMSIZE_MAGIC 0x534d4152
205#define BRCMF_RAMSIZE_OFFSET 0x6c
206
207
208struct brcmf_pcie_console {
209 u32 base_addr;
210 u32 buf_addr;
211 u32 bufsize;
212 u32 read_idx;
213 u8 log_str[256];
214 u8 log_idx;
215};
216
217struct brcmf_pcie_shared_info {
218 u32 tcm_base_address;
219 u32 flags;
220 struct brcmf_pcie_ringbuf *commonrings[BRCMF_NROF_COMMON_MSGRINGS];
221 struct brcmf_pcie_ringbuf *flowrings;
222 u16 max_rxbufpost;
223 u16 max_flowrings;
224 u16 max_submissionrings;
225 u16 max_completionrings;
226 u32 rx_dataoffset;
227 u32 htod_mb_data_addr;
228 u32 dtoh_mb_data_addr;
229 u32 ring_info_addr;
230 struct brcmf_pcie_console console;
231 void *scratch;
232 dma_addr_t scratch_dmahandle;
233 void *ringupd;
234 dma_addr_t ringupd_dmahandle;
235 u8 version;
236};
237
238struct brcmf_pcie_core_info {
239 u32 base;
240 u32 wrapbase;
241};
242
243struct brcmf_pciedev_info {
244 enum brcmf_pcie_state state;
245 bool in_irq;
246 struct pci_dev *pdev;
247 char fw_name[BRCMF_FW_NAME_LEN];
248 char nvram_name[BRCMF_FW_NAME_LEN];
249 void __iomem *regs;
250 void __iomem *tcm;
251 u32 ram_base;
252 u32 ram_size;
253 struct brcmf_chip *ci;
254 u32 coreid;
255 struct brcmf_pcie_shared_info shared;
256 wait_queue_head_t mbdata_resp_wait;
257 bool mbdata_completed;
258 bool irq_allocated;
259 bool wowl_enabled;
260 u8 dma_idx_sz;
261 void *idxbuf;
262 u32 idxbuf_sz;
263 dma_addr_t idxbuf_dmahandle;
264 u16 (*read_ptr)(struct brcmf_pciedev_info *devinfo, u32 mem_offset);
265 void (*write_ptr)(struct brcmf_pciedev_info *devinfo, u32 mem_offset,
266 u16 value);
267 struct brcmf_mp_device *settings;
268};
269
270struct brcmf_pcie_ringbuf {
271 struct brcmf_commonring commonring;
272 dma_addr_t dma_handle;
273 u32 w_idx_addr;
274 u32 r_idx_addr;
275 struct brcmf_pciedev_info *devinfo;
276 u8 id;
277};
278
279
280
281
282
283
284
285
286
287
288
289
290
291
292
293
294
295struct brcmf_pcie_dhi_ringinfo {
296 __le32 ringmem;
297 __le32 h2d_w_idx_ptr;
298 __le32 h2d_r_idx_ptr;
299 __le32 d2h_w_idx_ptr;
300 __le32 d2h_r_idx_ptr;
301 struct msgbuf_buf_addr h2d_w_idx_hostaddr;
302 struct msgbuf_buf_addr h2d_r_idx_hostaddr;
303 struct msgbuf_buf_addr d2h_w_idx_hostaddr;
304 struct msgbuf_buf_addr d2h_r_idx_hostaddr;
305 __le16 max_flowrings;
306 __le16 max_submissionrings;
307 __le16 max_completionrings;
308};
309
310static const u32 brcmf_ring_max_item[BRCMF_NROF_COMMON_MSGRINGS] = {
311 BRCMF_H2D_MSGRING_CONTROL_SUBMIT_MAX_ITEM,
312 BRCMF_H2D_MSGRING_RXPOST_SUBMIT_MAX_ITEM,
313 BRCMF_D2H_MSGRING_CONTROL_COMPLETE_MAX_ITEM,
314 BRCMF_D2H_MSGRING_TX_COMPLETE_MAX_ITEM,
315 BRCMF_D2H_MSGRING_RX_COMPLETE_MAX_ITEM
316};
317
318static const u32 brcmf_ring_itemsize[BRCMF_NROF_COMMON_MSGRINGS] = {
319 BRCMF_H2D_MSGRING_CONTROL_SUBMIT_ITEMSIZE,
320 BRCMF_H2D_MSGRING_RXPOST_SUBMIT_ITEMSIZE,
321 BRCMF_D2H_MSGRING_CONTROL_COMPLETE_ITEMSIZE,
322 BRCMF_D2H_MSGRING_TX_COMPLETE_ITEMSIZE,
323 BRCMF_D2H_MSGRING_RX_COMPLETE_ITEMSIZE
324};
325
326
327static u32
328brcmf_pcie_read_reg32(struct brcmf_pciedev_info *devinfo, u32 reg_offset)
329{
330 void __iomem *address = devinfo->regs + reg_offset;
331
332 return (ioread32(address));
333}
334
335
336static void
337brcmf_pcie_write_reg32(struct brcmf_pciedev_info *devinfo, u32 reg_offset,
338 u32 value)
339{
340 void __iomem *address = devinfo->regs + reg_offset;
341
342 iowrite32(value, address);
343}
344
345
346static u8
347brcmf_pcie_read_tcm8(struct brcmf_pciedev_info *devinfo, u32 mem_offset)
348{
349 void __iomem *address = devinfo->tcm + mem_offset;
350
351 return (ioread8(address));
352}
353
354
355static u16
356brcmf_pcie_read_tcm16(struct brcmf_pciedev_info *devinfo, u32 mem_offset)
357{
358 void __iomem *address = devinfo->tcm + mem_offset;
359
360 return (ioread16(address));
361}
362
363
364static void
365brcmf_pcie_write_tcm16(struct brcmf_pciedev_info *devinfo, u32 mem_offset,
366 u16 value)
367{
368 void __iomem *address = devinfo->tcm + mem_offset;
369
370 iowrite16(value, address);
371}
372
373
374static u16
375brcmf_pcie_read_idx(struct brcmf_pciedev_info *devinfo, u32 mem_offset)
376{
377 u16 *address = devinfo->idxbuf + mem_offset;
378
379 return (*(address));
380}
381
382
383static void
384brcmf_pcie_write_idx(struct brcmf_pciedev_info *devinfo, u32 mem_offset,
385 u16 value)
386{
387 u16 *address = devinfo->idxbuf + mem_offset;
388
389 *(address) = value;
390}
391
392
393static u32
394brcmf_pcie_read_tcm32(struct brcmf_pciedev_info *devinfo, u32 mem_offset)
395{
396 void __iomem *address = devinfo->tcm + mem_offset;
397
398 return (ioread32(address));
399}
400
401
402static void
403brcmf_pcie_write_tcm32(struct brcmf_pciedev_info *devinfo, u32 mem_offset,
404 u32 value)
405{
406 void __iomem *address = devinfo->tcm + mem_offset;
407
408 iowrite32(value, address);
409}
410
411
412static u32
413brcmf_pcie_read_ram32(struct brcmf_pciedev_info *devinfo, u32 mem_offset)
414{
415 void __iomem *addr = devinfo->tcm + devinfo->ci->rambase + mem_offset;
416
417 return (ioread32(addr));
418}
419
420
421static void
422brcmf_pcie_write_ram32(struct brcmf_pciedev_info *devinfo, u32 mem_offset,
423 u32 value)
424{
425 void __iomem *addr = devinfo->tcm + devinfo->ci->rambase + mem_offset;
426
427 iowrite32(value, addr);
428}
429
430
431static void
432brcmf_pcie_copy_mem_todev(struct brcmf_pciedev_info *devinfo, u32 mem_offset,
433 void *srcaddr, u32 len)
434{
435 void __iomem *address = devinfo->tcm + mem_offset;
436 __le32 *src32;
437 __le16 *src16;
438 u8 *src8;
439
440 if (((ulong)address & 4) || ((ulong)srcaddr & 4) || (len & 4)) {
441 if (((ulong)address & 2) || ((ulong)srcaddr & 2) || (len & 2)) {
442 src8 = (u8 *)srcaddr;
443 while (len) {
444 iowrite8(*src8, address);
445 address++;
446 src8++;
447 len--;
448 }
449 } else {
450 len = len / 2;
451 src16 = (__le16 *)srcaddr;
452 while (len) {
453 iowrite16(le16_to_cpu(*src16), address);
454 address += 2;
455 src16++;
456 len--;
457 }
458 }
459 } else {
460 len = len / 4;
461 src32 = (__le32 *)srcaddr;
462 while (len) {
463 iowrite32(le32_to_cpu(*src32), address);
464 address += 4;
465 src32++;
466 len--;
467 }
468 }
469}
470
471
472static void
473brcmf_pcie_copy_dev_tomem(struct brcmf_pciedev_info *devinfo, u32 mem_offset,
474 void *dstaddr, u32 len)
475{
476 void __iomem *address = devinfo->tcm + mem_offset;
477 __le32 *dst32;
478 __le16 *dst16;
479 u8 *dst8;
480
481 if (((ulong)address & 4) || ((ulong)dstaddr & 4) || (len & 4)) {
482 if (((ulong)address & 2) || ((ulong)dstaddr & 2) || (len & 2)) {
483 dst8 = (u8 *)dstaddr;
484 while (len) {
485 *dst8 = ioread8(address);
486 address++;
487 dst8++;
488 len--;
489 }
490 } else {
491 len = len / 2;
492 dst16 = (__le16 *)dstaddr;
493 while (len) {
494 *dst16 = cpu_to_le16(ioread16(address));
495 address += 2;
496 dst16++;
497 len--;
498 }
499 }
500 } else {
501 len = len / 4;
502 dst32 = (__le32 *)dstaddr;
503 while (len) {
504 *dst32 = cpu_to_le32(ioread32(address));
505 address += 4;
506 dst32++;
507 len--;
508 }
509 }
510}
511
512
513#define WRITECC32(devinfo, reg, value) brcmf_pcie_write_reg32(devinfo, \
514 CHIPCREGOFFS(reg), value)
515
516
517static void
518brcmf_pcie_select_core(struct brcmf_pciedev_info *devinfo, u16 coreid)
519{
520 const struct pci_dev *pdev = devinfo->pdev;
521 struct brcmf_core *core;
522 u32 bar0_win;
523
524 core = brcmf_chip_get_core(devinfo->ci, coreid);
525 if (core) {
526 bar0_win = core->base;
527 pci_write_config_dword(pdev, BRCMF_PCIE_BAR0_WINDOW, bar0_win);
528 if (pci_read_config_dword(pdev, BRCMF_PCIE_BAR0_WINDOW,
529 &bar0_win) == 0) {
530 if (bar0_win != core->base) {
531 bar0_win = core->base;
532 pci_write_config_dword(pdev,
533 BRCMF_PCIE_BAR0_WINDOW,
534 bar0_win);
535 }
536 }
537 } else {
538 brcmf_err("Unsupported core selected %x\n", coreid);
539 }
540}
541
542
543static void brcmf_pcie_reset_device(struct brcmf_pciedev_info *devinfo)
544{
545 struct brcmf_core *core;
546 u16 cfg_offset[] = { BRCMF_PCIE_CFGREG_STATUS_CMD,
547 BRCMF_PCIE_CFGREG_PM_CSR,
548 BRCMF_PCIE_CFGREG_MSI_CAP,
549 BRCMF_PCIE_CFGREG_MSI_ADDR_L,
550 BRCMF_PCIE_CFGREG_MSI_ADDR_H,
551 BRCMF_PCIE_CFGREG_MSI_DATA,
552 BRCMF_PCIE_CFGREG_LINK_STATUS_CTRL2,
553 BRCMF_PCIE_CFGREG_RBAR_CTRL,
554 BRCMF_PCIE_CFGREG_PML1_SUB_CTRL1,
555 BRCMF_PCIE_CFGREG_REG_BAR2_CONFIG,
556 BRCMF_PCIE_CFGREG_REG_BAR3_CONFIG };
557 u32 i;
558 u32 val;
559 u32 lsc;
560
561 if (!devinfo->ci)
562 return;
563
564
565 brcmf_pcie_select_core(devinfo, BCMA_CORE_PCIE2);
566 pci_read_config_dword(devinfo->pdev, BRCMF_PCIE_REG_LINK_STATUS_CTRL,
567 &lsc);
568 val = lsc & (~BRCMF_PCIE_LINK_STATUS_CTRL_ASPM_ENAB);
569 pci_write_config_dword(devinfo->pdev, BRCMF_PCIE_REG_LINK_STATUS_CTRL,
570 val);
571
572
573 brcmf_pcie_select_core(devinfo, BCMA_CORE_CHIPCOMMON);
574 WRITECC32(devinfo, watchdog, 4);
575 msleep(100);
576
577
578 brcmf_pcie_select_core(devinfo, BCMA_CORE_PCIE2);
579 pci_write_config_dword(devinfo->pdev, BRCMF_PCIE_REG_LINK_STATUS_CTRL,
580 lsc);
581
582 core = brcmf_chip_get_core(devinfo->ci, BCMA_CORE_PCIE2);
583 if (core->rev <= 13) {
584 for (i = 0; i < ARRAY_SIZE(cfg_offset); i++) {
585 brcmf_pcie_write_reg32(devinfo,
586 BRCMF_PCIE_PCIE2REG_CONFIGADDR,
587 cfg_offset[i]);
588 val = brcmf_pcie_read_reg32(devinfo,
589 BRCMF_PCIE_PCIE2REG_CONFIGDATA);
590 brcmf_dbg(PCIE, "config offset 0x%04x, value 0x%04x\n",
591 cfg_offset[i], val);
592 brcmf_pcie_write_reg32(devinfo,
593 BRCMF_PCIE_PCIE2REG_CONFIGDATA,
594 val);
595 }
596 }
597}
598
599
600static void brcmf_pcie_attach(struct brcmf_pciedev_info *devinfo)
601{
602 u32 config;
603
604
605 brcmf_pcie_select_core(devinfo, BCMA_CORE_PCIE2);
606 brcmf_pcie_write_reg32(devinfo, BRCMF_PCIE_PCIE2REG_CONFIGADDR, 0x4e0);
607 config = brcmf_pcie_read_reg32(devinfo, BRCMF_PCIE_PCIE2REG_CONFIGDATA);
608 brcmf_pcie_write_reg32(devinfo, BRCMF_PCIE_PCIE2REG_CONFIGDATA, config);
609
610 device_wakeup_enable(&devinfo->pdev->dev);
611}
612
613
614static int brcmf_pcie_enter_download_state(struct brcmf_pciedev_info *devinfo)
615{
616 if (devinfo->ci->chip == BRCM_CC_43602_CHIP_ID) {
617 brcmf_pcie_select_core(devinfo, BCMA_CORE_ARM_CR4);
618 brcmf_pcie_write_reg32(devinfo, BRCMF_PCIE_ARMCR4REG_BANKIDX,
619 5);
620 brcmf_pcie_write_reg32(devinfo, BRCMF_PCIE_ARMCR4REG_BANKPDA,
621 0);
622 brcmf_pcie_write_reg32(devinfo, BRCMF_PCIE_ARMCR4REG_BANKIDX,
623 7);
624 brcmf_pcie_write_reg32(devinfo, BRCMF_PCIE_ARMCR4REG_BANKPDA,
625 0);
626 }
627 return 0;
628}
629
630
631static int brcmf_pcie_exit_download_state(struct brcmf_pciedev_info *devinfo,
632 u32 resetintr)
633{
634 struct brcmf_core *core;
635
636 if (devinfo->ci->chip == BRCM_CC_43602_CHIP_ID) {
637 core = brcmf_chip_get_core(devinfo->ci, BCMA_CORE_INTERNAL_MEM);
638 brcmf_chip_resetcore(core, 0, 0, 0);
639 }
640
641 if (!brcmf_chip_set_active(devinfo->ci, resetintr))
642 return -EINVAL;
643 return 0;
644}
645
646
647static int
648brcmf_pcie_send_mb_data(struct brcmf_pciedev_info *devinfo, u32 htod_mb_data)
649{
650 struct brcmf_pcie_shared_info *shared;
651 u32 addr;
652 u32 cur_htod_mb_data;
653 u32 i;
654
655 shared = &devinfo->shared;
656 addr = shared->htod_mb_data_addr;
657 cur_htod_mb_data = brcmf_pcie_read_tcm32(devinfo, addr);
658
659 if (cur_htod_mb_data != 0)
660 brcmf_dbg(PCIE, "MB transaction is already pending 0x%04x\n",
661 cur_htod_mb_data);
662
663 i = 0;
664 while (cur_htod_mb_data != 0) {
665 msleep(10);
666 i++;
667 if (i > 100)
668 return -EIO;
669 cur_htod_mb_data = brcmf_pcie_read_tcm32(devinfo, addr);
670 }
671
672 brcmf_pcie_write_tcm32(devinfo, addr, htod_mb_data);
673 pci_write_config_dword(devinfo->pdev, BRCMF_PCIE_REG_SBMBX, 1);
674 pci_write_config_dword(devinfo->pdev, BRCMF_PCIE_REG_SBMBX, 1);
675
676 return 0;
677}
678
679
680static void brcmf_pcie_handle_mb_data(struct brcmf_pciedev_info *devinfo)
681{
682 struct brcmf_pcie_shared_info *shared;
683 u32 addr;
684 u32 dtoh_mb_data;
685
686 shared = &devinfo->shared;
687 addr = shared->dtoh_mb_data_addr;
688 dtoh_mb_data = brcmf_pcie_read_tcm32(devinfo, addr);
689
690 if (!dtoh_mb_data)
691 return;
692
693 brcmf_pcie_write_tcm32(devinfo, addr, 0);
694
695 brcmf_dbg(PCIE, "D2H_MB_DATA: 0x%04x\n", dtoh_mb_data);
696 if (dtoh_mb_data & BRCMF_D2H_DEV_DS_ENTER_REQ) {
697 brcmf_dbg(PCIE, "D2H_MB_DATA: DEEP SLEEP REQ\n");
698 brcmf_pcie_send_mb_data(devinfo, BRCMF_H2D_HOST_DS_ACK);
699 brcmf_dbg(PCIE, "D2H_MB_DATA: sent DEEP SLEEP ACK\n");
700 }
701 if (dtoh_mb_data & BRCMF_D2H_DEV_DS_EXIT_NOTE)
702 brcmf_dbg(PCIE, "D2H_MB_DATA: DEEP SLEEP EXIT\n");
703 if (dtoh_mb_data & BRCMF_D2H_DEV_D3_ACK) {
704 brcmf_dbg(PCIE, "D2H_MB_DATA: D3 ACK\n");
705 devinfo->mbdata_completed = true;
706 wake_up(&devinfo->mbdata_resp_wait);
707 }
708}
709
710
711static void brcmf_pcie_bus_console_init(struct brcmf_pciedev_info *devinfo)
712{
713 struct brcmf_pcie_shared_info *shared;
714 struct brcmf_pcie_console *console;
715 u32 addr;
716
717 shared = &devinfo->shared;
718 console = &shared->console;
719 addr = shared->tcm_base_address + BRCMF_SHARED_CONSOLE_ADDR_OFFSET;
720 console->base_addr = brcmf_pcie_read_tcm32(devinfo, addr);
721
722 addr = console->base_addr + BRCMF_CONSOLE_BUFADDR_OFFSET;
723 console->buf_addr = brcmf_pcie_read_tcm32(devinfo, addr);
724 addr = console->base_addr + BRCMF_CONSOLE_BUFSIZE_OFFSET;
725 console->bufsize = brcmf_pcie_read_tcm32(devinfo, addr);
726
727 brcmf_dbg(FWCON, "Console: base %x, buf %x, size %d\n",
728 console->base_addr, console->buf_addr, console->bufsize);
729}
730
731
732static void brcmf_pcie_bus_console_read(struct brcmf_pciedev_info *devinfo)
733{
734 struct brcmf_pcie_console *console;
735 u32 addr;
736 u8 ch;
737 u32 newidx;
738
739 if (!BRCMF_FWCON_ON())
740 return;
741
742 console = &devinfo->shared.console;
743 addr = console->base_addr + BRCMF_CONSOLE_WRITEIDX_OFFSET;
744 newidx = brcmf_pcie_read_tcm32(devinfo, addr);
745 while (newidx != console->read_idx) {
746 addr = console->buf_addr + console->read_idx;
747 ch = brcmf_pcie_read_tcm8(devinfo, addr);
748 console->read_idx++;
749 if (console->read_idx == console->bufsize)
750 console->read_idx = 0;
751 if (ch == '\r')
752 continue;
753 console->log_str[console->log_idx] = ch;
754 console->log_idx++;
755 if ((ch != '\n') &&
756 (console->log_idx == (sizeof(console->log_str) - 2))) {
757 ch = '\n';
758 console->log_str[console->log_idx] = ch;
759 console->log_idx++;
760 }
761 if (ch == '\n') {
762 console->log_str[console->log_idx] = 0;
763 pr_debug("CONSOLE: %s", console->log_str);
764 console->log_idx = 0;
765 }
766 }
767}
768
769
770static void brcmf_pcie_intr_disable(struct brcmf_pciedev_info *devinfo)
771{
772 brcmf_pcie_write_reg32(devinfo, BRCMF_PCIE_PCIE2REG_MAILBOXMASK, 0);
773}
774
775
776static void brcmf_pcie_intr_enable(struct brcmf_pciedev_info *devinfo)
777{
778 brcmf_pcie_write_reg32(devinfo, BRCMF_PCIE_PCIE2REG_MAILBOXMASK,
779 BRCMF_PCIE_MB_INT_D2H_DB |
780 BRCMF_PCIE_MB_INT_FN0_0 |
781 BRCMF_PCIE_MB_INT_FN0_1);
782}
783
784
785static irqreturn_t brcmf_pcie_quick_check_isr(int irq, void *arg)
786{
787 struct brcmf_pciedev_info *devinfo = (struct brcmf_pciedev_info *)arg;
788
789 if (brcmf_pcie_read_reg32(devinfo, BRCMF_PCIE_PCIE2REG_MAILBOXINT)) {
790 brcmf_pcie_intr_disable(devinfo);
791 brcmf_dbg(PCIE, "Enter\n");
792 return IRQ_WAKE_THREAD;
793 }
794 return IRQ_NONE;
795}
796
797
798static irqreturn_t brcmf_pcie_isr_thread(int irq, void *arg)
799{
800 struct brcmf_pciedev_info *devinfo = (struct brcmf_pciedev_info *)arg;
801 u32 status;
802
803 devinfo->in_irq = true;
804 status = brcmf_pcie_read_reg32(devinfo, BRCMF_PCIE_PCIE2REG_MAILBOXINT);
805 brcmf_dbg(PCIE, "Enter %x\n", status);
806 if (status) {
807 brcmf_pcie_write_reg32(devinfo, BRCMF_PCIE_PCIE2REG_MAILBOXINT,
808 status);
809 if (status & (BRCMF_PCIE_MB_INT_FN0_0 |
810 BRCMF_PCIE_MB_INT_FN0_1))
811 brcmf_pcie_handle_mb_data(devinfo);
812 if (status & BRCMF_PCIE_MB_INT_D2H_DB) {
813 if (devinfo->state == BRCMFMAC_PCIE_STATE_UP)
814 brcmf_proto_msgbuf_rx_trigger(
815 &devinfo->pdev->dev);
816 }
817 }
818 brcmf_pcie_bus_console_read(devinfo);
819 if (devinfo->state == BRCMFMAC_PCIE_STATE_UP)
820 brcmf_pcie_intr_enable(devinfo);
821 devinfo->in_irq = false;
822 return IRQ_HANDLED;
823}
824
825
826static int brcmf_pcie_request_irq(struct brcmf_pciedev_info *devinfo)
827{
828 struct pci_dev *pdev;
829
830 pdev = devinfo->pdev;
831
832 brcmf_pcie_intr_disable(devinfo);
833
834 brcmf_dbg(PCIE, "Enter\n");
835
836 pci_enable_msi(pdev);
837 if (request_threaded_irq(pdev->irq, brcmf_pcie_quick_check_isr,
838 brcmf_pcie_isr_thread, IRQF_SHARED,
839 "brcmf_pcie_intr", devinfo)) {
840 pci_disable_msi(pdev);
841 brcmf_err("Failed to request IRQ %d\n", pdev->irq);
842 return -EIO;
843 }
844 devinfo->irq_allocated = true;
845 return 0;
846}
847
848
849static void brcmf_pcie_release_irq(struct brcmf_pciedev_info *devinfo)
850{
851 struct pci_dev *pdev;
852 u32 status;
853 u32 count;
854
855 if (!devinfo->irq_allocated)
856 return;
857
858 pdev = devinfo->pdev;
859
860 brcmf_pcie_intr_disable(devinfo);
861 free_irq(pdev->irq, devinfo);
862 pci_disable_msi(pdev);
863
864 msleep(50);
865 count = 0;
866 while ((devinfo->in_irq) && (count < 20)) {
867 msleep(50);
868 count++;
869 }
870 if (devinfo->in_irq)
871 brcmf_err("Still in IRQ (processing) !!!\n");
872
873 status = brcmf_pcie_read_reg32(devinfo, BRCMF_PCIE_PCIE2REG_MAILBOXINT);
874 brcmf_pcie_write_reg32(devinfo, BRCMF_PCIE_PCIE2REG_MAILBOXINT, status);
875
876 devinfo->irq_allocated = false;
877}
878
879
880static int brcmf_pcie_ring_mb_write_rptr(void *ctx)
881{
882 struct brcmf_pcie_ringbuf *ring = (struct brcmf_pcie_ringbuf *)ctx;
883 struct brcmf_pciedev_info *devinfo = ring->devinfo;
884 struct brcmf_commonring *commonring = &ring->commonring;
885
886 if (devinfo->state != BRCMFMAC_PCIE_STATE_UP)
887 return -EIO;
888
889 brcmf_dbg(PCIE, "W r_ptr %d (%d), ring %d\n", commonring->r_ptr,
890 commonring->w_ptr, ring->id);
891
892 devinfo->write_ptr(devinfo, ring->r_idx_addr, commonring->r_ptr);
893
894 return 0;
895}
896
897
898static int brcmf_pcie_ring_mb_write_wptr(void *ctx)
899{
900 struct brcmf_pcie_ringbuf *ring = (struct brcmf_pcie_ringbuf *)ctx;
901 struct brcmf_pciedev_info *devinfo = ring->devinfo;
902 struct brcmf_commonring *commonring = &ring->commonring;
903
904 if (devinfo->state != BRCMFMAC_PCIE_STATE_UP)
905 return -EIO;
906
907 brcmf_dbg(PCIE, "W w_ptr %d (%d), ring %d\n", commonring->w_ptr,
908 commonring->r_ptr, ring->id);
909
910 devinfo->write_ptr(devinfo, ring->w_idx_addr, commonring->w_ptr);
911
912 return 0;
913}
914
915
916static int brcmf_pcie_ring_mb_ring_bell(void *ctx)
917{
918 struct brcmf_pcie_ringbuf *ring = (struct brcmf_pcie_ringbuf *)ctx;
919 struct brcmf_pciedev_info *devinfo = ring->devinfo;
920
921 if (devinfo->state != BRCMFMAC_PCIE_STATE_UP)
922 return -EIO;
923
924 brcmf_dbg(PCIE, "RING !\n");
925
926 brcmf_pcie_write_reg32(devinfo, BRCMF_PCIE_PCIE2REG_H2D_MAILBOX, 1);
927
928 return 0;
929}
930
931
932static int brcmf_pcie_ring_mb_update_rptr(void *ctx)
933{
934 struct brcmf_pcie_ringbuf *ring = (struct brcmf_pcie_ringbuf *)ctx;
935 struct brcmf_pciedev_info *devinfo = ring->devinfo;
936 struct brcmf_commonring *commonring = &ring->commonring;
937
938 if (devinfo->state != BRCMFMAC_PCIE_STATE_UP)
939 return -EIO;
940
941 commonring->r_ptr = devinfo->read_ptr(devinfo, ring->r_idx_addr);
942
943 brcmf_dbg(PCIE, "R r_ptr %d (%d), ring %d\n", commonring->r_ptr,
944 commonring->w_ptr, ring->id);
945
946 return 0;
947}
948
949
950static int brcmf_pcie_ring_mb_update_wptr(void *ctx)
951{
952 struct brcmf_pcie_ringbuf *ring = (struct brcmf_pcie_ringbuf *)ctx;
953 struct brcmf_pciedev_info *devinfo = ring->devinfo;
954 struct brcmf_commonring *commonring = &ring->commonring;
955
956 if (devinfo->state != BRCMFMAC_PCIE_STATE_UP)
957 return -EIO;
958
959 commonring->w_ptr = devinfo->read_ptr(devinfo, ring->w_idx_addr);
960
961 brcmf_dbg(PCIE, "R w_ptr %d (%d), ring %d\n", commonring->w_ptr,
962 commonring->r_ptr, ring->id);
963
964 return 0;
965}
966
967
968static void *
969brcmf_pcie_init_dmabuffer_for_device(struct brcmf_pciedev_info *devinfo,
970 u32 size, u32 tcm_dma_phys_addr,
971 dma_addr_t *dma_handle)
972{
973 void *ring;
974 u64 address;
975
976 ring = dma_alloc_coherent(&devinfo->pdev->dev, size, dma_handle,
977 GFP_KERNEL);
978 if (!ring)
979 return NULL;
980
981 address = (u64)*dma_handle;
982 brcmf_pcie_write_tcm32(devinfo, tcm_dma_phys_addr,
983 address & 0xffffffff);
984 brcmf_pcie_write_tcm32(devinfo, tcm_dma_phys_addr + 4, address >> 32);
985
986 memset(ring, 0, size);
987
988 return (ring);
989}
990
991
992static struct brcmf_pcie_ringbuf *
993brcmf_pcie_alloc_dma_and_ring(struct brcmf_pciedev_info *devinfo, u32 ring_id,
994 u32 tcm_ring_phys_addr)
995{
996 void *dma_buf;
997 dma_addr_t dma_handle;
998 struct brcmf_pcie_ringbuf *ring;
999 u32 size;
1000 u32 addr;
1001
1002 size = brcmf_ring_max_item[ring_id] * brcmf_ring_itemsize[ring_id];
1003 dma_buf = brcmf_pcie_init_dmabuffer_for_device(devinfo, size,
1004 tcm_ring_phys_addr + BRCMF_RING_MEM_BASE_ADDR_OFFSET,
1005 &dma_handle);
1006 if (!dma_buf)
1007 return NULL;
1008
1009 addr = tcm_ring_phys_addr + BRCMF_RING_MAX_ITEM_OFFSET;
1010 brcmf_pcie_write_tcm16(devinfo, addr, brcmf_ring_max_item[ring_id]);
1011 addr = tcm_ring_phys_addr + BRCMF_RING_LEN_ITEMS_OFFSET;
1012 brcmf_pcie_write_tcm16(devinfo, addr, brcmf_ring_itemsize[ring_id]);
1013
1014 ring = kzalloc(sizeof(*ring), GFP_KERNEL);
1015 if (!ring) {
1016 dma_free_coherent(&devinfo->pdev->dev, size, dma_buf,
1017 dma_handle);
1018 return NULL;
1019 }
1020 brcmf_commonring_config(&ring->commonring, brcmf_ring_max_item[ring_id],
1021 brcmf_ring_itemsize[ring_id], dma_buf);
1022 ring->dma_handle = dma_handle;
1023 ring->devinfo = devinfo;
1024 brcmf_commonring_register_cb(&ring->commonring,
1025 brcmf_pcie_ring_mb_ring_bell,
1026 brcmf_pcie_ring_mb_update_rptr,
1027 brcmf_pcie_ring_mb_update_wptr,
1028 brcmf_pcie_ring_mb_write_rptr,
1029 brcmf_pcie_ring_mb_write_wptr, ring);
1030
1031 return (ring);
1032}
1033
1034
1035static void brcmf_pcie_release_ringbuffer(struct device *dev,
1036 struct brcmf_pcie_ringbuf *ring)
1037{
1038 void *dma_buf;
1039 u32 size;
1040
1041 if (!ring)
1042 return;
1043
1044 dma_buf = ring->commonring.buf_addr;
1045 if (dma_buf) {
1046 size = ring->commonring.depth * ring->commonring.item_len;
1047 dma_free_coherent(dev, size, dma_buf, ring->dma_handle);
1048 }
1049 kfree(ring);
1050}
1051
1052
1053static void brcmf_pcie_release_ringbuffers(struct brcmf_pciedev_info *devinfo)
1054{
1055 u32 i;
1056
1057 for (i = 0; i < BRCMF_NROF_COMMON_MSGRINGS; i++) {
1058 brcmf_pcie_release_ringbuffer(&devinfo->pdev->dev,
1059 devinfo->shared.commonrings[i]);
1060 devinfo->shared.commonrings[i] = NULL;
1061 }
1062 kfree(devinfo->shared.flowrings);
1063 devinfo->shared.flowrings = NULL;
1064 if (devinfo->idxbuf) {
1065 dma_free_coherent(&devinfo->pdev->dev,
1066 devinfo->idxbuf_sz,
1067 devinfo->idxbuf,
1068 devinfo->idxbuf_dmahandle);
1069 devinfo->idxbuf = NULL;
1070 }
1071}
1072
1073
1074static int brcmf_pcie_init_ringbuffers(struct brcmf_pciedev_info *devinfo)
1075{
1076 struct brcmf_pcie_ringbuf *ring;
1077 struct brcmf_pcie_ringbuf *rings;
1078 u32 d2h_w_idx_ptr;
1079 u32 d2h_r_idx_ptr;
1080 u32 h2d_w_idx_ptr;
1081 u32 h2d_r_idx_ptr;
1082 u32 ring_mem_ptr;
1083 u32 i;
1084 u64 address;
1085 u32 bufsz;
1086 u8 idx_offset;
1087 struct brcmf_pcie_dhi_ringinfo ringinfo;
1088 u16 max_flowrings;
1089 u16 max_submissionrings;
1090 u16 max_completionrings;
1091
1092 memcpy_fromio(&ringinfo, devinfo->tcm + devinfo->shared.ring_info_addr,
1093 sizeof(ringinfo));
1094 if (devinfo->shared.version >= 6) {
1095 max_submissionrings = le16_to_cpu(ringinfo.max_submissionrings);
1096 max_flowrings = le16_to_cpu(ringinfo.max_flowrings);
1097 max_completionrings = le16_to_cpu(ringinfo.max_completionrings);
1098 } else {
1099 max_submissionrings = le16_to_cpu(ringinfo.max_flowrings);
1100 max_flowrings = max_submissionrings -
1101 BRCMF_NROF_H2D_COMMON_MSGRINGS;
1102 max_completionrings = BRCMF_NROF_D2H_COMMON_MSGRINGS;
1103 }
1104
1105 if (devinfo->dma_idx_sz != 0) {
1106 bufsz = (max_submissionrings + max_completionrings) *
1107 devinfo->dma_idx_sz * 2;
1108 devinfo->idxbuf = dma_alloc_coherent(&devinfo->pdev->dev, bufsz,
1109 &devinfo->idxbuf_dmahandle,
1110 GFP_KERNEL);
1111 if (!devinfo->idxbuf)
1112 devinfo->dma_idx_sz = 0;
1113 }
1114
1115 if (devinfo->dma_idx_sz == 0) {
1116 d2h_w_idx_ptr = le32_to_cpu(ringinfo.d2h_w_idx_ptr);
1117 d2h_r_idx_ptr = le32_to_cpu(ringinfo.d2h_r_idx_ptr);
1118 h2d_w_idx_ptr = le32_to_cpu(ringinfo.h2d_w_idx_ptr);
1119 h2d_r_idx_ptr = le32_to_cpu(ringinfo.h2d_r_idx_ptr);
1120 idx_offset = sizeof(u32);
1121 devinfo->write_ptr = brcmf_pcie_write_tcm16;
1122 devinfo->read_ptr = brcmf_pcie_read_tcm16;
1123 brcmf_dbg(PCIE, "Using TCM indices\n");
1124 } else {
1125 memset(devinfo->idxbuf, 0, bufsz);
1126 devinfo->idxbuf_sz = bufsz;
1127 idx_offset = devinfo->dma_idx_sz;
1128 devinfo->write_ptr = brcmf_pcie_write_idx;
1129 devinfo->read_ptr = brcmf_pcie_read_idx;
1130
1131 h2d_w_idx_ptr = 0;
1132 address = (u64)devinfo->idxbuf_dmahandle;
1133 ringinfo.h2d_w_idx_hostaddr.low_addr =
1134 cpu_to_le32(address & 0xffffffff);
1135 ringinfo.h2d_w_idx_hostaddr.high_addr =
1136 cpu_to_le32(address >> 32);
1137
1138 h2d_r_idx_ptr = h2d_w_idx_ptr +
1139 max_submissionrings * idx_offset;
1140 address += max_submissionrings * idx_offset;
1141 ringinfo.h2d_r_idx_hostaddr.low_addr =
1142 cpu_to_le32(address & 0xffffffff);
1143 ringinfo.h2d_r_idx_hostaddr.high_addr =
1144 cpu_to_le32(address >> 32);
1145
1146 d2h_w_idx_ptr = h2d_r_idx_ptr +
1147 max_submissionrings * idx_offset;
1148 address += max_submissionrings * idx_offset;
1149 ringinfo.d2h_w_idx_hostaddr.low_addr =
1150 cpu_to_le32(address & 0xffffffff);
1151 ringinfo.d2h_w_idx_hostaddr.high_addr =
1152 cpu_to_le32(address >> 32);
1153
1154 d2h_r_idx_ptr = d2h_w_idx_ptr +
1155 max_completionrings * idx_offset;
1156 address += max_completionrings * idx_offset;
1157 ringinfo.d2h_r_idx_hostaddr.low_addr =
1158 cpu_to_le32(address & 0xffffffff);
1159 ringinfo.d2h_r_idx_hostaddr.high_addr =
1160 cpu_to_le32(address >> 32);
1161
1162 memcpy_toio(devinfo->tcm + devinfo->shared.ring_info_addr,
1163 &ringinfo, sizeof(ringinfo));
1164 brcmf_dbg(PCIE, "Using host memory indices\n");
1165 }
1166
1167 ring_mem_ptr = le32_to_cpu(ringinfo.ringmem);
1168
1169 for (i = 0; i < BRCMF_NROF_H2D_COMMON_MSGRINGS; i++) {
1170 ring = brcmf_pcie_alloc_dma_and_ring(devinfo, i, ring_mem_ptr);
1171 if (!ring)
1172 goto fail;
1173 ring->w_idx_addr = h2d_w_idx_ptr;
1174 ring->r_idx_addr = h2d_r_idx_ptr;
1175 ring->id = i;
1176 devinfo->shared.commonrings[i] = ring;
1177
1178 h2d_w_idx_ptr += idx_offset;
1179 h2d_r_idx_ptr += idx_offset;
1180 ring_mem_ptr += BRCMF_RING_MEM_SZ;
1181 }
1182
1183 for (i = BRCMF_NROF_H2D_COMMON_MSGRINGS;
1184 i < BRCMF_NROF_COMMON_MSGRINGS; i++) {
1185 ring = brcmf_pcie_alloc_dma_and_ring(devinfo, i, ring_mem_ptr);
1186 if (!ring)
1187 goto fail;
1188 ring->w_idx_addr = d2h_w_idx_ptr;
1189 ring->r_idx_addr = d2h_r_idx_ptr;
1190 ring->id = i;
1191 devinfo->shared.commonrings[i] = ring;
1192
1193 d2h_w_idx_ptr += idx_offset;
1194 d2h_r_idx_ptr += idx_offset;
1195 ring_mem_ptr += BRCMF_RING_MEM_SZ;
1196 }
1197
1198 devinfo->shared.max_flowrings = max_flowrings;
1199 devinfo->shared.max_submissionrings = max_submissionrings;
1200 devinfo->shared.max_completionrings = max_completionrings;
1201 rings = kcalloc(max_flowrings, sizeof(*ring), GFP_KERNEL);
1202 if (!rings)
1203 goto fail;
1204
1205 brcmf_dbg(PCIE, "Nr of flowrings is %d\n", max_flowrings);
1206
1207 for (i = 0; i < max_flowrings; i++) {
1208 ring = &rings[i];
1209 ring->devinfo = devinfo;
1210 ring->id = i + BRCMF_H2D_MSGRING_FLOWRING_IDSTART;
1211 brcmf_commonring_register_cb(&ring->commonring,
1212 brcmf_pcie_ring_mb_ring_bell,
1213 brcmf_pcie_ring_mb_update_rptr,
1214 brcmf_pcie_ring_mb_update_wptr,
1215 brcmf_pcie_ring_mb_write_rptr,
1216 brcmf_pcie_ring_mb_write_wptr,
1217 ring);
1218 ring->w_idx_addr = h2d_w_idx_ptr;
1219 ring->r_idx_addr = h2d_r_idx_ptr;
1220 h2d_w_idx_ptr += idx_offset;
1221 h2d_r_idx_ptr += idx_offset;
1222 }
1223 devinfo->shared.flowrings = rings;
1224
1225 return 0;
1226
1227fail:
1228 brcmf_err("Allocating ring buffers failed\n");
1229 brcmf_pcie_release_ringbuffers(devinfo);
1230 return -ENOMEM;
1231}
1232
1233
1234static void
1235brcmf_pcie_release_scratchbuffers(struct brcmf_pciedev_info *devinfo)
1236{
1237 if (devinfo->shared.scratch)
1238 dma_free_coherent(&devinfo->pdev->dev,
1239 BRCMF_DMA_D2H_SCRATCH_BUF_LEN,
1240 devinfo->shared.scratch,
1241 devinfo->shared.scratch_dmahandle);
1242 if (devinfo->shared.ringupd)
1243 dma_free_coherent(&devinfo->pdev->dev,
1244 BRCMF_DMA_D2H_RINGUPD_BUF_LEN,
1245 devinfo->shared.ringupd,
1246 devinfo->shared.ringupd_dmahandle);
1247}
1248
1249static int brcmf_pcie_init_scratchbuffers(struct brcmf_pciedev_info *devinfo)
1250{
1251 u64 address;
1252 u32 addr;
1253
1254 devinfo->shared.scratch =
1255 dma_zalloc_coherent(&devinfo->pdev->dev,
1256 BRCMF_DMA_D2H_SCRATCH_BUF_LEN,
1257 &devinfo->shared.scratch_dmahandle,
1258 GFP_KERNEL);
1259 if (!devinfo->shared.scratch)
1260 goto fail;
1261
1262 addr = devinfo->shared.tcm_base_address +
1263 BRCMF_SHARED_DMA_SCRATCH_ADDR_OFFSET;
1264 address = (u64)devinfo->shared.scratch_dmahandle;
1265 brcmf_pcie_write_tcm32(devinfo, addr, address & 0xffffffff);
1266 brcmf_pcie_write_tcm32(devinfo, addr + 4, address >> 32);
1267 addr = devinfo->shared.tcm_base_address +
1268 BRCMF_SHARED_DMA_SCRATCH_LEN_OFFSET;
1269 brcmf_pcie_write_tcm32(devinfo, addr, BRCMF_DMA_D2H_SCRATCH_BUF_LEN);
1270
1271 devinfo->shared.ringupd =
1272 dma_zalloc_coherent(&devinfo->pdev->dev,
1273 BRCMF_DMA_D2H_RINGUPD_BUF_LEN,
1274 &devinfo->shared.ringupd_dmahandle,
1275 GFP_KERNEL);
1276 if (!devinfo->shared.ringupd)
1277 goto fail;
1278
1279 addr = devinfo->shared.tcm_base_address +
1280 BRCMF_SHARED_DMA_RINGUPD_ADDR_OFFSET;
1281 address = (u64)devinfo->shared.ringupd_dmahandle;
1282 brcmf_pcie_write_tcm32(devinfo, addr, address & 0xffffffff);
1283 brcmf_pcie_write_tcm32(devinfo, addr + 4, address >> 32);
1284 addr = devinfo->shared.tcm_base_address +
1285 BRCMF_SHARED_DMA_RINGUPD_LEN_OFFSET;
1286 brcmf_pcie_write_tcm32(devinfo, addr, BRCMF_DMA_D2H_RINGUPD_BUF_LEN);
1287 return 0;
1288
1289fail:
1290 brcmf_err("Allocating scratch buffers failed\n");
1291 brcmf_pcie_release_scratchbuffers(devinfo);
1292 return -ENOMEM;
1293}
1294
1295
1296static void brcmf_pcie_down(struct device *dev)
1297{
1298}
1299
1300
1301static int brcmf_pcie_tx(struct device *dev, struct sk_buff *skb)
1302{
1303 return 0;
1304}
1305
1306
1307static int brcmf_pcie_tx_ctlpkt(struct device *dev, unsigned char *msg,
1308 uint len)
1309{
1310 return 0;
1311}
1312
1313
1314static int brcmf_pcie_rx_ctlpkt(struct device *dev, unsigned char *msg,
1315 uint len)
1316{
1317 return 0;
1318}
1319
1320
1321static void brcmf_pcie_wowl_config(struct device *dev, bool enabled)
1322{
1323 struct brcmf_bus *bus_if = dev_get_drvdata(dev);
1324 struct brcmf_pciedev *buspub = bus_if->bus_priv.pcie;
1325 struct brcmf_pciedev_info *devinfo = buspub->devinfo;
1326
1327 brcmf_dbg(PCIE, "Configuring WOWL, enabled=%d\n", enabled);
1328 devinfo->wowl_enabled = enabled;
1329}
1330
1331
1332static size_t brcmf_pcie_get_ramsize(struct device *dev)
1333{
1334 struct brcmf_bus *bus_if = dev_get_drvdata(dev);
1335 struct brcmf_pciedev *buspub = bus_if->bus_priv.pcie;
1336 struct brcmf_pciedev_info *devinfo = buspub->devinfo;
1337
1338 return devinfo->ci->ramsize - devinfo->ci->srsize;
1339}
1340
1341
1342static int brcmf_pcie_get_memdump(struct device *dev, void *data, size_t len)
1343{
1344 struct brcmf_bus *bus_if = dev_get_drvdata(dev);
1345 struct brcmf_pciedev *buspub = bus_if->bus_priv.pcie;
1346 struct brcmf_pciedev_info *devinfo = buspub->devinfo;
1347
1348 brcmf_dbg(PCIE, "dump at 0x%08X: len=%zu\n", devinfo->ci->rambase, len);
1349 brcmf_pcie_copy_dev_tomem(devinfo, devinfo->ci->rambase, data, len);
1350 return 0;
1351}
1352
1353static int brcmf_pcie_get_fwname(struct device *dev, u32 chip, u32 chiprev,
1354 u8 *fw_name)
1355{
1356 struct brcmf_bus *bus_if = dev_get_drvdata(dev);
1357 struct brcmf_pciedev *buspub = bus_if->bus_priv.pcie;
1358 struct brcmf_pciedev_info *devinfo = buspub->devinfo;
1359 int ret = 0;
1360
1361 if (devinfo->fw_name[0] != '\0')
1362 strlcpy(fw_name, devinfo->fw_name, BRCMF_FW_NAME_LEN);
1363 else
1364 ret = brcmf_fw_map_chip_to_name(chip, chiprev,
1365 brcmf_pcie_fwnames,
1366 ARRAY_SIZE(brcmf_pcie_fwnames),
1367 fw_name, NULL);
1368
1369 return ret;
1370}
1371
1372static const struct brcmf_bus_ops brcmf_pcie_bus_ops = {
1373 .txdata = brcmf_pcie_tx,
1374 .stop = brcmf_pcie_down,
1375 .txctl = brcmf_pcie_tx_ctlpkt,
1376 .rxctl = brcmf_pcie_rx_ctlpkt,
1377 .wowl_config = brcmf_pcie_wowl_config,
1378 .get_ramsize = brcmf_pcie_get_ramsize,
1379 .get_memdump = brcmf_pcie_get_memdump,
1380 .get_fwname = brcmf_pcie_get_fwname,
1381};
1382
1383
1384static void
1385brcmf_pcie_adjust_ramsize(struct brcmf_pciedev_info *devinfo, u8 *data,
1386 u32 data_len)
1387{
1388 __le32 *field;
1389 u32 newsize;
1390
1391 if (data_len < BRCMF_RAMSIZE_OFFSET + 8)
1392 return;
1393
1394 field = (__le32 *)&data[BRCMF_RAMSIZE_OFFSET];
1395 if (le32_to_cpup(field) != BRCMF_RAMSIZE_MAGIC)
1396 return;
1397 field++;
1398 newsize = le32_to_cpup(field);
1399
1400 brcmf_dbg(PCIE, "Found ramsize info in FW, adjusting to 0x%x\n",
1401 newsize);
1402 devinfo->ci->ramsize = newsize;
1403}
1404
1405
1406static int
1407brcmf_pcie_init_share_ram_info(struct brcmf_pciedev_info *devinfo,
1408 u32 sharedram_addr)
1409{
1410 struct brcmf_pcie_shared_info *shared;
1411 u32 addr;
1412
1413 shared = &devinfo->shared;
1414 shared->tcm_base_address = sharedram_addr;
1415
1416 shared->flags = brcmf_pcie_read_tcm32(devinfo, sharedram_addr);
1417 shared->version = (u8)(shared->flags & BRCMF_PCIE_SHARED_VERSION_MASK);
1418 brcmf_dbg(PCIE, "PCIe protocol version %d\n", shared->version);
1419 if ((shared->version > BRCMF_PCIE_MAX_SHARED_VERSION) ||
1420 (shared->version < BRCMF_PCIE_MIN_SHARED_VERSION)) {
1421 brcmf_err("Unsupported PCIE version %d\n", shared->version);
1422 return -EINVAL;
1423 }
1424
1425
1426 if (shared->flags & BRCMF_PCIE_SHARED_DMA_INDEX) {
1427 if (shared->flags & BRCMF_PCIE_SHARED_DMA_2B_IDX)
1428 devinfo->dma_idx_sz = sizeof(u16);
1429 else
1430 devinfo->dma_idx_sz = sizeof(u32);
1431 }
1432
1433 addr = sharedram_addr + BRCMF_SHARED_MAX_RXBUFPOST_OFFSET;
1434 shared->max_rxbufpost = brcmf_pcie_read_tcm16(devinfo, addr);
1435 if (shared->max_rxbufpost == 0)
1436 shared->max_rxbufpost = BRCMF_DEF_MAX_RXBUFPOST;
1437
1438 addr = sharedram_addr + BRCMF_SHARED_RX_DATAOFFSET_OFFSET;
1439 shared->rx_dataoffset = brcmf_pcie_read_tcm32(devinfo, addr);
1440
1441 addr = sharedram_addr + BRCMF_SHARED_HTOD_MB_DATA_ADDR_OFFSET;
1442 shared->htod_mb_data_addr = brcmf_pcie_read_tcm32(devinfo, addr);
1443
1444 addr = sharedram_addr + BRCMF_SHARED_DTOH_MB_DATA_ADDR_OFFSET;
1445 shared->dtoh_mb_data_addr = brcmf_pcie_read_tcm32(devinfo, addr);
1446
1447 addr = sharedram_addr + BRCMF_SHARED_RING_INFO_ADDR_OFFSET;
1448 shared->ring_info_addr = brcmf_pcie_read_tcm32(devinfo, addr);
1449
1450 brcmf_dbg(PCIE, "max rx buf post %d, rx dataoffset %d\n",
1451 shared->max_rxbufpost, shared->rx_dataoffset);
1452
1453 brcmf_pcie_bus_console_init(devinfo);
1454
1455 return 0;
1456}
1457
1458
1459static int brcmf_pcie_download_fw_nvram(struct brcmf_pciedev_info *devinfo,
1460 const struct firmware *fw, void *nvram,
1461 u32 nvram_len)
1462{
1463 u32 sharedram_addr;
1464 u32 sharedram_addr_written;
1465 u32 loop_counter;
1466 int err;
1467 u32 address;
1468 u32 resetintr;
1469
1470 brcmf_dbg(PCIE, "Halt ARM.\n");
1471 err = brcmf_pcie_enter_download_state(devinfo);
1472 if (err)
1473 return err;
1474
1475 brcmf_dbg(PCIE, "Download FW %s\n", devinfo->fw_name);
1476 brcmf_pcie_copy_mem_todev(devinfo, devinfo->ci->rambase,
1477 (void *)fw->data, fw->size);
1478
1479 resetintr = get_unaligned_le32(fw->data);
1480 release_firmware(fw);
1481
1482
1483
1484
1485 brcmf_pcie_write_ram32(devinfo, devinfo->ci->ramsize - 4, 0);
1486
1487 if (nvram) {
1488 brcmf_dbg(PCIE, "Download NVRAM %s\n", devinfo->nvram_name);
1489 address = devinfo->ci->rambase + devinfo->ci->ramsize -
1490 nvram_len;
1491 brcmf_pcie_copy_mem_todev(devinfo, address, nvram, nvram_len);
1492 brcmf_fw_nvram_free(nvram);
1493 } else {
1494 brcmf_dbg(PCIE, "No matching NVRAM file found %s\n",
1495 devinfo->nvram_name);
1496 }
1497
1498 sharedram_addr_written = brcmf_pcie_read_ram32(devinfo,
1499 devinfo->ci->ramsize -
1500 4);
1501 brcmf_dbg(PCIE, "Bring ARM in running state\n");
1502 err = brcmf_pcie_exit_download_state(devinfo, resetintr);
1503 if (err)
1504 return err;
1505
1506 brcmf_dbg(PCIE, "Wait for FW init\n");
1507 sharedram_addr = sharedram_addr_written;
1508 loop_counter = BRCMF_PCIE_FW_UP_TIMEOUT / 50;
1509 while ((sharedram_addr == sharedram_addr_written) && (loop_counter)) {
1510 msleep(50);
1511 sharedram_addr = brcmf_pcie_read_ram32(devinfo,
1512 devinfo->ci->ramsize -
1513 4);
1514 loop_counter--;
1515 }
1516 if (sharedram_addr == sharedram_addr_written) {
1517 brcmf_err("FW failed to initialize\n");
1518 return -ENODEV;
1519 }
1520 brcmf_dbg(PCIE, "Shared RAM addr: 0x%08x\n", sharedram_addr);
1521
1522 return (brcmf_pcie_init_share_ram_info(devinfo, sharedram_addr));
1523}
1524
1525
1526static int brcmf_pcie_get_resource(struct brcmf_pciedev_info *devinfo)
1527{
1528 struct pci_dev *pdev;
1529 int err;
1530 phys_addr_t bar0_addr, bar1_addr;
1531 ulong bar1_size;
1532
1533 pdev = devinfo->pdev;
1534
1535 err = pci_enable_device(pdev);
1536 if (err) {
1537 brcmf_err("pci_enable_device failed err=%d\n", err);
1538 return err;
1539 }
1540
1541 pci_set_master(pdev);
1542
1543
1544 bar0_addr = pci_resource_start(pdev, 0);
1545
1546 bar1_addr = pci_resource_start(pdev, 2);
1547
1548 bar1_size = pci_resource_len(pdev, 2);
1549 if ((bar1_size == 0) || (bar1_addr == 0)) {
1550 brcmf_err("BAR1 Not enabled, device size=%ld, addr=%#016llx\n",
1551 bar1_size, (unsigned long long)bar1_addr);
1552 return -EINVAL;
1553 }
1554
1555 devinfo->regs = ioremap_nocache(bar0_addr, BRCMF_PCIE_REG_MAP_SIZE);
1556 devinfo->tcm = ioremap_nocache(bar1_addr, bar1_size);
1557
1558 if (!devinfo->regs || !devinfo->tcm) {
1559 brcmf_err("ioremap() failed (%p,%p)\n", devinfo->regs,
1560 devinfo->tcm);
1561 return -EINVAL;
1562 }
1563 brcmf_dbg(PCIE, "Phys addr : reg space = %p base addr %#016llx\n",
1564 devinfo->regs, (unsigned long long)bar0_addr);
1565 brcmf_dbg(PCIE, "Phys addr : mem space = %p base addr %#016llx size 0x%x\n",
1566 devinfo->tcm, (unsigned long long)bar1_addr,
1567 (unsigned int)bar1_size);
1568
1569 return 0;
1570}
1571
1572
1573static void brcmf_pcie_release_resource(struct brcmf_pciedev_info *devinfo)
1574{
1575 if (devinfo->tcm)
1576 iounmap(devinfo->tcm);
1577 if (devinfo->regs)
1578 iounmap(devinfo->regs);
1579
1580 pci_disable_device(devinfo->pdev);
1581}
1582
1583
1584static int brcmf_pcie_attach_bus(struct brcmf_pciedev_info *devinfo)
1585{
1586 int ret;
1587
1588
1589 ret = brcmf_attach(&devinfo->pdev->dev, devinfo->settings);
1590 if (ret) {
1591 brcmf_err("brcmf_attach failed\n");
1592 } else {
1593 ret = brcmf_bus_started(&devinfo->pdev->dev);
1594 if (ret)
1595 brcmf_err("dongle is not responding\n");
1596 }
1597
1598 return ret;
1599}
1600
1601
1602static u32 brcmf_pcie_buscore_prep_addr(const struct pci_dev *pdev, u32 addr)
1603{
1604 u32 ret_addr;
1605
1606 ret_addr = addr & (BRCMF_PCIE_BAR0_REG_SIZE - 1);
1607 addr &= ~(BRCMF_PCIE_BAR0_REG_SIZE - 1);
1608 pci_write_config_dword(pdev, BRCMF_PCIE_BAR0_WINDOW, addr);
1609
1610 return ret_addr;
1611}
1612
1613
1614static u32 brcmf_pcie_buscore_read32(void *ctx, u32 addr)
1615{
1616 struct brcmf_pciedev_info *devinfo = (struct brcmf_pciedev_info *)ctx;
1617
1618 addr = brcmf_pcie_buscore_prep_addr(devinfo->pdev, addr);
1619 return brcmf_pcie_read_reg32(devinfo, addr);
1620}
1621
1622
1623static void brcmf_pcie_buscore_write32(void *ctx, u32 addr, u32 value)
1624{
1625 struct brcmf_pciedev_info *devinfo = (struct brcmf_pciedev_info *)ctx;
1626
1627 addr = brcmf_pcie_buscore_prep_addr(devinfo->pdev, addr);
1628 brcmf_pcie_write_reg32(devinfo, addr, value);
1629}
1630
1631
1632static int brcmf_pcie_buscoreprep(void *ctx)
1633{
1634 return brcmf_pcie_get_resource(ctx);
1635}
1636
1637
1638static int brcmf_pcie_buscore_reset(void *ctx, struct brcmf_chip *chip)
1639{
1640 struct brcmf_pciedev_info *devinfo = (struct brcmf_pciedev_info *)ctx;
1641 u32 val;
1642
1643 devinfo->ci = chip;
1644 brcmf_pcie_reset_device(devinfo);
1645
1646 val = brcmf_pcie_read_reg32(devinfo, BRCMF_PCIE_PCIE2REG_MAILBOXINT);
1647 if (val != 0xffffffff)
1648 brcmf_pcie_write_reg32(devinfo, BRCMF_PCIE_PCIE2REG_MAILBOXINT,
1649 val);
1650
1651 return 0;
1652}
1653
1654
1655static void brcmf_pcie_buscore_activate(void *ctx, struct brcmf_chip *chip,
1656 u32 rstvec)
1657{
1658 struct brcmf_pciedev_info *devinfo = (struct brcmf_pciedev_info *)ctx;
1659
1660 brcmf_pcie_write_tcm32(devinfo, 0, rstvec);
1661}
1662
1663
1664static const struct brcmf_buscore_ops brcmf_pcie_buscore_ops = {
1665 .prepare = brcmf_pcie_buscoreprep,
1666 .reset = brcmf_pcie_buscore_reset,
1667 .activate = brcmf_pcie_buscore_activate,
1668 .read32 = brcmf_pcie_buscore_read32,
1669 .write32 = brcmf_pcie_buscore_write32,
1670};
1671
1672static void brcmf_pcie_setup(struct device *dev, int ret,
1673 const struct firmware *fw,
1674 void *nvram, u32 nvram_len)
1675{
1676 struct brcmf_bus *bus;
1677 struct brcmf_pciedev *pcie_bus_dev;
1678 struct brcmf_pciedev_info *devinfo;
1679 struct brcmf_commonring **flowrings;
1680 u32 i;
1681
1682
1683 if (ret)
1684 goto fail;
1685
1686 bus = dev_get_drvdata(dev);
1687 pcie_bus_dev = bus->bus_priv.pcie;
1688 devinfo = pcie_bus_dev->devinfo;
1689 brcmf_pcie_attach(devinfo);
1690
1691
1692
1693
1694
1695
1696 brcmf_pcie_adjust_ramsize(devinfo, (u8 *)fw->data, fw->size);
1697
1698 ret = brcmf_pcie_download_fw_nvram(devinfo, fw, nvram, nvram_len);
1699 if (ret)
1700 goto fail;
1701
1702 devinfo->state = BRCMFMAC_PCIE_STATE_UP;
1703
1704 ret = brcmf_pcie_init_ringbuffers(devinfo);
1705 if (ret)
1706 goto fail;
1707
1708 ret = brcmf_pcie_init_scratchbuffers(devinfo);
1709 if (ret)
1710 goto fail;
1711
1712 brcmf_pcie_select_core(devinfo, BCMA_CORE_PCIE2);
1713 ret = brcmf_pcie_request_irq(devinfo);
1714 if (ret)
1715 goto fail;
1716
1717
1718 for (i = 0; i < BRCMF_NROF_COMMON_MSGRINGS; i++)
1719 bus->msgbuf->commonrings[i] =
1720 &devinfo->shared.commonrings[i]->commonring;
1721
1722 flowrings = kcalloc(devinfo->shared.max_flowrings, sizeof(*flowrings),
1723 GFP_KERNEL);
1724 if (!flowrings)
1725 goto fail;
1726
1727 for (i = 0; i < devinfo->shared.max_flowrings; i++)
1728 flowrings[i] = &devinfo->shared.flowrings[i].commonring;
1729 bus->msgbuf->flowrings = flowrings;
1730
1731 bus->msgbuf->rx_dataoffset = devinfo->shared.rx_dataoffset;
1732 bus->msgbuf->max_rxbufpost = devinfo->shared.max_rxbufpost;
1733 bus->msgbuf->max_flowrings = devinfo->shared.max_flowrings;
1734
1735 init_waitqueue_head(&devinfo->mbdata_resp_wait);
1736
1737 brcmf_pcie_intr_enable(devinfo);
1738 if (brcmf_pcie_attach_bus(devinfo) == 0)
1739 return;
1740
1741 brcmf_pcie_bus_console_read(devinfo);
1742
1743fail:
1744 device_release_driver(dev);
1745}
1746
1747static int
1748brcmf_pcie_probe(struct pci_dev *pdev, const struct pci_device_id *id)
1749{
1750 int ret;
1751 struct brcmf_pciedev_info *devinfo;
1752 struct brcmf_pciedev *pcie_bus_dev;
1753 struct brcmf_bus *bus;
1754 u16 domain_nr;
1755 u16 bus_nr;
1756
1757 domain_nr = pci_domain_nr(pdev->bus) + 1;
1758 bus_nr = pdev->bus->number;
1759 brcmf_dbg(PCIE, "Enter %x:%x (%d/%d)\n", pdev->vendor, pdev->device,
1760 domain_nr, bus_nr);
1761
1762 ret = -ENOMEM;
1763 devinfo = kzalloc(sizeof(*devinfo), GFP_KERNEL);
1764 if (devinfo == NULL)
1765 return ret;
1766
1767 devinfo->pdev = pdev;
1768 pcie_bus_dev = NULL;
1769 devinfo->ci = brcmf_chip_attach(devinfo, &brcmf_pcie_buscore_ops);
1770 if (IS_ERR(devinfo->ci)) {
1771 ret = PTR_ERR(devinfo->ci);
1772 devinfo->ci = NULL;
1773 goto fail;
1774 }
1775
1776 pcie_bus_dev = kzalloc(sizeof(*pcie_bus_dev), GFP_KERNEL);
1777 if (pcie_bus_dev == NULL) {
1778 ret = -ENOMEM;
1779 goto fail;
1780 }
1781
1782 devinfo->settings = brcmf_get_module_param(&devinfo->pdev->dev,
1783 BRCMF_BUSTYPE_PCIE,
1784 devinfo->ci->chip,
1785 devinfo->ci->chiprev);
1786 if (!devinfo->settings) {
1787 ret = -ENOMEM;
1788 goto fail;
1789 }
1790
1791 bus = kzalloc(sizeof(*bus), GFP_KERNEL);
1792 if (!bus) {
1793 ret = -ENOMEM;
1794 goto fail;
1795 }
1796 bus->msgbuf = kzalloc(sizeof(*bus->msgbuf), GFP_KERNEL);
1797 if (!bus->msgbuf) {
1798 ret = -ENOMEM;
1799 kfree(bus);
1800 goto fail;
1801 }
1802
1803
1804 pcie_bus_dev->devinfo = devinfo;
1805 pcie_bus_dev->bus = bus;
1806 bus->dev = &pdev->dev;
1807 bus->bus_priv.pcie = pcie_bus_dev;
1808 bus->ops = &brcmf_pcie_bus_ops;
1809 bus->proto_type = BRCMF_PROTO_MSGBUF;
1810 bus->chip = devinfo->coreid;
1811 bus->wowl_supported = pci_pme_capable(pdev, PCI_D3hot);
1812 dev_set_drvdata(&pdev->dev, bus);
1813
1814 ret = brcmf_fw_map_chip_to_name(devinfo->ci->chip, devinfo->ci->chiprev,
1815 brcmf_pcie_fwnames,
1816 ARRAY_SIZE(brcmf_pcie_fwnames),
1817 devinfo->fw_name, devinfo->nvram_name);
1818 if (ret)
1819 goto fail_bus;
1820
1821 ret = brcmf_fw_get_firmwares_pcie(bus->dev, BRCMF_FW_REQUEST_NVRAM |
1822 BRCMF_FW_REQ_NV_OPTIONAL,
1823 devinfo->fw_name, devinfo->nvram_name,
1824 brcmf_pcie_setup, domain_nr, bus_nr);
1825 if (ret == 0)
1826 return 0;
1827fail_bus:
1828 kfree(bus->msgbuf);
1829 kfree(bus);
1830fail:
1831 brcmf_err("failed %x:%x\n", pdev->vendor, pdev->device);
1832 brcmf_pcie_release_resource(devinfo);
1833 if (devinfo->ci)
1834 brcmf_chip_detach(devinfo->ci);
1835 if (devinfo->settings)
1836 brcmf_release_module_param(devinfo->settings);
1837 kfree(pcie_bus_dev);
1838 kfree(devinfo);
1839 return ret;
1840}
1841
1842
1843static void
1844brcmf_pcie_remove(struct pci_dev *pdev)
1845{
1846 struct brcmf_pciedev_info *devinfo;
1847 struct brcmf_bus *bus;
1848
1849 brcmf_dbg(PCIE, "Enter\n");
1850
1851 bus = dev_get_drvdata(&pdev->dev);
1852 if (bus == NULL)
1853 return;
1854
1855 devinfo = bus->bus_priv.pcie->devinfo;
1856
1857 devinfo->state = BRCMFMAC_PCIE_STATE_DOWN;
1858 if (devinfo->ci)
1859 brcmf_pcie_intr_disable(devinfo);
1860
1861 brcmf_detach(&pdev->dev);
1862
1863 kfree(bus->bus_priv.pcie);
1864 kfree(bus->msgbuf->flowrings);
1865 kfree(bus->msgbuf);
1866 kfree(bus);
1867
1868 brcmf_pcie_release_irq(devinfo);
1869 brcmf_pcie_release_scratchbuffers(devinfo);
1870 brcmf_pcie_release_ringbuffers(devinfo);
1871 brcmf_pcie_reset_device(devinfo);
1872 brcmf_pcie_release_resource(devinfo);
1873
1874 if (devinfo->ci)
1875 brcmf_chip_detach(devinfo->ci);
1876 if (devinfo->settings)
1877 brcmf_release_module_param(devinfo->settings);
1878
1879 kfree(devinfo);
1880 dev_set_drvdata(&pdev->dev, NULL);
1881}
1882
1883
1884#ifdef CONFIG_PM
1885
1886
1887static int brcmf_pcie_pm_enter_D3(struct device *dev)
1888{
1889 struct brcmf_pciedev_info *devinfo;
1890 struct brcmf_bus *bus;
1891
1892 brcmf_dbg(PCIE, "Enter\n");
1893
1894 bus = dev_get_drvdata(dev);
1895 devinfo = bus->bus_priv.pcie->devinfo;
1896
1897 brcmf_bus_change_state(bus, BRCMF_BUS_DOWN);
1898
1899 devinfo->mbdata_completed = false;
1900 brcmf_pcie_send_mb_data(devinfo, BRCMF_H2D_HOST_D3_INFORM);
1901
1902 wait_event_timeout(devinfo->mbdata_resp_wait, devinfo->mbdata_completed,
1903 BRCMF_PCIE_MBDATA_TIMEOUT);
1904 if (!devinfo->mbdata_completed) {
1905 brcmf_err("Timeout on response for entering D3 substate\n");
1906 brcmf_bus_change_state(bus, BRCMF_BUS_UP);
1907 return -EIO;
1908 }
1909
1910 devinfo->state = BRCMFMAC_PCIE_STATE_DOWN;
1911
1912 return 0;
1913}
1914
1915
1916static int brcmf_pcie_pm_leave_D3(struct device *dev)
1917{
1918 struct brcmf_pciedev_info *devinfo;
1919 struct brcmf_bus *bus;
1920 struct pci_dev *pdev;
1921 int err;
1922
1923 brcmf_dbg(PCIE, "Enter\n");
1924
1925 bus = dev_get_drvdata(dev);
1926 devinfo = bus->bus_priv.pcie->devinfo;
1927 brcmf_dbg(PCIE, "Enter, dev=%p, bus=%p\n", dev, bus);
1928
1929
1930 if (brcmf_pcie_read_reg32(devinfo, BRCMF_PCIE_PCIE2REG_INTMASK) != 0) {
1931 brcmf_dbg(PCIE, "Try to wakeup device....\n");
1932 if (brcmf_pcie_send_mb_data(devinfo, BRCMF_H2D_HOST_D0_INFORM))
1933 goto cleanup;
1934 brcmf_dbg(PCIE, "Hot resume, continue....\n");
1935 devinfo->state = BRCMFMAC_PCIE_STATE_UP;
1936 brcmf_pcie_select_core(devinfo, BCMA_CORE_PCIE2);
1937 brcmf_bus_change_state(bus, BRCMF_BUS_UP);
1938 brcmf_pcie_intr_enable(devinfo);
1939 return 0;
1940 }
1941
1942cleanup:
1943 brcmf_chip_detach(devinfo->ci);
1944 devinfo->ci = NULL;
1945 pdev = devinfo->pdev;
1946 brcmf_pcie_remove(pdev);
1947
1948 err = brcmf_pcie_probe(pdev, NULL);
1949 if (err)
1950 brcmf_err("probe after resume failed, err=%d\n", err);
1951
1952 return err;
1953}
1954
1955
1956static const struct dev_pm_ops brcmf_pciedrvr_pm = {
1957 .suspend = brcmf_pcie_pm_enter_D3,
1958 .resume = brcmf_pcie_pm_leave_D3,
1959 .freeze = brcmf_pcie_pm_enter_D3,
1960 .restore = brcmf_pcie_pm_leave_D3,
1961};
1962
1963
1964#endif
1965
1966
1967#define BRCMF_PCIE_DEVICE(dev_id) { BRCM_PCIE_VENDOR_ID_BROADCOM, dev_id,\
1968 PCI_ANY_ID, PCI_ANY_ID, PCI_CLASS_NETWORK_OTHER << 8, 0xffff00, 0 }
1969#define BRCMF_PCIE_DEVICE_SUB(dev_id, subvend, subdev) { \
1970 BRCM_PCIE_VENDOR_ID_BROADCOM, dev_id,\
1971 subvend, subdev, PCI_CLASS_NETWORK_OTHER << 8, 0xffff00, 0 }
1972
1973static const struct pci_device_id brcmf_pcie_devid_table[] = {
1974 BRCMF_PCIE_DEVICE(BRCM_PCIE_4350_DEVICE_ID),
1975 BRCMF_PCIE_DEVICE(BRCM_PCIE_4356_DEVICE_ID),
1976 BRCMF_PCIE_DEVICE(BRCM_PCIE_43567_DEVICE_ID),
1977 BRCMF_PCIE_DEVICE(BRCM_PCIE_43570_DEVICE_ID),
1978 BRCMF_PCIE_DEVICE(BRCM_PCIE_4358_DEVICE_ID),
1979 BRCMF_PCIE_DEVICE(BRCM_PCIE_4359_DEVICE_ID),
1980 BRCMF_PCIE_DEVICE(BRCM_PCIE_43602_DEVICE_ID),
1981 BRCMF_PCIE_DEVICE(BRCM_PCIE_43602_2G_DEVICE_ID),
1982 BRCMF_PCIE_DEVICE(BRCM_PCIE_43602_5G_DEVICE_ID),
1983 BRCMF_PCIE_DEVICE(BRCM_PCIE_43602_RAW_DEVICE_ID),
1984 BRCMF_PCIE_DEVICE(BRCM_PCIE_4365_DEVICE_ID),
1985 BRCMF_PCIE_DEVICE(BRCM_PCIE_4365_2G_DEVICE_ID),
1986 BRCMF_PCIE_DEVICE(BRCM_PCIE_4365_5G_DEVICE_ID),
1987 BRCMF_PCIE_DEVICE_SUB(0x4365, BRCM_PCIE_VENDOR_ID_BROADCOM, 0x4365),
1988 BRCMF_PCIE_DEVICE(BRCM_PCIE_4366_DEVICE_ID),
1989 BRCMF_PCIE_DEVICE(BRCM_PCIE_4366_2G_DEVICE_ID),
1990 BRCMF_PCIE_DEVICE(BRCM_PCIE_4366_5G_DEVICE_ID),
1991 BRCMF_PCIE_DEVICE(BRCM_PCIE_4371_DEVICE_ID),
1992 { }
1993};
1994
1995
1996MODULE_DEVICE_TABLE(pci, brcmf_pcie_devid_table);
1997
1998
1999static struct pci_driver brcmf_pciedrvr = {
2000 .node = {},
2001 .name = KBUILD_MODNAME,
2002 .id_table = brcmf_pcie_devid_table,
2003 .probe = brcmf_pcie_probe,
2004 .remove = brcmf_pcie_remove,
2005#ifdef CONFIG_PM
2006 .driver.pm = &brcmf_pciedrvr_pm,
2007#endif
2008};
2009
2010
2011void brcmf_pcie_register(void)
2012{
2013 int err;
2014
2015 brcmf_dbg(PCIE, "Enter\n");
2016 err = pci_register_driver(&brcmf_pciedrvr);
2017 if (err)
2018 brcmf_err("PCIE driver registration failed, err=%d\n", err);
2019}
2020
2021
2022void brcmf_pcie_exit(void)
2023{
2024 brcmf_dbg(PCIE, "Enter\n");
2025 pci_unregister_driver(&brcmf_pciedrvr);
2026}
2027