1*6c92544dSBjoern A. Zeeb // SPDX-License-Identifier: ISC
2*6c92544dSBjoern A. Zeeb /*
3*6c92544dSBjoern A. Zeeb * Copyright (C) 2016 Felix Fietkau <nbd@nbd.name>
4*6c92544dSBjoern A. Zeeb * Copyright (C) 2018 Lorenzo Bianconi <lorenzo.bianconi83@gmail.com>
5*6c92544dSBjoern A. Zeeb */
6*6c92544dSBjoern A. Zeeb
7*6c92544dSBjoern A. Zeeb #include "mt76x2.h"
8*6c92544dSBjoern A. Zeeb
mt76x2_mac_stop(struct mt76x02_dev * dev,bool force)9*6c92544dSBjoern A. Zeeb void mt76x2_mac_stop(struct mt76x02_dev *dev, bool force)
10*6c92544dSBjoern A. Zeeb {
11*6c92544dSBjoern A. Zeeb bool stopped = false;
12*6c92544dSBjoern A. Zeeb u32 rts_cfg;
13*6c92544dSBjoern A. Zeeb int i;
14*6c92544dSBjoern A. Zeeb
15*6c92544dSBjoern A. Zeeb mt76_clear(dev, MT_TXOP_CTRL_CFG, MT_TXOP_ED_CCA_EN);
16*6c92544dSBjoern A. Zeeb mt76_clear(dev, MT_TXOP_HLDR_ET, MT_TXOP_HLDR_TX40M_BLK_EN);
17*6c92544dSBjoern A. Zeeb
18*6c92544dSBjoern A. Zeeb mt76_wr(dev, MT_MAC_SYS_CTRL, 0);
19*6c92544dSBjoern A. Zeeb
20*6c92544dSBjoern A. Zeeb rts_cfg = mt76_rr(dev, MT_TX_RTS_CFG);
21*6c92544dSBjoern A. Zeeb mt76_wr(dev, MT_TX_RTS_CFG, rts_cfg & ~MT_TX_RTS_CFG_RETRY_LIMIT);
22*6c92544dSBjoern A. Zeeb
23*6c92544dSBjoern A. Zeeb /* Wait for MAC to become idle */
24*6c92544dSBjoern A. Zeeb for (i = 0; i < 300; i++) {
25*6c92544dSBjoern A. Zeeb if ((mt76_rr(dev, MT_MAC_STATUS) &
26*6c92544dSBjoern A. Zeeb (MT_MAC_STATUS_RX | MT_MAC_STATUS_TX)) ||
27*6c92544dSBjoern A. Zeeb mt76_rr(dev, MT_BBP(IBI, 12))) {
28*6c92544dSBjoern A. Zeeb udelay(1);
29*6c92544dSBjoern A. Zeeb continue;
30*6c92544dSBjoern A. Zeeb }
31*6c92544dSBjoern A. Zeeb
32*6c92544dSBjoern A. Zeeb stopped = true;
33*6c92544dSBjoern A. Zeeb break;
34*6c92544dSBjoern A. Zeeb }
35*6c92544dSBjoern A. Zeeb
36*6c92544dSBjoern A. Zeeb if (force && !stopped) {
37*6c92544dSBjoern A. Zeeb mt76_set(dev, MT_BBP(CORE, 4), BIT(1));
38*6c92544dSBjoern A. Zeeb mt76_clear(dev, MT_BBP(CORE, 4), BIT(1));
39*6c92544dSBjoern A. Zeeb
40*6c92544dSBjoern A. Zeeb mt76_set(dev, MT_BBP(CORE, 4), BIT(0));
41*6c92544dSBjoern A. Zeeb mt76_clear(dev, MT_BBP(CORE, 4), BIT(0));
42*6c92544dSBjoern A. Zeeb }
43*6c92544dSBjoern A. Zeeb
44*6c92544dSBjoern A. Zeeb mt76_wr(dev, MT_TX_RTS_CFG, rts_cfg);
45*6c92544dSBjoern A. Zeeb }
46*6c92544dSBjoern A. Zeeb EXPORT_SYMBOL_GPL(mt76x2_mac_stop);
47