1*0e3d6777SRyder Lee // SPDX-License-Identifier: ISC
21613c621SLorenzo Bianconi /*
31613c621SLorenzo Bianconi * Copyright (C) 2016 Felix Fietkau <nbd@nbd.name>
41613c621SLorenzo Bianconi * Copyright (C) 2018 Lorenzo Bianconi <lorenzo.bianconi83@gmail.com>
51613c621SLorenzo Bianconi */
61613c621SLorenzo Bianconi
71613c621SLorenzo Bianconi #include "mt76x2.h"
81613c621SLorenzo Bianconi
mt76x2_mac_stop(struct mt76x02_dev * dev,bool force)9e40803f2SLorenzo Bianconi void mt76x2_mac_stop(struct mt76x02_dev *dev, bool force)
101613c621SLorenzo Bianconi {
111613c621SLorenzo Bianconi bool stopped = false;
121613c621SLorenzo Bianconi u32 rts_cfg;
131613c621SLorenzo Bianconi int i;
141613c621SLorenzo Bianconi
154606a26cSFelix Fietkau mt76_clear(dev, MT_TXOP_CTRL_CFG, MT_TXOP_ED_CCA_EN);
164606a26cSFelix Fietkau mt76_clear(dev, MT_TXOP_HLDR_ET, MT_TXOP_HLDR_TX40M_BLK_EN);
174606a26cSFelix Fietkau
181613c621SLorenzo Bianconi mt76_wr(dev, MT_MAC_SYS_CTRL, 0);
191613c621SLorenzo Bianconi
201613c621SLorenzo Bianconi rts_cfg = mt76_rr(dev, MT_TX_RTS_CFG);
211613c621SLorenzo Bianconi mt76_wr(dev, MT_TX_RTS_CFG, rts_cfg & ~MT_TX_RTS_CFG_RETRY_LIMIT);
221613c621SLorenzo Bianconi
231613c621SLorenzo Bianconi /* Wait for MAC to become idle */
241613c621SLorenzo Bianconi for (i = 0; i < 300; i++) {
251613c621SLorenzo Bianconi if ((mt76_rr(dev, MT_MAC_STATUS) &
261613c621SLorenzo Bianconi (MT_MAC_STATUS_RX | MT_MAC_STATUS_TX)) ||
271613c621SLorenzo Bianconi mt76_rr(dev, MT_BBP(IBI, 12))) {
281613c621SLorenzo Bianconi udelay(1);
291613c621SLorenzo Bianconi continue;
301613c621SLorenzo Bianconi }
311613c621SLorenzo Bianconi
321613c621SLorenzo Bianconi stopped = true;
331613c621SLorenzo Bianconi break;
341613c621SLorenzo Bianconi }
351613c621SLorenzo Bianconi
361613c621SLorenzo Bianconi if (force && !stopped) {
371613c621SLorenzo Bianconi mt76_set(dev, MT_BBP(CORE, 4), BIT(1));
381613c621SLorenzo Bianconi mt76_clear(dev, MT_BBP(CORE, 4), BIT(1));
391613c621SLorenzo Bianconi
401613c621SLorenzo Bianconi mt76_set(dev, MT_BBP(CORE, 4), BIT(0));
411613c621SLorenzo Bianconi mt76_clear(dev, MT_BBP(CORE, 4), BIT(0));
421613c621SLorenzo Bianconi }
431613c621SLorenzo Bianconi
441613c621SLorenzo Bianconi mt76_wr(dev, MT_TX_RTS_CFG, rts_cfg);
451613c621SLorenzo Bianconi }
461613c621SLorenzo Bianconi EXPORT_SYMBOL_GPL(mt76x2_mac_stop);
47