1 // SPDX-License-Identifier: GPL-2.0 OR BSD-3-Clause
2 /* Copyright(c) 2018-2019  Realtek Corporation
94 			return -ETIMEDOUT;  in rtw_mac_pre_system_cfg()
107 		return -EINVAL;  in rtw_mac_pre_system_cfg()
156 	if (cmd->base == RTW_PWR_ADDR_SDIO)  in rtw_pwr_cmd_polling()
157 		offset = cmd->offset | SDIO_LOCAL_OFFSET;  in rtw_pwr_cmd_polling()
159 		offset = cmd->offset;  in rtw_pwr_cmd_polling()
161 	if (do_pwr_poll_cmd(rtwdev, offset, cmd->mask, cmd->value))  in rtw_pwr_cmd_polling()
169 	if (rtwdev->chip->id == RTW_CHIP_TYPE_8723D)  in rtw_pwr_cmd_polling()
173 	if (rtwdev->chip->id == RTW_CHIP_TYPE_8723D)  in rtw_pwr_cmd_polling()
176 	if (do_pwr_poll_cmd(rtwdev, offset, cmd->mask, cmd->value))  in rtw_pwr_cmd_polling()
181 		offset, cmd->mask, cmd->value);  in rtw_pwr_cmd_polling()
182 	return -EBUSY;  in rtw_pwr_cmd_polling()
193 	for (cur_cmd = cmd; cur_cmd->cmd != RTW_PWR_CMD_END; cur_cmd++) {  in rtw_sub_pwr_seq_parser()
194 		if (!(cur_cmd->intf_mask & intf_mask) ||  in rtw_sub_pwr_seq_parser()
195 		    !(cur_cmd->cut_mask & cut_mask))  in rtw_sub_pwr_seq_parser()
198 		switch (cur_cmd->cmd) {  in rtw_sub_pwr_seq_parser()
200 			offset = cur_cmd->offset;  in rtw_sub_pwr_seq_parser()
202 			if (cur_cmd->base == RTW_PWR_ADDR_SDIO)  in rtw_sub_pwr_seq_parser()
206 			value &= ~cur_cmd->mask;  in rtw_sub_pwr_seq_parser()
207 			value |= (cur_cmd->value & cur_cmd->mask);  in rtw_sub_pwr_seq_parser()
212 				return -EBUSY;  in rtw_sub_pwr_seq_parser()
215 			if (cur_cmd->value == RTW_PWR_DELAY_US)  in rtw_sub_pwr_seq_parser()
216 				udelay(cur_cmd->offset);  in rtw_sub_pwr_seq_parser()
218 				mdelay(cur_cmd->offset);  in rtw_sub_pwr_seq_parser()
223 			return -EINVAL;  in rtw_sub_pwr_seq_parser()
240 	cut = rtwdev->hal.cut_version;  in rtw_pwr_seq_parser()
253 		return -EINVAL;  in rtw_pwr_seq_parser()
274 	const struct rtw_chip_info *chip = rtwdev->chip;  in rtw_mac_power_switch()  local
282 		rpwm = rtw_read8(rtwdev, rtwdev->hci.rpwm_addr);  in rtw_mac_power_switch()
287 			rtw_write8(rtwdev, rtwdev->hci.rpwm_addr, rpwm);  in rtw_mac_power_switch()
294 		 chip->id != RTW_CHIP_TYPE_8814A &&  in rtw_mac_power_switch()
301 		return -EALREADY;  in rtw_mac_power_switch()
309 		clear_bit(RTW_FLAG_POWERON, rtwdev->flags);  in rtw_mac_power_switch()
311 	pwr_seq = pwr_on ? chip->pwr_on_seq : chip->pwr_off_seq;  in rtw_mac_power_switch()
315 		if (chip->id == RTW_CHIP_TYPE_8822C ||  in rtw_mac_power_switch()
316 		    chip->id == RTW_CHIP_TYPE_8822B ||  in rtw_mac_power_switch()
317 		    chip->id == RTW_CHIP_TYPE_8821C)  in rtw_mac_power_switch()
325 		set_bit(RTW_FLAG_POWERON, rtwdev->flags);  in rtw_mac_power_switch()
332 	u8 sys_func_en = rtwdev->chip->sys_func_en;  in __rtw_mac_init_system_cfg()
344 	/* disable boot-from-flash for driver's DL FW */  in __rtw_mac_init_system_cfg()
387 	if (ret == -EALREADY) {  in rtw_mac_power_on()
425 	dmem_size = le32_to_cpu(fw_hdr->dmem_size);  in check_firmware_size()
426 	imem_size = le32_to_cpu(fw_hdr->imem_size);  in check_firmware_size()
427 	emem_size = (fw_hdr->mem_usage & BIT(4)) ?  in check_firmware_size()
428 		    le32_to_cpu(fw_hdr->emem_size) : 0;  in check_firmware_size()
496 	rtw_write32(rtwdev, REG_RQPN_CTRL_2, bckp[bckp_idx - 1].val);  in download_firmware_reg_backup()
538 		return -ENOMEM;  in send_firmware_pkt_rsvd_page()
551 	    !((size + TX_DESC_SIZE) & (512 - 1)))  in send_firmware_pkt()
569 		return -EBUSY;  in iddma_enable()
580 		return -EBUSY;  in iddma_download_firmware()
587 		return -EBUSY;  in iddma_download_firmware()
598 		return -EBUSY;  in rtw_ddma_to_fw_fifo()
605 		return -EBUSY;  in rtw_ddma_to_fw_fifo()
649 	const struct rtw_chip_info *chip = rtwdev->chip;  in download_firmware_to_mem()  local
650 	u32 desc_size = chip->tx_pkt_desc_sz;  in download_firmware_to_mem()
687 		residue_size -= pkt_size;  in download_firmware_to_mem()
691 		return -EINVAL;  in download_firmware_to_mem()
708 	dmem_size = le32_to_cpu(fw_hdr->dmem_size);  in start_download_firmware()
709 	imem_size = le32_to_cpu(fw_hdr->imem_size);  in start_download_firmware()
710 	emem_size = (fw_hdr->mem_usage & BIT(4)) ?  in start_download_firmware()
711 		    le32_to_cpu(fw_hdr->emem_size) : 0;  in start_download_firmware()
721 	addr = le32_to_cpu(fw_hdr->dmem_addr);  in start_download_firmware()
728 	addr = le32_to_cpu(fw_hdr->imem_addr);  in start_download_firmware()
736 		addr = le32_to_cpu(fw_hdr->emem_addr);  in start_download_firmware()
755 		return -EINVAL;  in download_firmware_validate()
780 	const u8 *data = fw->firmware->data;  in __rtw_download_firmware()
781 	u32 size = fw->firmware->size;  in __rtw_download_firmware()
786 		return -EINVAL;  in __rtw_download_firmware()
788 	if (rtwdev->chip->ltecoex_addr &&  in __rtw_download_firmware()
790 		return -EBUSY;  in __rtw_download_firmware()
807 	if (rtwdev->chip->ltecoex_addr &&  in __rtw_download_firmware()
809 		ret = -EBUSY;  in __rtw_download_firmware()
820 	rtwdev->h2c.last_box_num = 0;  in __rtw_download_firmware()
821 	rtwdev->h2c.seq = 0;  in __rtw_download_firmware()
823 	set_bit(RTW_FLAG_FW_RUNNING, rtwdev->flags);  in __rtw_download_firmware()
871 	remain_size = size & (DLFW_BLK_SIZE_LEGACY - 1);  in rtw_write_firmware_page()
900 	size -= sizeof(struct rtw_fw_hdr_legacy);  in download_firmware_legacy()
903 	last_page_size = size & (DLFW_PAGE_SIZE_LEGACY - 1);  in download_firmware_legacy()
918 		return -EINVAL;  in download_firmware_legacy()
945 	return -EINVAL;  in download_firmware_validate_legacy()
954 	if (rtwdev->chip->id == RTW_CHIP_TYPE_8703B &&  in __rtw_download_firmware_legacy()
960 	ret = download_firmware_legacy(rtwdev, fw->firmware->data, fw->firmware->size);  in __rtw_download_firmware_legacy()
972 	rtwdev->h2c.last_box_num = 0;  in __rtw_download_firmware_legacy()
973 	rtwdev->h2c.seq = 0;  in __rtw_download_firmware_legacy()
975 	set_bit(RTW_FLAG_FW_RUNNING, rtwdev->flags);  in __rtw_download_firmware_legacy()
999 	    rtwdev->chip->id == RTW_CHIP_TYPE_8821C)  in rtw_download_firmware()
1008 	const struct rtw_rqpn *rqpn = rtwdev->fifo.rqpn;  in get_priority_queues()
1012 		prio_queues |= BIT(rqpn->dma_map_vo);  in get_priority_queues()
1014 		prio_queues |= BIT(rqpn->dma_map_vi);  in get_priority_queues()
1016 		prio_queues |= BIT(rqpn->dma_map_be);  in get_priority_queues()
1018 		prio_queues |= BIT(rqpn->dma_map_bk);  in get_priority_queues()
1026 	const struct rtw_chip_info *chip = rtwdev->chip;  in __rtw_mac_flush_prio_queue()  local
1035 	addr = &chip->prioq_addrs->prio[prio_queue];  in __rtw_mac_flush_prio_queue()
1036 	wsize = chip->prioq_addrs->wsize;  in __rtw_mac_flush_prio_queue()
1040 		rsvd_page = wsize ? rtw_read16(rtwdev, addr->rsvd) :  in __rtw_mac_flush_prio_queue()
1041 				     rtw_read8(rtwdev, addr->rsvd);  in __rtw_mac_flush_prio_queue()
1042 		avail_page = wsize ? rtw_read16(rtwdev, addr->avail) :  in __rtw_mac_flush_prio_queue()
1043 				      rtw_read8(rtwdev, addr->avail);  in __rtw_mac_flush_prio_queue()
1079 	if (queues == BIT(rtwdev->hw->queues) - 1 || !rtwdev->fifo.rqpn)  in rtw_mac_flush_queues()
1080 		prio_queues = BIT(RTW_DMA_MAPPING_MAX) - 1;  in rtw_mac_flush_queues()
1089 	const struct rtw_chip_info *chip = rtwdev->chip;  in txdma_queue_mapping()  local
1095 		rqpn = &chip->rqpn_table[1];  in txdma_queue_mapping()
1098 		if (rtwdev->hci.bulkout_num == 2)  in txdma_queue_mapping()
1099 			rqpn = &chip->rqpn_table[2];  in txdma_queue_mapping()
1100 		else if (rtwdev->hci.bulkout_num == 3)  in txdma_queue_mapping()
1101 			rqpn = &chip->rqpn_table[3];  in txdma_queue_mapping()
1102 		else if (rtwdev->hci.bulkout_num == 4)  in txdma_queue_mapping()
1103 			rqpn = &chip->rqpn_table[4];  in txdma_queue_mapping()
1105 			return -EINVAL;  in txdma_queue_mapping()
1108 		rqpn = &chip->rqpn_table[0];  in txdma_queue_mapping()
1111 		return -EINVAL;  in txdma_queue_mapping()
1114 	rtwdev->fifo.rqpn = rqpn;  in txdma_queue_mapping()
1115 	txdma_pq_map |= BIT_TXDMA_HIQ_MAP(rqpn->dma_map_hi);  in txdma_queue_mapping()
1116 	txdma_pq_map |= BIT_TXDMA_MGQ_MAP(rqpn->dma_map_mg);  in txdma_queue_mapping()
1117 	txdma_pq_map |= BIT_TXDMA_BKQ_MAP(rqpn->dma_map_bk);  in txdma_queue_mapping()
1118 	txdma_pq_map |= BIT_TXDMA_BEQ_MAP(rqpn->dma_map_be);  in txdma_queue_mapping()
1119 	txdma_pq_map |= BIT_TXDMA_VIQ_MAP(rqpn->dma_map_vi);  in txdma_queue_mapping()
1120 	txdma_pq_map |= BIT_TXDMA_VOQ_MAP(rqpn->dma_map_vo);  in txdma_queue_mapping()
1140 	const struct rtw_chip_info *chip = rtwdev->chip;  in rtw_set_trx_fifo_info()  local
1141 	struct rtw_fifo_conf *fifo = &rtwdev->fifo;  in rtw_set_trx_fifo_info()
1143 	u8 csi_buf_pg_num = chip->csi_buf_pg_num;  in rtw_set_trx_fifo_info()
1146 	fifo->rsvd_drv_pg_num = chip->rsvd_drv_pg_num;  in rtw_set_trx_fifo_info()
1147 	fifo->txff_pg_num = chip->txff_size / chip->page_size;  in rtw_set_trx_fifo_info()
1149 		fifo->rsvd_pg_num = fifo->rsvd_drv_pg_num;  in rtw_set_trx_fifo_info()
1151 		fifo->rsvd_pg_num = fifo->rsvd_drv_pg_num +  in rtw_set_trx_fifo_info()
1159 	if (fifo->rsvd_pg_num > fifo->txff_pg_num)  in rtw_set_trx_fifo_info()
1160 		return -ENOMEM;  in rtw_set_trx_fifo_info()
1162 	fifo->acq_pg_num = fifo->txff_pg_num - fifo->rsvd_pg_num;  in rtw_set_trx_fifo_info()
1163 	fifo->rsvd_boundary = fifo->txff_pg_num - fifo->rsvd_pg_num;  in rtw_set_trx_fifo_info()
1165 	cur_pg_addr = fifo->txff_pg_num;  in rtw_set_trx_fifo_info()
1167 		cur_pg_addr -= csi_buf_pg_num;  in rtw_set_trx_fifo_info()
1168 		fifo->rsvd_csibuf_addr = cur_pg_addr;  in rtw_set_trx_fifo_info()
1169 		cur_pg_addr -= RSVD_PG_FW_TXBUF_NUM;  in rtw_set_trx_fifo_info()
1170 		fifo->rsvd_fw_txbuf_addr = cur_pg_addr;  in rtw_set_trx_fifo_info()
1171 		cur_pg_addr -= RSVD_PG_CPU_INSTRUCTION_NUM;  in rtw_set_trx_fifo_info()
1172 		fifo->rsvd_cpu_instr_addr = cur_pg_addr;  in rtw_set_trx_fifo_info()
1173 		cur_pg_addr -= RSVD_PG_H2CQ_NUM;  in rtw_set_trx_fifo_info()
1174 		fifo->rsvd_h2cq_addr = cur_pg_addr;  in rtw_set_trx_fifo_info()
1175 		cur_pg_addr -= RSVD_PG_H2C_STATICINFO_NUM;  in rtw_set_trx_fifo_info()
1176 		fifo->rsvd_h2c_sta_info_addr = cur_pg_addr;  in rtw_set_trx_fifo_info()
1177 		cur_pg_addr -= RSVD_PG_H2C_EXTRAINFO_NUM;  in rtw_set_trx_fifo_info()
1178 		fifo->rsvd_h2c_info_addr = cur_pg_addr;  in rtw_set_trx_fifo_info()
1180 	cur_pg_addr -= fifo->rsvd_drv_pg_num;  in rtw_set_trx_fifo_info()
1181 	fifo->rsvd_drv_addr = cur_pg_addr;  in rtw_set_trx_fifo_info()
1183 	if (fifo->rsvd_boundary != fifo->rsvd_drv_addr) {  in rtw_set_trx_fifo_info()
1185 		return -EINVAL;  in rtw_set_trx_fifo_info()
1196 	const struct rtw_chip_info *chip = rtwdev->chip;  in __priority_queue_cfg()  local
1197 	struct rtw_fifo_conf *fifo = &rtwdev->fifo;  in __priority_queue_cfg()
1199 	rtw_write16(rtwdev, REG_FIFOPAGE_INFO_1, pg_tbl->hq_num);  in __priority_queue_cfg()
1200 	rtw_write16(rtwdev, REG_FIFOPAGE_INFO_2, pg_tbl->lq_num);  in __priority_queue_cfg()
1201 	rtw_write16(rtwdev, REG_FIFOPAGE_INFO_3, pg_tbl->nq_num);  in __priority_queue_cfg()
1202 	rtw_write16(rtwdev, REG_FIFOPAGE_INFO_4, pg_tbl->exq_num);  in __priority_queue_cfg()
1206 	rtw_write16(rtwdev, REG_FIFOPAGE_CTRL_2, fifo->rsvd_boundary);  in __priority_queue_cfg()
1209 	rtw_write16(rtwdev, REG_BCNQ_BDNY_V1, fifo->rsvd_boundary);  in __priority_queue_cfg()
1210 	rtw_write16(rtwdev, REG_FIFOPAGE_CTRL_2 + 2, fifo->rsvd_boundary);  in __priority_queue_cfg()
1211 	rtw_write16(rtwdev, REG_BCNQ1_BDNY_V1, fifo->rsvd_boundary);  in __priority_queue_cfg()
1212 	rtw_write32(rtwdev, REG_RXFF_BNDY, chip->rxff_size - C2H_PKT_BUF - 1);  in __priority_queue_cfg()
1214 	if (rtwdev->hci.type == RTW_HCI_TYPE_USB) {  in __priority_queue_cfg()
1216 				chip->usb_tx_agg_desc_num);  in __priority_queue_cfg()
1218 		rtw_write8(rtwdev, REG_AUTO_LLT_V1 + 3, chip->usb_tx_agg_desc_num);  in __priority_queue_cfg()
1225 		return -EBUSY;  in __priority_queue_cfg()
1236 	const struct rtw_chip_info *chip = rtwdev->chip;  in __priority_queue_cfg_legacy()  local
1237 	struct rtw_fifo_conf *fifo = &rtwdev->fifo;  in __priority_queue_cfg_legacy()
1240 	val32 = BIT_RQPN_NE(pg_tbl->nq_num, pg_tbl->exq_num);  in __priority_queue_cfg_legacy()
1242 	val32 = BIT_RQPN_HLP(pg_tbl->hq_num, pg_tbl->lq_num, pubq_num);  in __priority_queue_cfg_legacy()
1245 	rtw_write8(rtwdev, REG_TRXFF_BNDY, fifo->rsvd_boundary);  in __priority_queue_cfg_legacy()
1246 	rtw_write16(rtwdev, REG_TRXFF_BNDY + 2, chip->rxff_size - REPORT_BUF - 1);  in __priority_queue_cfg_legacy()
1247 	rtw_write8(rtwdev, REG_DWBCN0_CTRL + 1, fifo->rsvd_boundary);  in __priority_queue_cfg_legacy()
1248 	rtw_write8(rtwdev, REG_BCNQ_BDNY, fifo->rsvd_boundary);  in __priority_queue_cfg_legacy()
1249 	rtw_write8(rtwdev, REG_MGQ_BDNY, fifo->rsvd_boundary);  in __priority_queue_cfg_legacy()
1250 	rtw_write8(rtwdev, REG_WMAC_LBK_BF_HD, fifo->rsvd_boundary);  in __priority_queue_cfg_legacy()
1255 		return -EBUSY;  in __priority_queue_cfg_legacy()
1262 	const struct rtw_chip_info *chip = rtwdev->chip;  in priority_queue_cfg()  local
1263 	struct rtw_fifo_conf *fifo = &rtwdev->fifo;  in priority_queue_cfg()
1274 		pg_tbl = &chip->page_table[1];  in priority_queue_cfg()
1277 		if (rtwdev->hci.bulkout_num == 2)  in priority_queue_cfg()
1278 			pg_tbl = &chip->page_table[2];  in priority_queue_cfg()
1279 		else if (rtwdev->hci.bulkout_num == 3)  in priority_queue_cfg()
1280 			pg_tbl = &chip->page_table[3];  in priority_queue_cfg()
1281 		else if (rtwdev->hci.bulkout_num == 4)  in priority_queue_cfg()
1282 			pg_tbl = &chip->page_table[4];  in priority_queue_cfg()
1284 			return -EINVAL;  in priority_queue_cfg()
1287 		pg_tbl = &chip->page_table[0];  in priority_queue_cfg()
1290 		return -EINVAL;  in priority_queue_cfg()
1293 	pubq_num = fifo->acq_pg_num - pg_tbl->hq_num - pg_tbl->lq_num -  in priority_queue_cfg()
1294 		   pg_tbl->nq_num - pg_tbl->exq_num - pg_tbl->gapq_num;  in priority_queue_cfg()
1303 	struct rtw_fifo_conf *fifo = &rtwdev->fifo;  in init_h2c()
1314 	h2cq_addr = fifo->rsvd_h2cq_addr << TX_PAGE_SIZE_SHIFT;  in init_h2c()
1344 	h2cq_free = wp >= rp ? h2cq_size - (wp - rp) : rp - wp;  in init_h2c()
1348 		return -EINVAL;  in init_h2c()
1393 	const struct rtw_chip_info *chip = rtwdev->chip;  in rtw_mac_init()  local
1400 	ret = chip->ops->mac_init(rtwdev);  in rtw_mac_init()
1415 	const struct rtw_chip_info *chip = rtwdev->chip;  in rtw_mac_postinit()  local
1417 	if (!chip->ops->mac_postinit)  in rtw_mac_postinit()
1420 	return chip->ops->mac_postinit(rtwdev);  in rtw_mac_postinit()