int tx_frames_to_rb(struct sbd_ring_buffer *rb)
{
struct sk_buff_head *skb_txq = &rb->skb_q;
int tx_bytes = 0;
int ret = 0;
while (1) {
struct sk_buff *skb;
skb = skb_dequeue(skb_txq);
if (unlikely(!skb))
break;
ret = sbd_pio_tx(rb, skb);
if (unlikely(ret < 0)) {
/* Take the skb back to the skb_txq */
skb_queue_head(skb_txq, skb);
break;
}
tx_bytes += ret;
log_ipc_pkt(LNK_TX, rb->ch, skb);
trace_mif_event(skb, skb->len, FUNC);
dev_kfree_skb_any(skb);
}
return (ret < 0) ? ret : tx_bytes;
}
/**
@brief transmit an IPC message packet
@param mld the pointer to a mem_link_device instance
@param ch the channel ID
@param skb the pointer to an skb that will be transmitted
@retval "> 0" the size of the data in @b @@skb
@retval "< 0" an error code (-ENODEV, -EBUSY)
*/
static int xmit_ipc_to_rb(struct mem_link_device *mld, enum sipc_ch_id ch,
struct sk_buff *skb)
{
int ret;
struct link_device *ld = &mld->link_dev;
struct io_device *iod = skbpriv(skb)->iod;
struct modem_ctl *mc = ld->mc;
struct sbd_ring_buffer *rb = sbd_ch2rb(&mld->sbd_link_dev, ch, TX);
struct sk_buff_head *skb_txq;
unsigned long flags;
if (!rb) {
mif_err("%s: %s->%s: ERR! NO SBD RB {ch:%d}\n",
ld->name, iod->name, mc->name, ch);
return -ENODEV;
}
skb_txq = &rb->skb_q;
#ifdef CONFIG_LINK_POWER_MANAGEMENT
if (cp_online(mc) && mld->forbid_cp_sleep)
mld->forbid_cp_sleep(mld);
#endif
spin_lock_irqsave(&rb->lock, flags);
if (unlikely(skb_txq->qlen >= MAX_SKB_TXQ_DEPTH)) {
mif_err_limited("%s: %s->%s: ERR! {ch:%d} "
"skb_txq.len %d >= limit %d\n",
ld->name, iod->name, mc->name, ch,
skb_txq->qlen, MAX_SKB_TXQ_DEPTH);
ret = -EBUSY;
} else {
skb->len = min_t(int, skb->len, rb->buff_size);
ret = skb->len;
skb_queue_tail(skb_txq, skb);
start_tx_timer(mld, &mld->sbd_tx_timer);
#ifdef DEBUG_MODEM_IF
trace_mif_event(skb, skb->len, FUNC);
#endif
}
spin_unlock_irqrestore(&rb->lock, flags);
#ifdef CONFIG_LINK_POWER_MANAGEMENT
if (cp_online(mc) && mld->permit_cp_sleep)
mld->permit_cp_sleep(mld);
#endif
return ret;
}