示例#1
0
static 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;
#ifdef DEBUG_MODEM_IF
		u8 *hdr;
#endif

		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;

#ifdef DEBUG_MODEM_IF
		hdr = skbpriv(skb)->lnk_hdr ? skb->data : NULL;
#ifdef DEBUG_MODEM_IF_IP_DATA
		if (sipc_ps_ch(rb->ch)) {
			u8 *ip_pkt = skb->data;
			if (hdr)
				ip_pkt += sipc5_get_hdr_len(hdr);
			print_ipv4_packet(ip_pkt, TX);
		}
#endif
#ifdef DEBUG_MODEM_IF_LINK_TX
		log_ipc_pkt(rb->ch, LINK, TX, skb, hdr);
#endif
#endif
		dev_kfree_skb_any(skb);
	}

	return (ret < 0) ? ret : tx_bytes;
}
示例#2
0
void print_sipc5_link_fmt_frame(const u8 *psrc)
{
    u8 *lf;				/* Link Frame	*/
    struct sipc5_link_hdr *lh;	/* Link Header	*/
    struct sipc_fmt_hdr *fh;	/* IPC Header	*/
    int lh_len;
    int fh_len;
    u8 *data;
    int dlen;

    lf = (u8 *)psrc;

    /* Point HDLC header and IPC header */
    lh = (struct sipc5_link_hdr *)lf;
    lh_len = (u16)sipc5_get_hdr_len((u8 *)lh);
    fh = (struct sipc_fmt_hdr *)(lf + lh_len);
    fh_len = sizeof(struct sipc_fmt_hdr);

    /* Point IPC data */
    data = lf + (lh_len + fh_len);
    dlen = lh->len - (lh_len + fh_len);

    mif_err("--------------------LINK & FMT HEADER----------------------\n");

    mif_err("LINK: cfg 0x%02X, ch %d, len %d\n", lh->cfg, lh->ch, lh->len);

    mif_err("(M)0x%02X, (S)0x%02X, (T)0x%02X, mseq:%d, aseq:%d, len:%d\n",
            fh->main_cmd, fh->sub_cmd, fh->cmd_type,
            fh->msg_seq, fh->ack_seq, fh->len);

    mif_err("-----------------------IPC FMT DATA------------------------\n");

    if (dlen > 0) {
        if (dlen > 64)
            dlen = 64;
        mif_print_data(data, dlen);
    }

    mif_err("-----------------------------------------------------------\n");
}