mt76: mt7615: introduce mt7615_mcu_wait_response
Introduce mt7615_mcu_wait_response in order to be reused parsing mt7663u mcu messages Co-developed-by: Sean Wang <sean.wang@mediatek.com> Signed-off-by: Sean Wang <sean.wang@mediatek.com> Signed-off-by: Lorenzo Bianconi <lorenzo@kernel.org> Signed-off-by: Felix Fietkau <nbd@nbd.name>
This commit is contained in:

committed by
Felix Fietkau

parent
63f09b6b98
commit
044a43256a
@@ -144,12 +144,33 @@ mt7615_mcu_parse_response(struct mt7615_dev *dev, int cmd,
|
|||||||
return ret;
|
return ret;
|
||||||
}
|
}
|
||||||
|
|
||||||
|
int mt7615_mcu_wait_response(struct mt7615_dev *dev, int cmd, int seq)
|
||||||
|
{
|
||||||
|
unsigned long expires = jiffies + 20 * HZ;
|
||||||
|
struct sk_buff *skb;
|
||||||
|
int ret = 0;
|
||||||
|
|
||||||
|
while (true) {
|
||||||
|
skb = mt76_mcu_get_response(&dev->mt76, expires);
|
||||||
|
if (!skb) {
|
||||||
|
dev_err(dev->mt76.dev, "Message %d (seq %d) timeout\n",
|
||||||
|
cmd, seq);
|
||||||
|
return -ETIMEDOUT;
|
||||||
|
}
|
||||||
|
|
||||||
|
ret = mt7615_mcu_parse_response(dev, cmd, skb, seq);
|
||||||
|
if (ret != -EAGAIN)
|
||||||
|
break;
|
||||||
|
}
|
||||||
|
|
||||||
|
return ret;
|
||||||
|
}
|
||||||
|
|
||||||
static int
|
static int
|
||||||
mt7615_mcu_msg_send(struct mt76_dev *mdev, int cmd, const void *data,
|
mt7615_mcu_msg_send(struct mt76_dev *mdev, int cmd, const void *data,
|
||||||
int len, bool wait_resp)
|
int len, bool wait_resp)
|
||||||
{
|
{
|
||||||
struct mt7615_dev *dev = container_of(mdev, struct mt7615_dev, mt76);
|
struct mt7615_dev *dev = container_of(mdev, struct mt7615_dev, mt76);
|
||||||
unsigned long expires = jiffies + 20 * HZ;
|
|
||||||
struct sk_buff *skb;
|
struct sk_buff *skb;
|
||||||
int ret, seq;
|
int ret, seq;
|
||||||
|
|
||||||
@@ -163,19 +184,8 @@ mt7615_mcu_msg_send(struct mt76_dev *mdev, int cmd, const void *data,
|
|||||||
if (ret)
|
if (ret)
|
||||||
goto out;
|
goto out;
|
||||||
|
|
||||||
while (wait_resp) {
|
if (wait_resp)
|
||||||
skb = mt76_mcu_get_response(mdev, expires);
|
ret = mt7615_mcu_wait_response(dev, cmd, seq);
|
||||||
if (!skb) {
|
|
||||||
dev_err(mdev->dev, "Message %d (seq %d) timeout\n",
|
|
||||||
cmd, seq);
|
|
||||||
ret = -ETIMEDOUT;
|
|
||||||
break;
|
|
||||||
}
|
|
||||||
|
|
||||||
ret = mt7615_mcu_parse_response(dev, cmd, skb, seq);
|
|
||||||
if (ret != -EAGAIN)
|
|
||||||
break;
|
|
||||||
}
|
|
||||||
|
|
||||||
out:
|
out:
|
||||||
mutex_unlock(&mdev->mcu.mutex);
|
mutex_unlock(&mdev->mcu.mutex);
|
||||||
|
Reference in New Issue
Block a user