1 // SPDX-License-Identifier: ISC 2 /* 3 * Copyright (C) 2019 Lorenzo Bianconi <lorenzo.bianconi83@gmail.com> 4 */ 5 6 #include "mt76.h" 7 8 struct sk_buff * 9 __mt76_mcu_msg_alloc(struct mt76_dev *dev, const void *data, 10 int len, int data_len, gfp_t gfp) 11 { 12 const struct mt76_mcu_ops *ops = dev->mcu_ops; 13 struct sk_buff *skb; 14 15 len = max_t(int, len, data_len); 16 len = ops->headroom + len + ops->tailroom; 17 18 skb = alloc_skb(len, gfp); 19 if (!skb) 20 return NULL; 21 22 memset(skb->head, 0, len); 23 skb_reserve(skb, ops->headroom); 24 25 if (data && data_len) 26 skb_put_data(skb, data, data_len); 27 28 return skb; 29 } 30 EXPORT_SYMBOL_GPL(__mt76_mcu_msg_alloc); 31 32 struct sk_buff *mt76_mcu_get_response(struct mt76_dev *dev, 33 unsigned long expires) 34 { 35 unsigned long timeout; 36 37 if (!time_is_after_jiffies(expires)) 38 return NULL; 39 40 timeout = expires - jiffies; 41 wait_event_timeout(dev->mcu.wait, 42 (!skb_queue_empty(&dev->mcu.res_q) || 43 test_bit(MT76_MCU_RESET, &dev->phy.state)), 44 timeout); 45 return skb_dequeue(&dev->mcu.res_q); 46 } 47 EXPORT_SYMBOL_GPL(mt76_mcu_get_response); 48 49 void mt76_mcu_rx_event(struct mt76_dev *dev, struct sk_buff *skb) 50 { 51 skb_queue_tail(&dev->mcu.res_q, skb); 52 wake_up(&dev->mcu.wait); 53 } 54 EXPORT_SYMBOL_GPL(mt76_mcu_rx_event); 55 56 int mt76_mcu_send_and_get_msg(struct mt76_dev *dev, int cmd, const void *data, 57 int len, bool wait_resp, struct sk_buff **ret_skb) 58 { 59 struct sk_buff *skb; 60 61 if (dev->mcu_ops->mcu_send_msg) 62 return dev->mcu_ops->mcu_send_msg(dev, cmd, data, len, wait_resp); 63 64 skb = mt76_mcu_msg_alloc(dev, data, len); 65 if (!skb) 66 return -ENOMEM; 67 68 return mt76_mcu_skb_send_and_get_msg(dev, skb, cmd, wait_resp, ret_skb); 69 } 70 EXPORT_SYMBOL_GPL(mt76_mcu_send_and_get_msg); 71 72 int mt76_mcu_skb_send_and_get_msg(struct mt76_dev *dev, struct sk_buff *skb, 73 int cmd, bool wait_resp, 74 struct sk_buff **ret_skb) 75 { 76 unsigned long expires; 77 int ret, seq; 78 79 if (ret_skb) 80 *ret_skb = NULL; 81 82 mutex_lock(&dev->mcu.mutex); 83 84 ret = dev->mcu_ops->mcu_skb_send_msg(dev, skb, cmd, &seq); 85 if (ret < 0) 86 goto out; 87 88 if (!wait_resp) { 89 ret = 0; 90 goto out; 91 } 92 93 expires = jiffies + dev->mcu.timeout; 94 95 do { 96 skb = mt76_mcu_get_response(dev, expires); 97 ret = dev->mcu_ops->mcu_parse_response(dev, cmd, skb, seq); 98 if (!ret && ret_skb) 99 *ret_skb = skb; 100 else 101 dev_kfree_skb(skb); 102 } while (ret == -EAGAIN); 103 104 out: 105 mutex_unlock(&dev->mcu.mutex); 106 107 return ret; 108 } 109 EXPORT_SYMBOL_GPL(mt76_mcu_skb_send_and_get_msg); 110 111 int __mt76_mcu_send_firmware(struct mt76_dev *dev, int cmd, const void *data, 112 int len, int max_len) 113 { 114 int err, cur_len; 115 116 while (len > 0) { 117 cur_len = min_t(int, max_len, len); 118 119 err = mt76_mcu_send_msg(dev, cmd, data, cur_len, false); 120 if (err) 121 return err; 122 123 data += cur_len; 124 len -= cur_len; 125 126 if (dev->queue_ops->tx_cleanup) 127 dev->queue_ops->tx_cleanup(dev, 128 dev->q_mcu[MT_MCUQ_FWDL], 129 false); 130 } 131 132 return 0; 133 } 134 EXPORT_SYMBOL_GPL(__mt76_mcu_send_firmware); 135