Lines Matching refs:cf
312 static int check_optimized(struct canfd_frame *cf, int start_index) in check_optimized() argument
319 if (cf->len <= CAN_MAX_DLEN) in check_optimized()
320 return (cf->len != start_index); in check_optimized()
328 return (cf->len != padlen(start_index)); in check_optimized()
332 static int check_pad(struct isotp_sock *so, struct canfd_frame *cf, in check_pad() argument
340 return check_optimized(cf, start_index); in check_pad()
348 cf->len != padlen(cf->len)) in check_pad()
353 for (i = start_index; i < cf->len; i++) in check_pad()
354 if (cf->data[i] != content) in check_pad()
362 static int isotp_rcv_fc(struct isotp_sock *so, struct canfd_frame *cf, int ae) in isotp_rcv_fc() argument
372 if ((cf->len < ae + FC_CONTENT_SZ) || in isotp_rcv_fc()
374 check_pad(so, cf, ae + FC_CONTENT_SZ, so->opt.rxpad_content))) { in isotp_rcv_fc()
388 so->txfc.bs = cf->data[ae + 1]; in isotp_rcv_fc()
389 so->txfc.stmin = cf->data[ae + 2]; in isotp_rcv_fc()
413 switch (cf->data[ae] & 0x0F) { in isotp_rcv_fc()
444 static int isotp_rcv_sf(struct sock *sk, struct canfd_frame *cf, int pcilen, in isotp_rcv_sf() argument
453 if (!len || len > cf->len - pcilen) in isotp_rcv_sf()
457 check_pad(so, cf, pcilen + len, so->opt.rxpad_content)) { in isotp_rcv_sf()
469 memcpy(skb_put(nskb, len), &cf->data[pcilen], len); in isotp_rcv_sf()
477 static int isotp_rcv_ff(struct sock *sk, struct canfd_frame *cf, int ae) in isotp_rcv_ff() argument
488 so->rx.ll_dl = padlen(cf->len); in isotp_rcv_ff()
491 if (cf->len != so->rx.ll_dl) in isotp_rcv_ff()
495 so->rx.len = (cf->data[ae] & 0x0F) << 8; in isotp_rcv_ff()
496 so->rx.len += cf->data[ae + 1]; in isotp_rcv_ff()
503 so->rx.len = cf->data[ae + 2] << 24; in isotp_rcv_ff()
504 so->rx.len += cf->data[ae + 3] << 16; in isotp_rcv_ff()
505 so->rx.len += cf->data[ae + 4] << 8; in isotp_rcv_ff()
506 so->rx.len += cf->data[ae + 5]; in isotp_rcv_ff()
535 so->rx.buf[so->rx.idx++] = cf->data[i]; in isotp_rcv_ff()
550 static int isotp_rcv_cf(struct sock *sk, struct canfd_frame *cf, int ae, in isotp_rcv_cf() argument
572 if (cf->len > so->rx.ll_dl) in isotp_rcv_cf()
576 if (cf->len < so->rx.ll_dl) { in isotp_rcv_cf()
582 if ((cf->data[ae] & 0x0F) != so->rx.sn) { in isotp_rcv_cf()
595 for (i = ae + N_PCI_SZ; i < cf->len; i++) { in isotp_rcv_cf()
596 so->rx.buf[so->rx.idx++] = cf->data[i]; in isotp_rcv_cf()
606 check_pad(so, cf, i + 1, so->opt.rxpad_content)) { in isotp_rcv_cf()
648 struct canfd_frame *cf; in isotp_rcv() local
658 cf = (struct canfd_frame *)skb->data; in isotp_rcv()
661 if (ae && cf->data[0] != so->opt.rx_ext_address) in isotp_rcv()
664 n_pci_type = cf->data[ae] & 0xF0; in isotp_rcv()
682 isotp_rcv_fc(so, cf, ae); in isotp_rcv()
694 sf_dl = cf->data[ae] & 0x0F; in isotp_rcv()
696 if (cf->len <= CAN_MAX_DLEN) { in isotp_rcv()
697 isotp_rcv_sf(sk, cf, SF_PCI_SZ4 + ae, skb, sf_dl); in isotp_rcv()
709 isotp_rcv_sf(sk, cf, SF_PCI_SZ8 + ae, skb, in isotp_rcv()
710 cf->data[SF_PCI_SZ4 + ae]); in isotp_rcv()
717 isotp_rcv_ff(sk, cf, ae); in isotp_rcv()
722 isotp_rcv_cf(sk, cf, ae, skb); in isotp_rcv()
730 static void isotp_fill_dataframe(struct canfd_frame *cf, struct isotp_sock *so, in isotp_fill_dataframe() argument
738 cf->can_id = so->txid; in isotp_fill_dataframe()
739 cf->len = num + pcilen; in isotp_fill_dataframe()
744 cf->len = padlen(cf->len); in isotp_fill_dataframe()
745 memset(cf->data, so->opt.txpad_content, cf->len); in isotp_fill_dataframe()
746 } else if (cf->len > CAN_MAX_DLEN) { in isotp_fill_dataframe()
748 cf->len = padlen(cf->len); in isotp_fill_dataframe()
749 memset(cf->data, CAN_ISOTP_DEFAULT_PAD_CONTENT, in isotp_fill_dataframe()
750 cf->len); in isotp_fill_dataframe()
755 cf->data[pcilen + i] = so->tx.buf[so->tx.idx++]; in isotp_fill_dataframe()
758 cf->data[0] = so->opt.ext_address; in isotp_fill_dataframe()
766 struct canfd_frame *cf; in isotp_send_cframe() local
784 cf = (struct canfd_frame *)skb->data; in isotp_send_cframe()
788 isotp_fill_dataframe(cf, so, ae, 0); in isotp_send_cframe()
791 cf->data[ae] = N_PCI_CF | so->tx.sn++; in isotp_send_cframe()
795 cf->flags = so->ll.tx_flags; in isotp_send_cframe()
805 so->cfecho = *(u32 *)cf->data; in isotp_send_cframe()
818 static void isotp_create_fframe(struct canfd_frame *cf, struct isotp_sock *so, in isotp_create_fframe() argument
824 cf->can_id = so->txid; in isotp_create_fframe()
825 cf->len = so->tx.ll_dl; in isotp_create_fframe()
827 cf->data[0] = so->opt.ext_address; in isotp_create_fframe()
832 cf->data[ae] = N_PCI_FF; in isotp_create_fframe()
833 cf->data[ae + 1] = 0; in isotp_create_fframe()
834 cf->data[ae + 2] = (u8)(so->tx.len >> 24) & 0xFFU; in isotp_create_fframe()
835 cf->data[ae + 3] = (u8)(so->tx.len >> 16) & 0xFFU; in isotp_create_fframe()
836 cf->data[ae + 4] = (u8)(so->tx.len >> 8) & 0xFFU; in isotp_create_fframe()
837 cf->data[ae + 5] = (u8)so->tx.len & 0xFFU; in isotp_create_fframe()
841 cf->data[ae] = (u8)(so->tx.len >> 8) | N_PCI_FF; in isotp_create_fframe()
842 cf->data[ae + 1] = (u8)so->tx.len & 0xFFU; in isotp_create_fframe()
848 cf->data[i] = so->tx.buf[so->tx.idx++]; in isotp_create_fframe()
857 struct canfd_frame *cf = (struct canfd_frame *)skb->data; in isotp_rcv_echo() local
860 if (skb->sk != sk || so->cfecho != *(u32 *)cf->data) in isotp_rcv_echo()
943 struct canfd_frame *cf; in isotp_sendmsg() local
1016 cf = (struct canfd_frame *)skb->data; in isotp_sendmsg()
1037 isotp_fill_dataframe(cf, so, ae, off); in isotp_sendmsg()
1040 cf->data[ae] = N_PCI_SF; in isotp_sendmsg()
1044 cf->data[SF_PCI_SZ4 + ae] = size; in isotp_sendmsg()
1046 cf->data[ae] |= size; in isotp_sendmsg()
1049 so->cfecho = *(u32 *)cf->data; in isotp_sendmsg()
1053 isotp_create_fframe(cf, so, ae); in isotp_sendmsg()
1066 so->cfecho = *(u32 *)cf->data; in isotp_sendmsg()
1083 cf->flags = so->ll.tx_flags; in isotp_sendmsg()