mt76/mt76x2/usb_init.c

13 static void mt76x2u_init_dma(struct mt76x02_dev *dev)
15 	u32 val = mt76_rr(dev, MT_VEND_ADDR(CFG, MT_USB_U3DMA_CFG));
25 	mt76_wr(dev, MT_VEND_ADDR(CFG, MT_USB_U3DMA_CFG), val);
28 static void mt76x2u_power_on_rf_patch(struct mt76x02_dev *dev)
30 	mt76_set(dev, MT_VEND_ADDR(CFG, 0x130), BIT(0) | BIT(16));
33 	mt76_clear(dev, MT_VEND_ADDR(CFG, 0x1c), 0xff);
34 	mt76_set(dev, MT_VEND_ADDR(CFG, 0x1c), 0x30);
36 	mt76_wr(dev, MT_VEND_ADDR(CFG, 0x14), 0x484f);
39 	mt76_set(dev, MT_VEND_ADDR(CFG, 0x130), BIT(17));
42 	mt76_clear(dev, MT_VEND_ADDR(CFG, 0x130), BIT(16));
45 	mt76_set(dev, MT_VEND_ADDR(CFG, 0x14c), BIT(19) | BIT(20));
48 static void mt76x2u_power_on_rf(struct mt76x02_dev *dev, int unit)
54 	mt76_set(dev, MT_VEND_ADDR(CFG, 0x130), BIT(0) << shift);
58 	mt76_set(dev, MT_VEND_ADDR(CFG, 0x130), val);
62 	mt76_clear(dev, MT_VEND_ADDR(CFG, 0x130), BIT(2) << shift);
65 	mt76x2u_power_on_rf_patch(dev);
67 	mt76_set(dev, 0x530, 0xf);
70 static void mt76x2u_power_on(struct mt76x02_dev *dev)
75 	mt76_set(dev, MT_VEND_ADDR(CFG, 0x148),
82 	mt76_poll(dev, MT_VEND_ADDR(CFG, 0x148), val, val, 1000);
84 	mt76_clear(dev, MT_VEND_ADDR(CFG, 0x148), 0x7f << 16);
87 	mt76_clear(dev, MT_VEND_ADDR(CFG, 0x148), 0xf << 24);
90 	mt76_set(dev, MT_VEND_ADDR(CFG, 0x148), 0xf << 24);
91 	mt76_clear(dev, MT_VEND_ADDR(CFG, 0x148), 0xfff);
94 	mt76_clear(dev, MT_VEND_ADDR(CFG, 0x1204), BIT(3));
97 	mt76_set(dev, MT_VEND_ADDR(CFG, 0x80), BIT(0));
100 	mt76_clear(dev, MT_VEND_ADDR(CFG, 0x64), BIT(18));
102 	mt76x2u_power_on_rf(dev, 0);
103 	mt76x2u_power_on_rf(dev, 1);
106 static int mt76x2u_init_eeprom(struct mt76x02_dev *dev)
110 	dev->mt76.eeprom.data = devm_kzalloc(dev->mt76.dev,
113 	dev->mt76.eeprom.size = MT7612U_EEPROM_SIZE;
114 	if (!dev->mt76.eeprom.data)
118 		val = mt76_rr(dev, MT_VEND_ADDR(EEPROM, i));
119 		put_unaligned_le32(val, dev->mt76.eeprom.data + i);
122 	mt76x02_eeprom_parse_hw_cap(dev);
126 int mt76x2u_init_hardware(struct mt76x02_dev *dev)
130 	mt76x2_reset_wlan(dev, true);
131 	mt76x2u_power_on(dev);
133 	if (!mt76x02_wait_for_mac(&dev->mt76))
136 	err = mt76x2u_mcu_fw_init(dev);
140 	if (!mt76_poll_msec(dev, MT_WPDMA_GLO_CFG,
146 	if (!mt76x02_wait_for_mac(&dev->mt76))
149 	mt76x2u_init_dma(dev);
151 	err = mt76x2u_mcu_init(dev);
155 	err = mt76x2u_mac_reset(dev);
159 	mt76x02_mac_setaddr(dev, dev->mt76.eeprom.data + MT_EE_MAC_ADDR);
160 	dev->mt76.rxfilter = mt76_rr(dev, MT_RX_FILTR_CFG);
162 	if (!mt76x02_wait_for_txrx_idle(&dev->mt76))
167 		mt76x02_mac_wcid_setup(dev, i, 0, NULL);
172 			mt76x02_mac_shared_key_setup(dev, i, k, NULL);
175 	mt76x02u_init_beacon_config(dev);
177 	mt76_rmw(dev, MT_US_CYC_CFG, MT_US_CYC_CNT, 0x1e);
178 	mt76_wr(dev, MT_TXOP_CTRL_CFG, 0x583f);
180 	err = mt76x2_mcu_load_cr(dev, MT_RF_BBP_CR, 0, 0);
184 	mt76x02_phy_set_rxpath(dev);
185 	mt76x02_phy_set_txdac(dev);
187 	return mt76x2u_mac_stop(dev);
190 int mt76x2u_register_device(struct mt76x02_dev *dev)
192 	struct ieee80211_hw *hw = mt76_hw(dev);
193 	struct mt76_usb *usb = &dev->mt76.usb;
196 	INIT_DELAYED_WORK(&dev->cal_work, mt76x2u_phy_calibrate);
197 	err = mt76x02_init_device(dev);
201 	err = mt76x2u_init_eeprom(dev);
205 	usb->mcu.data = devm_kmalloc(dev->mt76.dev, MCU_RESP_URB_SIZE,
210 	err = mt76u_alloc_queues(&dev->mt76);
214 	err = mt76x2u_init_hardware(dev);
219 	hw->max_tx_fragments = dev->mt76.usb.sg_en ? MT_TX_SG_MAX_SIZE : 1;
220 	err = mt76_register_device(&dev->mt76, true, mt76x02_rates,
225 	set_bit(MT76_STATE_INITIALIZED, &dev->mphy.state);
227 	mt76x02_init_debugfs(dev);
228 	mt76x2_init_txpower(dev, &dev->mphy.sband_2g.sband);
229 	mt76x2_init_txpower(dev, &dev->mphy.sband_5g.sband);
234 	mt76x2u_cleanup(dev);
238 void mt76x2u_stop_hw(struct mt76x02_dev *dev)
240 	cancel_delayed_work_sync(&dev->cal_work);
241 	cancel_delayed_work_sync(&dev->mphy.mac_work);
242 	mt76x2u_mac_stop(dev);
245 void mt76x2u_cleanup(struct mt76x02_dev *dev)
247 	mt76x02_mcu_set_radio_state(dev, false);
248 	mt76x2u_stop_hw(dev);
249 	mt76u_queues_deinit(&dev->mt76);