drivers/staging/rtl8192e/rtl8192e/r8192E_cmdpkt.c

   1 // SPDX-License-Identifier: GPL-2.0
   2 /*
   3  * Copyright(c) 2008 - 2010 Realtek Corporation. All rights reserved.
   4  *
   5  * Contact Information: wlanfae <wlanfae@realtek.com>
   6  */
   7 #include "rtl_core.h"
   8 #include "r8192E_hw.h"
   9 #include "r8192E_cmdpkt.h"
  10
  11 bool rtl92e_send_cmd_pkt(struct net_device *dev, u32 type, const void *data,
  12                          u32 len)
  13 {
  14         bool                            rt_status = true;
  15         struct r8192_priv *priv = rtllib_priv(dev);
  16         u16                             frag_length = 0, frag_offset = 0;
  17         struct sk_buff          *skb;
  18         unsigned char           *seg_ptr;
  19         struct cb_desc *tcb_desc;
  20         u8                              bLastIniPkt;
  21
  22         struct tx_fwinfo_8190pci *pTxFwInfo = NULL;
  23
  24         do {
  25                 if ((len - frag_offset) > CMDPACKET_FRAG_SIZE) {
  26                         frag_length = CMDPACKET_FRAG_SIZE;
  27                         bLastIniPkt = 0;
  28
  29                 } else {
  30                         frag_length = (u16)(len - frag_offset);
  31                         bLastIniPkt = 1;
  32                 }
  33
  34                 if (type == DESC_PACKET_TYPE_NORMAL)
  35                         skb = dev_alloc_skb(frag_length +
  36                                             priv->rtllib->tx_headroom + 4);
  37                 else
  38                         skb = dev_alloc_skb(frag_length + 4);
  39
  40                 if (!skb) {
  41                         rt_status = false;
  42                         goto Failed;
  43                 }
  44
  45                 memcpy((unsigned char *)(skb->cb), &dev, sizeof(dev));
  46                 tcb_desc = (struct cb_desc *)(skb->cb + MAX_DEV_ADDR_SIZE);
  47                 tcb_desc->queue_index = TXCMD_QUEUE;
  48                 tcb_desc->bCmdOrInit = type;
  49                 tcb_desc->bLastIniPkt = bLastIniPkt;
  50
  51                 if (type == DESC_PACKET_TYPE_NORMAL) {
  52                         tcb_desc->pkt_size = frag_length;
  53
  54                         seg_ptr = skb_put(skb, priv->rtllib->tx_headroom);
  55                         pTxFwInfo = (struct tx_fwinfo_8190pci *)seg_ptr;
  56                         memset(pTxFwInfo, 0, sizeof(struct tx_fwinfo_8190pci));
  57                         memset(pTxFwInfo, 0x12, 8);
  58                 } else {
  59                         tcb_desc->txbuf_size = frag_length;
  60                 }
  61
  62                 skb_put_data(skb, data, frag_length);
  63
  64                 if (type == DESC_PACKET_TYPE_INIT &&
  65                     (!priv->rtllib->check_nic_enough_desc(dev, TXCMD_QUEUE) ||
  66                      (!skb_queue_empty(&priv->rtllib->skb_waitq[TXCMD_QUEUE])) ||
  67                      (priv->rtllib->queue_stop))) {
  68                         skb_queue_tail(&priv->rtllib->skb_waitq[TXCMD_QUEUE],
  69                                        skb);
  70                 } else {
  71                         priv->rtllib->softmac_hard_start_xmit(skb, dev);
  72                 }
  73
  74                 data += frag_length;
  75                 frag_offset += frag_length;
  76
  77         } while (frag_offset < len);
  78
  79         rtl92e_writeb(dev, TP_POLL, TP_POLL_CQ);
  80 Failed:
  81         return rt_status;
  82 }