Lines Matching refs:rtwdev
12 void rtw_set_channel_mac(struct rtw_dev *rtwdev, u8 channel, u8 bw, in rtw_set_channel_mac() argument
26 rtw_write8(rtwdev, REG_DATA_SC, in rtw_set_channel_mac()
29 value32 = rtw_read32(rtwdev, REG_WMAC_TRXPTCL_CTL); in rtw_set_channel_mac()
42 rtw_write32(rtwdev, REG_WMAC_TRXPTCL_CTL, value32); in rtw_set_channel_mac()
44 if (rtw_chip_wcpu_11n(rtwdev)) in rtw_set_channel_mac()
47 value32 = rtw_read32(rtwdev, REG_AFE_CTRL1) & ~(BIT_MAC_CLK_SEL); in rtw_set_channel_mac()
49 rtw_write32(rtwdev, REG_AFE_CTRL1, value32); in rtw_set_channel_mac()
51 rtw_write8(rtwdev, REG_USTIME_TSF, MAC_CLK_SPEED); in rtw_set_channel_mac()
52 rtw_write8(rtwdev, REG_USTIME_EDCA, MAC_CLK_SPEED); in rtw_set_channel_mac()
54 value8 = rtw_read8(rtwdev, REG_CCK_CHECK); in rtw_set_channel_mac()
58 rtw_write8(rtwdev, REG_CCK_CHECK, value8); in rtw_set_channel_mac()
62 static int rtw_mac_pre_system_cfg(struct rtw_dev *rtwdev) in rtw_mac_pre_system_cfg() argument
68 rtw_write8(rtwdev, REG_RSV_CTRL, 0); in rtw_mac_pre_system_cfg()
70 if (rtw_chip_wcpu_11n(rtwdev)) { in rtw_mac_pre_system_cfg()
71 if (rtw_read32(rtwdev, REG_SYS_CFG1) & BIT_LDO) in rtw_mac_pre_system_cfg()
72 rtw_write8(rtwdev, REG_LDO_SWR_CTRL, LDO_SEL); in rtw_mac_pre_system_cfg()
74 rtw_write8(rtwdev, REG_LDO_SWR_CTRL, SPS_SEL); in rtw_mac_pre_system_cfg()
78 switch (rtw_hci_type(rtwdev)) { in rtw_mac_pre_system_cfg()
80 rtw_write32_set(rtwdev, REG_HCI_OPT_CTRL, BIT_USB_SUS_DIS); in rtw_mac_pre_system_cfg()
83 rtw_write8_clr(rtwdev, REG_SDIO_HSUS_CTRL, BIT_HCI_SUS_REQ); in rtw_mac_pre_system_cfg()
86 if (rtw_read8(rtwdev, REG_SDIO_HSUS_CTRL) & BIT_HCI_RESUME_RDY) in rtw_mac_pre_system_cfg()
93 rtw_err(rtwdev, "failed to poll REG_SDIO_HSUS_CTRL[1]"); in rtw_mac_pre_system_cfg()
97 if (rtw_sdio_is_sdio30_supported(rtwdev)) in rtw_mac_pre_system_cfg()
98 rtw_write8_set(rtwdev, REG_HCI_OPT_CTRL + 2, in rtw_mac_pre_system_cfg()
101 rtw_write8_clr(rtwdev, REG_HCI_OPT_CTRL + 2, in rtw_mac_pre_system_cfg()
111 value32 = rtw_read32(rtwdev, REG_PAD_CTRL1); in rtw_mac_pre_system_cfg()
113 rtw_write32(rtwdev, REG_PAD_CTRL1, value32); in rtw_mac_pre_system_cfg()
115 value32 = rtw_read32(rtwdev, REG_LED_CFG); in rtw_mac_pre_system_cfg()
117 rtw_write32(rtwdev, REG_LED_CFG, value32); in rtw_mac_pre_system_cfg()
119 value32 = rtw_read32(rtwdev, REG_GPIO_MUXCFG); in rtw_mac_pre_system_cfg()
121 rtw_write32(rtwdev, REG_GPIO_MUXCFG, value32); in rtw_mac_pre_system_cfg()
124 value8 = rtw_read8(rtwdev, REG_SYS_FUNC_EN); in rtw_mac_pre_system_cfg()
126 rtw_write8(rtwdev, REG_SYS_FUNC_EN, value8); in rtw_mac_pre_system_cfg()
128 value8 = rtw_read8(rtwdev, REG_RF_CTRL); in rtw_mac_pre_system_cfg()
130 rtw_write8(rtwdev, REG_RF_CTRL, value8); in rtw_mac_pre_system_cfg()
132 value32 = rtw_read32(rtwdev, REG_WLRF1); in rtw_mac_pre_system_cfg()
134 rtw_write32(rtwdev, REG_WLRF1, value32); in rtw_mac_pre_system_cfg()
139 static bool do_pwr_poll_cmd(struct rtw_dev *rtwdev, u32 addr, u32 mask, u32 target) in do_pwr_poll_cmd() argument
147 rtwdev, addr) == 0; in do_pwr_poll_cmd()
150 static int rtw_pwr_cmd_polling(struct rtw_dev *rtwdev, in rtw_pwr_cmd_polling() argument
161 if (do_pwr_poll_cmd(rtwdev, offset, cmd->mask, cmd->value)) in rtw_pwr_cmd_polling()
164 if (rtw_hci_type(rtwdev) != RTW_HCI_TYPE_PCIE) in rtw_pwr_cmd_polling()
168 value = rtw_read8(rtwdev, REG_SYS_PW_CTRL); in rtw_pwr_cmd_polling()
169 if (rtwdev->chip->id == RTW_CHIP_TYPE_8723D) in rtw_pwr_cmd_polling()
170 rtw_write8(rtwdev, REG_SYS_PW_CTRL, value & ~BIT_PFM_WOWL); in rtw_pwr_cmd_polling()
171 rtw_write8(rtwdev, REG_SYS_PW_CTRL, value | BIT_PFM_WOWL); in rtw_pwr_cmd_polling()
172 rtw_write8(rtwdev, REG_SYS_PW_CTRL, value & ~BIT_PFM_WOWL); in rtw_pwr_cmd_polling()
173 if (rtwdev->chip->id == RTW_CHIP_TYPE_8723D) in rtw_pwr_cmd_polling()
174 rtw_write8(rtwdev, REG_SYS_PW_CTRL, value | BIT_PFM_WOWL); in rtw_pwr_cmd_polling()
176 if (do_pwr_poll_cmd(rtwdev, offset, cmd->mask, cmd->value)) in rtw_pwr_cmd_polling()
180 rtw_err(rtwdev, "failed to poll offset=0x%x mask=0x%x value=0x%x\n", in rtw_pwr_cmd_polling()
185 static int rtw_sub_pwr_seq_parser(struct rtw_dev *rtwdev, u8 intf_mask, in rtw_sub_pwr_seq_parser() argument
205 value = rtw_read8(rtwdev, offset); in rtw_sub_pwr_seq_parser()
208 rtw_write8(rtwdev, offset, value); in rtw_sub_pwr_seq_parser()
211 if (rtw_pwr_cmd_polling(rtwdev, cur_cmd)) in rtw_sub_pwr_seq_parser()
230 static int rtw_pwr_seq_parser(struct rtw_dev *rtwdev, in rtw_pwr_seq_parser() argument
240 cut = rtwdev->hal.cut_version; in rtw_pwr_seq_parser()
242 switch (rtw_hci_type(rtwdev)) { in rtw_pwr_seq_parser()
261 ret = rtw_sub_pwr_seq_parser(rtwdev, intf_mask, cut_mask, cmd); in rtw_pwr_seq_parser()
271 static int rtw_mac_power_switch(struct rtw_dev *rtwdev, bool pwr_on) in rtw_mac_power_switch() argument
273 const struct rtw_chip_info *chip = rtwdev->chip; in rtw_mac_power_switch()
280 if (rtw_chip_wcpu_11ac(rtwdev)) { in rtw_mac_power_switch()
281 rpwm = rtw_read8(rtwdev, rtwdev->hci.rpwm_addr); in rtw_mac_power_switch()
284 if (rtw_read16(rtwdev, REG_MCUFW_CTRL) == 0xC078) { in rtw_mac_power_switch()
286 rtw_write8(rtwdev, rtwdev->hci.rpwm_addr, rpwm); in rtw_mac_power_switch()
290 if (rtw_read8(rtwdev, REG_CR) == 0xea) in rtw_mac_power_switch()
292 else if (rtw_hci_type(rtwdev) == RTW_HCI_TYPE_USB && in rtw_mac_power_switch()
293 (rtw_read8(rtwdev, REG_SYS_STATUS1 + 1) & BIT(0))) in rtw_mac_power_switch()
301 if (rtw_hci_type(rtwdev) == RTW_HCI_TYPE_SDIO) { in rtw_mac_power_switch()
302 imr = rtw_read32(rtwdev, REG_SDIO_HIMR); in rtw_mac_power_switch()
303 rtw_write32(rtwdev, REG_SDIO_HIMR, 0); in rtw_mac_power_switch()
307 clear_bit(RTW_FLAG_POWERON, rtwdev->flags); in rtw_mac_power_switch()
310 ret = rtw_pwr_seq_parser(rtwdev, pwr_seq); in rtw_mac_power_switch()
312 if (pwr_on && rtw_hci_type(rtwdev) == RTW_HCI_TYPE_USB) { in rtw_mac_power_switch()
316 rtw_write8_clr(rtwdev, REG_SYS_STATUS1 + 1, BIT(0)); in rtw_mac_power_switch()
319 if (rtw_hci_type(rtwdev) == RTW_HCI_TYPE_SDIO) in rtw_mac_power_switch()
320 rtw_write32(rtwdev, REG_SDIO_HIMR, imr); in rtw_mac_power_switch()
323 set_bit(RTW_FLAG_POWERON, rtwdev->flags); in rtw_mac_power_switch()
328 static int __rtw_mac_init_system_cfg(struct rtw_dev *rtwdev) in __rtw_mac_init_system_cfg() argument
330 u8 sys_func_en = rtwdev->chip->sys_func_en; in __rtw_mac_init_system_cfg()
334 value = rtw_read32(rtwdev, REG_CPU_DMEM_CON); in __rtw_mac_init_system_cfg()
336 rtw_write32(rtwdev, REG_CPU_DMEM_CON, value); in __rtw_mac_init_system_cfg()
338 rtw_write8_set(rtwdev, REG_SYS_FUNC_EN + 1, sys_func_en); in __rtw_mac_init_system_cfg()
339 value8 = (rtw_read8(rtwdev, REG_CR_EXT + 3) & 0xF0) | 0x0C; in __rtw_mac_init_system_cfg()
340 rtw_write8(rtwdev, REG_CR_EXT + 3, value8); in __rtw_mac_init_system_cfg()
343 tmp = rtw_read32(rtwdev, REG_MCUFW_CTRL); in __rtw_mac_init_system_cfg()
345 rtw_write32(rtwdev, REG_MCUFW_CTRL, tmp & (~BIT_BOOT_FSPI_EN)); in __rtw_mac_init_system_cfg()
346 value = rtw_read32(rtwdev, REG_GPIO_MUXCFG) & (~BIT_FSPI_EN); in __rtw_mac_init_system_cfg()
347 rtw_write32(rtwdev, REG_GPIO_MUXCFG, value); in __rtw_mac_init_system_cfg()
353 static int __rtw_mac_init_system_cfg_legacy(struct rtw_dev *rtwdev) in __rtw_mac_init_system_cfg_legacy() argument
355 rtw_write8(rtwdev, REG_CR, 0xff); in __rtw_mac_init_system_cfg_legacy()
357 rtw_write8(rtwdev, REG_HWSEQ_CTRL, 0x7f); in __rtw_mac_init_system_cfg_legacy()
360 rtw_write8_set(rtwdev, REG_SYS_CLKR, BIT_WAKEPAD_EN); in __rtw_mac_init_system_cfg_legacy()
361 rtw_write16_clr(rtwdev, REG_GPIO_MUXCFG, BIT_EN_SIC); in __rtw_mac_init_system_cfg_legacy()
363 rtw_write16(rtwdev, REG_CR, 0x2ff); in __rtw_mac_init_system_cfg_legacy()
368 static int rtw_mac_init_system_cfg(struct rtw_dev *rtwdev) in rtw_mac_init_system_cfg() argument
370 if (rtw_chip_wcpu_11n(rtwdev)) in rtw_mac_init_system_cfg()
371 return __rtw_mac_init_system_cfg_legacy(rtwdev); in rtw_mac_init_system_cfg()
373 return __rtw_mac_init_system_cfg(rtwdev); in rtw_mac_init_system_cfg()
376 int rtw_mac_power_on(struct rtw_dev *rtwdev) in rtw_mac_power_on() argument
380 ret = rtw_mac_pre_system_cfg(rtwdev); in rtw_mac_power_on()
384 ret = rtw_mac_power_switch(rtwdev, true); in rtw_mac_power_on()
386 rtw_mac_power_switch(rtwdev, false); in rtw_mac_power_on()
388 ret = rtw_mac_pre_system_cfg(rtwdev); in rtw_mac_power_on()
392 ret = rtw_mac_power_switch(rtwdev, true); in rtw_mac_power_on()
399 ret = rtw_mac_init_system_cfg(rtwdev); in rtw_mac_power_on()
406 rtw_err(rtwdev, "mac power on failed"); in rtw_mac_power_on()
410 void rtw_mac_power_off(struct rtw_dev *rtwdev) in rtw_mac_power_off() argument
412 rtw_mac_power_switch(rtwdev, false); in rtw_mac_power_off()
438 static void wlan_cpu_enable(struct rtw_dev *rtwdev, bool enable) in wlan_cpu_enable() argument
442 rtw_write8_set(rtwdev, REG_RSV_CTRL + 1, BIT_WLMCU_IOIF); in wlan_cpu_enable()
445 rtw_write8_set(rtwdev, REG_SYS_FUNC_EN + 1, BIT_FEN_CPUEN); in wlan_cpu_enable()
448 rtw_write8_clr(rtwdev, REG_SYS_FUNC_EN + 1, BIT_FEN_CPUEN); in wlan_cpu_enable()
451 rtw_write8_clr(rtwdev, REG_RSV_CTRL + 1, BIT_WLMCU_IOIF); in wlan_cpu_enable()
457 static void download_firmware_reg_backup(struct rtw_dev *rtwdev, in download_firmware_reg_backup() argument
466 bckp[bckp_idx].val = rtw_read8(rtwdev, REG_TXDMA_PQ_MAP + 1); in download_firmware_reg_backup()
469 rtw_write8(rtwdev, REG_TXDMA_PQ_MAP + 1, tmp); in download_firmware_reg_backup()
474 bckp[bckp_idx].val = rtw_read8(rtwdev, REG_CR); in download_firmware_reg_backup()
481 rtw_write8(rtwdev, REG_CR, tmp); in download_firmware_reg_backup()
482 rtw_write32(rtwdev, REG_H2CQ_CSR, BIT_H2CQ_FULL); in download_firmware_reg_backup()
487 bckp[bckp_idx].val = rtw_read16(rtwdev, REG_FIFOPAGE_INFO_1); in download_firmware_reg_backup()
491 bckp[bckp_idx].val = rtw_read32(rtwdev, REG_RQPN_CTRL_2) | BIT_LD_RQPN; in download_firmware_reg_backup()
493 rtw_write16(rtwdev, REG_FIFOPAGE_INFO_1, 0x200); in download_firmware_reg_backup()
494 rtw_write32(rtwdev, REG_RQPN_CTRL_2, bckp[bckp_idx - 1].val); in download_firmware_reg_backup()
496 if (rtw_hci_type(rtwdev) == RTW_HCI_TYPE_SDIO) in download_firmware_reg_backup()
497 rtw_read32(rtwdev, REG_SDIO_FREE_TXPG); in download_firmware_reg_backup()
500 tmp = rtw_read8(rtwdev, REG_BCN_CTRL); in download_firmware_reg_backup()
506 rtw_write8(rtwdev, REG_BCN_CTRL, tmp); in download_firmware_reg_backup()
511 static void download_firmware_reset_platform(struct rtw_dev *rtwdev) in download_firmware_reset_platform() argument
513 rtw_write8_clr(rtwdev, REG_CPU_DMEM_CON + 2, BIT_WL_PLATFORM_RST >> 16); in download_firmware_reset_platform()
514 rtw_write8_clr(rtwdev, REG_SYS_CLK_CTRL + 1, BIT_CPU_CLK_EN >> 8); in download_firmware_reset_platform()
515 rtw_write8_set(rtwdev, REG_CPU_DMEM_CON + 2, BIT_WL_PLATFORM_RST >> 16); in download_firmware_reset_platform()
516 rtw_write8_set(rtwdev, REG_SYS_CLK_CTRL + 1, BIT_CPU_CLK_EN >> 8); in download_firmware_reset_platform()
519 static void download_firmware_reg_restore(struct rtw_dev *rtwdev, in download_firmware_reg_restore() argument
523 rtw_restore_reg(rtwdev, bckp, bckp_num); in download_firmware_reg_restore()
528 static int send_firmware_pkt_rsvd_page(struct rtw_dev *rtwdev, u16 pg_addr, in send_firmware_pkt_rsvd_page() argument
538 ret = rtw_fw_write_data_rsvd_page(rtwdev, pg_addr, buf, size); in send_firmware_pkt_rsvd_page()
544 send_firmware_pkt(struct rtw_dev *rtwdev, u16 pg_addr, const u8 *data, u32 size) in send_firmware_pkt() argument
548 if (rtw_hci_type(rtwdev) == RTW_HCI_TYPE_USB && in send_firmware_pkt()
552 ret = send_firmware_pkt_rsvd_page(rtwdev, pg_addr, data, size); in send_firmware_pkt()
554 rtw_err(rtwdev, "failed to download rsvd page\n"); in send_firmware_pkt()
560 iddma_enable(struct rtw_dev *rtwdev, u32 src, u32 dst, u32 ctrl) in iddma_enable() argument
562 rtw_write32(rtwdev, REG_DDMA_CH0SA, src); in iddma_enable()
563 rtw_write32(rtwdev, REG_DDMA_CH0DA, dst); in iddma_enable()
564 rtw_write32(rtwdev, REG_DDMA_CH0CTRL, ctrl); in iddma_enable()
566 if (!check_hw_ready(rtwdev, REG_DDMA_CH0CTRL, BIT_DDMACH0_OWN, 0)) in iddma_enable()
572 static int iddma_download_firmware(struct rtw_dev *rtwdev, u32 src, u32 dst, in iddma_download_firmware() argument
577 if (!check_hw_ready(rtwdev, REG_DDMA_CH0CTRL, BIT_DDMACH0_OWN, 0)) in iddma_download_firmware()
584 if (iddma_enable(rtwdev, src, dst, ch0_ctrl)) in iddma_download_firmware()
590 int rtw_ddma_to_fw_fifo(struct rtw_dev *rtwdev, u32 ocp_src, u32 size) in rtw_ddma_to_fw_fifo() argument
594 if (!check_hw_ready(rtwdev, REG_DDMA_CH0CTRL, BIT_DDMACH0_OWN, 0)) { in rtw_ddma_to_fw_fifo()
595 rtw_dbg(rtwdev, RTW_DBG_FW, "busy to start ddma\n"); in rtw_ddma_to_fw_fifo()
601 if (iddma_enable(rtwdev, ocp_src, OCPBASE_RXBUF_FW_88XX, ch0_ctrl)) { in rtw_ddma_to_fw_fifo()
602 rtw_dbg(rtwdev, RTW_DBG_FW, "busy to complete ddma\n"); in rtw_ddma_to_fw_fifo()
610 check_fw_checksum(struct rtw_dev *rtwdev, u32 addr) in check_fw_checksum() argument
614 fw_ctrl = rtw_read8(rtwdev, REG_MCUFW_CTRL); in check_fw_checksum()
616 if (rtw_read32(rtwdev, REG_DDMA_CH0CTRL) & BIT_DDMACH0_CHKSUM_STS) { in check_fw_checksum()
620 rtw_write8(rtwdev, REG_MCUFW_CTRL, fw_ctrl); in check_fw_checksum()
624 rtw_write8(rtwdev, REG_MCUFW_CTRL, fw_ctrl); in check_fw_checksum()
627 rtw_err(rtwdev, "invalid fw checksum\n"); in check_fw_checksum()
634 rtw_write8(rtwdev, REG_MCUFW_CTRL, fw_ctrl); in check_fw_checksum()
637 rtw_write8(rtwdev, REG_MCUFW_CTRL, fw_ctrl); in check_fw_checksum()
644 download_firmware_to_mem(struct rtw_dev *rtwdev, const u8 *data, in download_firmware_to_mem() argument
647 const struct rtw_chip_info *chip = rtwdev->chip; in download_firmware_to_mem()
661 val = rtw_read32(rtwdev, REG_DDMA_CH0CTRL); in download_firmware_to_mem()
663 rtw_write32(rtwdev, REG_DDMA_CH0CTRL, val); in download_firmware_to_mem()
671 ret = send_firmware_pkt(rtwdev, (u16)(src >> 7), in download_firmware_to_mem()
676 ret = iddma_download_firmware(rtwdev, OCPBASE_TXBUF_88XX + in download_firmware_to_mem()
688 if (!check_fw_checksum(rtwdev, dst)) in download_firmware_to_mem()
695 start_download_firmware(struct rtw_dev *rtwdev, const u8 *data, u32 size) in start_download_firmware() argument
714 val = (u16)(rtw_read16(rtwdev, REG_MCUFW_CTRL) & 0x3800); in start_download_firmware()
716 rtw_write16(rtwdev, REG_MCUFW_CTRL, val); in start_download_firmware()
721 ret = download_firmware_to_mem(rtwdev, cur_fw, 0, addr, dmem_size); in start_download_firmware()
728 ret = download_firmware_to_mem(rtwdev, cur_fw, 0, addr, imem_size); in start_download_firmware()
736 ret = download_firmware_to_mem(rtwdev, cur_fw, 0, addr, in start_download_firmware()
745 static int download_firmware_validate(struct rtw_dev *rtwdev) in download_firmware_validate() argument
749 if (!check_hw_ready(rtwdev, REG_MCUFW_CTRL, FW_READY_MASK, FW_READY)) { in download_firmware_validate()
750 fw_key = rtw_read32(rtwdev, REG_FW_DBG7) & FW_KEY_MASK; in download_firmware_validate()
752 rtw_err(rtwdev, "invalid fw key\n"); in download_firmware_validate()
759 static void download_firmware_end_flow(struct rtw_dev *rtwdev) in download_firmware_end_flow() argument
763 rtw_write32(rtwdev, REG_TXDMA_STATUS, BTI_PAGE_OVF); in download_firmware_end_flow()
766 fw_ctrl = rtw_read16(rtwdev, REG_MCUFW_CTRL); in download_firmware_end_flow()
771 rtw_write16(rtwdev, REG_MCUFW_CTRL, fw_ctrl); in download_firmware_end_flow()
774 static int __rtw_download_firmware(struct rtw_dev *rtwdev, in __rtw_download_firmware() argument
786 if (!ltecoex_read_reg(rtwdev, 0x38, <ecoex_bckp)) in __rtw_download_firmware()
789 wlan_cpu_enable(rtwdev, false); in __rtw_download_firmware()
791 download_firmware_reg_backup(rtwdev, bckp); in __rtw_download_firmware()
792 download_firmware_reset_platform(rtwdev); in __rtw_download_firmware()
794 ret = start_download_firmware(rtwdev, data, size); in __rtw_download_firmware()
798 download_firmware_reg_restore(rtwdev, bckp, DLFW_RESTORE_REG_NUM); in __rtw_download_firmware()
800 download_firmware_end_flow(rtwdev); in __rtw_download_firmware()
802 wlan_cpu_enable(rtwdev, true); in __rtw_download_firmware()
804 if (!ltecoex_reg_write(rtwdev, 0x38, ltecoex_bckp)) { in __rtw_download_firmware()
809 ret = download_firmware_validate(rtwdev); in __rtw_download_firmware()
814 rtw_hci_setup(rtwdev); in __rtw_download_firmware()
816 rtwdev->h2c.last_box_num = 0; in __rtw_download_firmware()
817 rtwdev->h2c.seq = 0; in __rtw_download_firmware()
819 set_bit(RTW_FLAG_FW_RUNNING, rtwdev->flags); in __rtw_download_firmware()
825 rtw_write8_clr(rtwdev, REG_MCUFW_CTRL, BIT_MCUFWDL_EN); in __rtw_download_firmware()
826 rtw_write8_set(rtwdev, REG_SYS_FUNC_EN + 1, BIT_FEN_CPUEN); in __rtw_download_firmware()
831 static void en_download_firmware_legacy(struct rtw_dev *rtwdev, bool en) in en_download_firmware_legacy() argument
836 wlan_cpu_enable(rtwdev, false); in en_download_firmware_legacy()
837 wlan_cpu_enable(rtwdev, true); in en_download_firmware_legacy()
839 rtw_write8_set(rtwdev, REG_MCUFW_CTRL, BIT_MCUFWDL_EN); in en_download_firmware_legacy()
842 if (rtw_read8(rtwdev, REG_MCUFW_CTRL) & BIT_MCUFWDL_EN) in en_download_firmware_legacy()
844 rtw_write8_set(rtwdev, REG_MCUFW_CTRL, BIT_MCUFWDL_EN); in en_download_firmware_legacy()
847 rtw_err(rtwdev, "failed to check fw download ready\n"); in en_download_firmware_legacy()
849 rtw_write32_clr(rtwdev, REG_MCUFW_CTRL, BIT_ROM_DLEN); in en_download_firmware_legacy()
851 rtw_write8_clr(rtwdev, REG_MCUFW_CTRL, BIT_MCUFWDL_EN); in en_download_firmware_legacy()
856 write_firmware_page(struct rtw_dev *rtwdev, u32 page, const u8 *data, u32 size) in write_firmware_page() argument
869 val32 = rtw_read32(rtwdev, REG_MCUFW_CTRL); in write_firmware_page()
872 rtw_write32(rtwdev, REG_MCUFW_CTRL, val32); in write_firmware_page()
875 rtw_write32(rtwdev, write_addr, le32_to_cpu(*ptr)); in write_firmware_page()
883 rtw_write32(rtwdev, write_addr, le32_to_cpu(remain_data)); in write_firmware_page()
888 download_firmware_legacy(struct rtw_dev *rtwdev, const u8 *data, u32 size) in download_firmware_legacy() argument
900 rtw_write8_set(rtwdev, REG_MCUFW_CTRL, BIT_FWDL_CHK_RPT); in download_firmware_legacy()
903 write_firmware_page(rtwdev, page, data, DLFW_PAGE_SIZE_LEGACY); in download_firmware_legacy()
907 write_firmware_page(rtwdev, page, data, last_page_size); in download_firmware_legacy()
909 if (!check_hw_ready(rtwdev, REG_MCUFW_CTRL, BIT_FWDL_CHK_RPT, 1)) { in download_firmware_legacy()
910 rtw_err(rtwdev, "failed to check download firmware report\n"); in download_firmware_legacy()
917 static int download_firmware_validate_legacy(struct rtw_dev *rtwdev) in download_firmware_validate_legacy() argument
922 val32 = rtw_read32(rtwdev, REG_MCUFW_CTRL); in download_firmware_validate_legacy()
925 rtw_write32(rtwdev, REG_MCUFW_CTRL, val32); in download_firmware_validate_legacy()
927 wlan_cpu_enable(rtwdev, false); in download_firmware_validate_legacy()
928 wlan_cpu_enable(rtwdev, true); in download_firmware_validate_legacy()
931 val32 = rtw_read32(rtwdev, REG_MCUFW_CTRL); in download_firmware_validate_legacy()
937 rtw_err(rtwdev, "failed to validate firmware\n"); in download_firmware_validate_legacy()
941 static int __rtw_download_firmware_legacy(struct rtw_dev *rtwdev, in __rtw_download_firmware_legacy() argument
947 if (rtwdev->chip->id == RTW_CHIP_TYPE_8703B && in __rtw_download_firmware_legacy()
948 rtw_read8_mask(rtwdev, REG_MCUFW_CTRL, BIT_RAM_DL_SEL)) { in __rtw_download_firmware_legacy()
949 rtw_write8(rtwdev, REG_MCUFW_CTRL, 0x00); in __rtw_download_firmware_legacy()
952 en_download_firmware_legacy(rtwdev, true); in __rtw_download_firmware_legacy()
953 ret = download_firmware_legacy(rtwdev, fw->firmware->data, fw->firmware->size); in __rtw_download_firmware_legacy()
954 en_download_firmware_legacy(rtwdev, false); in __rtw_download_firmware_legacy()
958 ret = download_firmware_validate_legacy(rtwdev); in __rtw_download_firmware_legacy()
963 rtw_hci_setup(rtwdev); in __rtw_download_firmware_legacy()
965 rtwdev->h2c.last_box_num = 0; in __rtw_download_firmware_legacy()
966 rtwdev->h2c.seq = 0; in __rtw_download_firmware_legacy()
968 set_bit(RTW_FLAG_FW_RUNNING, rtwdev->flags); in __rtw_download_firmware_legacy()
975 int _rtw_download_firmware(struct rtw_dev *rtwdev, struct rtw_fw_state *fw) in _rtw_download_firmware() argument
977 if (rtw_chip_wcpu_11n(rtwdev)) in _rtw_download_firmware()
978 return __rtw_download_firmware_legacy(rtwdev, fw); in _rtw_download_firmware()
980 return __rtw_download_firmware(rtwdev, fw); in _rtw_download_firmware()
983 int rtw_download_firmware(struct rtw_dev *rtwdev, struct rtw_fw_state *fw) in rtw_download_firmware() argument
987 ret = _rtw_download_firmware(rtwdev, fw); in rtw_download_firmware()
991 if (rtw_hci_type(rtwdev) == RTW_HCI_TYPE_PCIE && in rtw_download_firmware()
992 rtwdev->chip->id == RTW_CHIP_TYPE_8821C) in rtw_download_firmware()
993 rtw_fw_set_recover_bt_device(rtwdev); in rtw_download_firmware()
998 static u32 get_priority_queues(struct rtw_dev *rtwdev, u32 queues) in get_priority_queues() argument
1000 const struct rtw_rqpn *rqpn = rtwdev->fifo.rqpn; in get_priority_queues()
1015 static void __rtw_mac_flush_prio_queue(struct rtw_dev *rtwdev, in __rtw_mac_flush_prio_queue() argument
1018 const struct rtw_chip_info *chip = rtwdev->chip; in __rtw_mac_flush_prio_queue()
1032 rsvd_page = wsize ? rtw_read16(rtwdev, addr->rsvd) : in __rtw_mac_flush_prio_queue()
1033 rtw_read8(rtwdev, addr->rsvd); in __rtw_mac_flush_prio_queue()
1034 avail_page = wsize ? rtw_read16(rtwdev, addr->avail) : in __rtw_mac_flush_prio_queue()
1035 rtw_read8(rtwdev, addr->avail); in __rtw_mac_flush_prio_queue()
1049 rtw_dbg(rtwdev, RTW_DBG_UNEXP, in __rtw_mac_flush_prio_queue()
1053 static void rtw_mac_flush_prio_queues(struct rtw_dev *rtwdev, in rtw_mac_flush_prio_queues() argument
1060 __rtw_mac_flush_prio_queue(rtwdev, q, drop); in rtw_mac_flush_prio_queues()
1063 void rtw_mac_flush_queues(struct rtw_dev *rtwdev, u32 queues, bool drop) in rtw_mac_flush_queues() argument
1071 if (queues == BIT(rtwdev->hw->queues) - 1 || !rtwdev->fifo.rqpn) in rtw_mac_flush_queues()
1074 prio_queues = get_priority_queues(rtwdev, queues); in rtw_mac_flush_queues()
1076 rtw_mac_flush_prio_queues(rtwdev, prio_queues, drop); in rtw_mac_flush_queues()
1079 static int txdma_queue_mapping(struct rtw_dev *rtwdev) in txdma_queue_mapping() argument
1081 const struct rtw_chip_info *chip = rtwdev->chip; in txdma_queue_mapping()
1085 switch (rtw_hci_type(rtwdev)) { in txdma_queue_mapping()
1090 if (rtwdev->hci.bulkout_num == 2) in txdma_queue_mapping()
1092 else if (rtwdev->hci.bulkout_num == 3) in txdma_queue_mapping()
1094 else if (rtwdev->hci.bulkout_num == 4) in txdma_queue_mapping()
1106 rtwdev->fifo.rqpn = rqpn; in txdma_queue_mapping()
1113 rtw_write16(rtwdev, REG_TXDMA_PQ_MAP, txdma_pq_map); in txdma_queue_mapping()
1115 rtw_write8(rtwdev, REG_CR, 0); in txdma_queue_mapping()
1116 rtw_write8(rtwdev, REG_CR, MAC_TRX_ENABLE); in txdma_queue_mapping()
1117 if (rtw_chip_wcpu_11ac(rtwdev)) in txdma_queue_mapping()
1118 rtw_write32(rtwdev, REG_H2CQ_CSR, BIT_H2CQ_FULL); in txdma_queue_mapping()
1120 if (rtw_hci_type(rtwdev) == RTW_HCI_TYPE_SDIO) { in txdma_queue_mapping()
1121 rtw_read32(rtwdev, REG_SDIO_FREE_TXPG); in txdma_queue_mapping()
1122 rtw_write32(rtwdev, REG_SDIO_TX_CTRL, 0); in txdma_queue_mapping()
1123 } else if (rtw_hci_type(rtwdev) == RTW_HCI_TYPE_USB) { in txdma_queue_mapping()
1124 rtw_write8_set(rtwdev, REG_TXDMA_PQ_MAP, BIT_RXDMA_ARBBW_EN); in txdma_queue_mapping()
1130 static int set_trx_fifo_info(struct rtw_dev *rtwdev) in set_trx_fifo_info() argument
1132 const struct rtw_chip_info *chip = rtwdev->chip; in set_trx_fifo_info()
1133 struct rtw_fifo_conf *fifo = &rtwdev->fifo; in set_trx_fifo_info()
1140 if (rtw_chip_wcpu_11n(rtwdev)) in set_trx_fifo_info()
1158 if (rtw_chip_wcpu_11ac(rtwdev)) { in set_trx_fifo_info()
1176 rtw_err(rtwdev, "wrong rsvd driver address\n"); in set_trx_fifo_info()
1183 static int __priority_queue_cfg(struct rtw_dev *rtwdev, in __priority_queue_cfg() argument
1187 const struct rtw_chip_info *chip = rtwdev->chip; in __priority_queue_cfg()
1188 struct rtw_fifo_conf *fifo = &rtwdev->fifo; in __priority_queue_cfg()
1190 rtw_write16(rtwdev, REG_FIFOPAGE_INFO_1, pg_tbl->hq_num); in __priority_queue_cfg()
1191 rtw_write16(rtwdev, REG_FIFOPAGE_INFO_2, pg_tbl->lq_num); in __priority_queue_cfg()
1192 rtw_write16(rtwdev, REG_FIFOPAGE_INFO_3, pg_tbl->nq_num); in __priority_queue_cfg()
1193 rtw_write16(rtwdev, REG_FIFOPAGE_INFO_4, pg_tbl->exq_num); in __priority_queue_cfg()
1194 rtw_write16(rtwdev, REG_FIFOPAGE_INFO_5, pubq_num); in __priority_queue_cfg()
1195 rtw_write32_set(rtwdev, REG_RQPN_CTRL_2, BIT_LD_RQPN); in __priority_queue_cfg()
1197 rtw_write16(rtwdev, REG_FIFOPAGE_CTRL_2, fifo->rsvd_boundary); in __priority_queue_cfg()
1198 rtw_write8_set(rtwdev, REG_FWHW_TXQ_CTRL + 2, BIT_EN_WR_FREE_TAIL >> 16); in __priority_queue_cfg()
1200 rtw_write16(rtwdev, REG_BCNQ_BDNY_V1, fifo->rsvd_boundary); in __priority_queue_cfg()
1201 rtw_write16(rtwdev, REG_FIFOPAGE_CTRL_2 + 2, fifo->rsvd_boundary); in __priority_queue_cfg()
1202 rtw_write16(rtwdev, REG_BCNQ1_BDNY_V1, fifo->rsvd_boundary); in __priority_queue_cfg()
1203 rtw_write32(rtwdev, REG_RXFF_BNDY, chip->rxff_size - C2H_PKT_BUF - 1); in __priority_queue_cfg()
1205 if (rtwdev->hci.type == RTW_HCI_TYPE_USB) { in __priority_queue_cfg()
1206 rtw_write8_mask(rtwdev, REG_AUTO_LLT_V1, BIT_MASK_BLK_DESC_NUM, in __priority_queue_cfg()
1209 rtw_write8(rtwdev, REG_AUTO_LLT_V1 + 3, chip->usb_tx_agg_desc_num); in __priority_queue_cfg()
1210 rtw_write8_set(rtwdev, REG_TXDMA_OFFSET_CHK + 1, BIT(1)); in __priority_queue_cfg()
1213 rtw_write8_set(rtwdev, REG_AUTO_LLT_V1, BIT_AUTO_INIT_LLT_V1); in __priority_queue_cfg()
1215 if (!check_hw_ready(rtwdev, REG_AUTO_LLT_V1, BIT_AUTO_INIT_LLT_V1, 0)) in __priority_queue_cfg()
1218 rtw_write8(rtwdev, REG_CR + 3, 0); in __priority_queue_cfg()
1223 static int __priority_queue_cfg_legacy(struct rtw_dev *rtwdev, in __priority_queue_cfg_legacy() argument
1227 const struct rtw_chip_info *chip = rtwdev->chip; in __priority_queue_cfg_legacy()
1228 struct rtw_fifo_conf *fifo = &rtwdev->fifo; in __priority_queue_cfg_legacy()
1232 rtw_write32(rtwdev, REG_RQPN_NPQ, val32); in __priority_queue_cfg_legacy()
1234 rtw_write32(rtwdev, REG_RQPN, val32); in __priority_queue_cfg_legacy()
1236 rtw_write8(rtwdev, REG_TRXFF_BNDY, fifo->rsvd_boundary); in __priority_queue_cfg_legacy()
1237 rtw_write16(rtwdev, REG_TRXFF_BNDY + 2, chip->rxff_size - REPORT_BUF - 1); in __priority_queue_cfg_legacy()
1238 rtw_write8(rtwdev, REG_DWBCN0_CTRL + 1, fifo->rsvd_boundary); in __priority_queue_cfg_legacy()
1239 rtw_write8(rtwdev, REG_BCNQ_BDNY, fifo->rsvd_boundary); in __priority_queue_cfg_legacy()
1240 rtw_write8(rtwdev, REG_MGQ_BDNY, fifo->rsvd_boundary); in __priority_queue_cfg_legacy()
1241 rtw_write8(rtwdev, REG_WMAC_LBK_BF_HD, fifo->rsvd_boundary); in __priority_queue_cfg_legacy()
1243 rtw_write32_set(rtwdev, REG_AUTO_LLT, BIT_AUTO_INIT_LLT); in __priority_queue_cfg_legacy()
1245 if (!check_hw_ready(rtwdev, REG_AUTO_LLT, BIT_AUTO_INIT_LLT, 0)) in __priority_queue_cfg_legacy()
1251 static int priority_queue_cfg(struct rtw_dev *rtwdev) in priority_queue_cfg() argument
1253 const struct rtw_chip_info *chip = rtwdev->chip; in priority_queue_cfg()
1254 struct rtw_fifo_conf *fifo = &rtwdev->fifo; in priority_queue_cfg()
1259 ret = set_trx_fifo_info(rtwdev); in priority_queue_cfg()
1263 switch (rtw_hci_type(rtwdev)) { in priority_queue_cfg()
1268 if (rtwdev->hci.bulkout_num == 2) in priority_queue_cfg()
1270 else if (rtwdev->hci.bulkout_num == 3) in priority_queue_cfg()
1272 else if (rtwdev->hci.bulkout_num == 4) in priority_queue_cfg()
1286 if (rtw_chip_wcpu_11n(rtwdev)) in priority_queue_cfg()
1287 return __priority_queue_cfg_legacy(rtwdev, pg_tbl, pubq_num); in priority_queue_cfg()
1289 return __priority_queue_cfg(rtwdev, pg_tbl, pubq_num); in priority_queue_cfg()
1292 static int init_h2c(struct rtw_dev *rtwdev) in init_h2c() argument
1294 struct rtw_fifo_conf *fifo = &rtwdev->fifo; in init_h2c()
1302 if (rtw_chip_wcpu_11n(rtwdev)) in init_h2c()
1308 value32 = rtw_read32(rtwdev, REG_H2C_HEAD); in init_h2c()
1310 rtw_write32(rtwdev, REG_H2C_HEAD, value32); in init_h2c()
1312 value32 = rtw_read32(rtwdev, REG_H2C_READ_ADDR); in init_h2c()
1314 rtw_write32(rtwdev, REG_H2C_READ_ADDR, value32); in init_h2c()
1316 value32 = rtw_read32(rtwdev, REG_H2C_TAIL); in init_h2c()
1319 rtw_write32(rtwdev, REG_H2C_TAIL, value32); in init_h2c()
1321 value8 = rtw_read8(rtwdev, REG_H2C_INFO); in init_h2c()
1323 rtw_write8(rtwdev, REG_H2C_INFO, value8); in init_h2c()
1325 value8 = rtw_read8(rtwdev, REG_H2C_INFO); in init_h2c()
1327 rtw_write8(rtwdev, REG_H2C_INFO, value8); in init_h2c()
1329 value8 = rtw_read8(rtwdev, REG_TXDMA_OFFSET_CHK + 1); in init_h2c()
1331 rtw_write8(rtwdev, REG_TXDMA_OFFSET_CHK + 1, value8); in init_h2c()
1333 wp = rtw_read32(rtwdev, REG_H2C_PKT_WRITEADDR) & 0x3FFFF; in init_h2c()
1334 rp = rtw_read32(rtwdev, REG_H2C_PKT_READADDR) & 0x3FFFF; in init_h2c()
1338 rtw_err(rtwdev, "H2C queue mismatch\n"); in init_h2c()
1345 static int rtw_init_trx_cfg(struct rtw_dev *rtwdev) in rtw_init_trx_cfg() argument
1349 ret = txdma_queue_mapping(rtwdev); in rtw_init_trx_cfg()
1353 ret = priority_queue_cfg(rtwdev); in rtw_init_trx_cfg()
1357 ret = init_h2c(rtwdev); in rtw_init_trx_cfg()
1364 static int rtw_drv_info_cfg(struct rtw_dev *rtwdev) in rtw_drv_info_cfg() argument
1368 rtw_write8(rtwdev, REG_RX_DRVINFO_SZ, PHY_STATUS_SIZE); in rtw_drv_info_cfg()
1369 if (rtw_chip_wcpu_11ac(rtwdev)) { in rtw_drv_info_cfg()
1370 value8 = rtw_read8(rtwdev, REG_TRXFF_BNDY + 1); in rtw_drv_info_cfg()
1374 rtw_write8(rtwdev, REG_TRXFF_BNDY + 1, value8); in rtw_drv_info_cfg()
1376 rtw_write32_set(rtwdev, REG_RCR, BIT_APP_PHYSTS); in rtw_drv_info_cfg()
1377 rtw_write32_clr(rtwdev, REG_WMAC_OPTION_FUNCTION + 4, BIT(8) | BIT(9)); in rtw_drv_info_cfg()
1382 int rtw_mac_init(struct rtw_dev *rtwdev) in rtw_mac_init() argument
1384 const struct rtw_chip_info *chip = rtwdev->chip; in rtw_mac_init()
1387 ret = rtw_init_trx_cfg(rtwdev); in rtw_mac_init()
1391 ret = chip->ops->mac_init(rtwdev); in rtw_mac_init()
1395 ret = rtw_drv_info_cfg(rtwdev); in rtw_mac_init()
1399 rtw_hci_interface_cfg(rtwdev); in rtw_mac_init()