1*4882a593Smuzhiyun // SPDX-License-Identifier: ISC
2*4882a593Smuzhiyun /*
3*4882a593Smuzhiyun * Copyright (C) 2019 Lorenzo Bianconi <lorenzo.bianconi83@gmail.com>
4*4882a593Smuzhiyun */
5*4882a593Smuzhiyun
6*4882a593Smuzhiyun #include "mt76.h"
7*4882a593Smuzhiyun
8*4882a593Smuzhiyun struct sk_buff *
mt76_mcu_msg_alloc(struct mt76_dev * dev,const void * data,int data_len)9*4882a593Smuzhiyun mt76_mcu_msg_alloc(struct mt76_dev *dev, const void *data,
10*4882a593Smuzhiyun int data_len)
11*4882a593Smuzhiyun {
12*4882a593Smuzhiyun const struct mt76_mcu_ops *ops = dev->mcu_ops;
13*4882a593Smuzhiyun int length = ops->headroom + data_len + ops->tailroom;
14*4882a593Smuzhiyun struct sk_buff *skb;
15*4882a593Smuzhiyun
16*4882a593Smuzhiyun skb = alloc_skb(length, GFP_KERNEL);
17*4882a593Smuzhiyun if (!skb)
18*4882a593Smuzhiyun return NULL;
19*4882a593Smuzhiyun
20*4882a593Smuzhiyun memset(skb->head, 0, length);
21*4882a593Smuzhiyun skb_reserve(skb, ops->headroom);
22*4882a593Smuzhiyun
23*4882a593Smuzhiyun if (data && data_len)
24*4882a593Smuzhiyun skb_put_data(skb, data, data_len);
25*4882a593Smuzhiyun
26*4882a593Smuzhiyun return skb;
27*4882a593Smuzhiyun }
28*4882a593Smuzhiyun EXPORT_SYMBOL_GPL(mt76_mcu_msg_alloc);
29*4882a593Smuzhiyun
mt76_mcu_get_response(struct mt76_dev * dev,unsigned long expires)30*4882a593Smuzhiyun struct sk_buff *mt76_mcu_get_response(struct mt76_dev *dev,
31*4882a593Smuzhiyun unsigned long expires)
32*4882a593Smuzhiyun {
33*4882a593Smuzhiyun unsigned long timeout;
34*4882a593Smuzhiyun
35*4882a593Smuzhiyun if (!time_is_after_jiffies(expires))
36*4882a593Smuzhiyun return NULL;
37*4882a593Smuzhiyun
38*4882a593Smuzhiyun timeout = expires - jiffies;
39*4882a593Smuzhiyun wait_event_timeout(dev->mcu.wait,
40*4882a593Smuzhiyun (!skb_queue_empty(&dev->mcu.res_q) ||
41*4882a593Smuzhiyun test_bit(MT76_MCU_RESET, &dev->phy.state)),
42*4882a593Smuzhiyun timeout);
43*4882a593Smuzhiyun return skb_dequeue(&dev->mcu.res_q);
44*4882a593Smuzhiyun }
45*4882a593Smuzhiyun EXPORT_SYMBOL_GPL(mt76_mcu_get_response);
46*4882a593Smuzhiyun
mt76_mcu_rx_event(struct mt76_dev * dev,struct sk_buff * skb)47*4882a593Smuzhiyun void mt76_mcu_rx_event(struct mt76_dev *dev, struct sk_buff *skb)
48*4882a593Smuzhiyun {
49*4882a593Smuzhiyun skb_queue_tail(&dev->mcu.res_q, skb);
50*4882a593Smuzhiyun wake_up(&dev->mcu.wait);
51*4882a593Smuzhiyun }
52*4882a593Smuzhiyun EXPORT_SYMBOL_GPL(mt76_mcu_rx_event);
53