Lines Matching refs:cf
303 static int check_optimized(struct canfd_frame *cf, int start_index) in check_optimized() argument
310 if (cf->len <= CAN_MAX_DLEN) in check_optimized()
311 return (cf->len != start_index); in check_optimized()
319 return (cf->len != padlen(start_index)); in check_optimized()
323 static int check_pad(struct isotp_sock *so, struct canfd_frame *cf, in check_pad() argument
331 return check_optimized(cf, start_index); in check_pad()
339 cf->len != padlen(cf->len)) in check_pad()
344 for (i = start_index; i < cf->len; i++) in check_pad()
345 if (cf->data[i] != content) in check_pad()
353 static int isotp_rcv_fc(struct isotp_sock *so, struct canfd_frame *cf, int ae) in isotp_rcv_fc() argument
363 if ((cf->len < ae + FC_CONTENT_SZ) || in isotp_rcv_fc()
365 check_pad(so, cf, ae + FC_CONTENT_SZ, so->opt.rxpad_content))) { in isotp_rcv_fc()
378 so->txfc.bs = cf->data[ae + 1]; in isotp_rcv_fc()
379 so->txfc.stmin = cf->data[ae + 2]; in isotp_rcv_fc()
403 switch (cf->data[ae] & 0x0F) { in isotp_rcv_fc()
434 static int isotp_rcv_sf(struct sock *sk, struct canfd_frame *cf, int pcilen, in isotp_rcv_sf() argument
443 if (!len || len > cf->len - pcilen) in isotp_rcv_sf()
447 check_pad(so, cf, pcilen + len, so->opt.rxpad_content)) { in isotp_rcv_sf()
459 memcpy(skb_put(nskb, len), &cf->data[pcilen], len); in isotp_rcv_sf()
467 static int isotp_rcv_ff(struct sock *sk, struct canfd_frame *cf, int ae) in isotp_rcv_ff() argument
478 so->rx.ll_dl = padlen(cf->len); in isotp_rcv_ff()
481 if (cf->len != so->rx.ll_dl) in isotp_rcv_ff()
485 so->rx.len = (cf->data[ae] & 0x0F) << 8; in isotp_rcv_ff()
486 so->rx.len += cf->data[ae + 1]; in isotp_rcv_ff()
493 so->rx.len = cf->data[ae + 2] << 24; in isotp_rcv_ff()
494 so->rx.len += cf->data[ae + 3] << 16; in isotp_rcv_ff()
495 so->rx.len += cf->data[ae + 4] << 8; in isotp_rcv_ff()
496 so->rx.len += cf->data[ae + 5]; in isotp_rcv_ff()
515 so->rx.buf[so->rx.idx++] = cf->data[i]; in isotp_rcv_ff()
530 static int isotp_rcv_cf(struct sock *sk, struct canfd_frame *cf, int ae, in isotp_rcv_cf() argument
552 if (cf->len > so->rx.ll_dl) in isotp_rcv_cf()
556 if (cf->len < so->rx.ll_dl) { in isotp_rcv_cf()
562 if ((cf->data[ae] & 0x0F) != so->rx.sn) { in isotp_rcv_cf()
575 for (i = ae + N_PCI_SZ; i < cf->len; i++) { in isotp_rcv_cf()
576 so->rx.buf[so->rx.idx++] = cf->data[i]; in isotp_rcv_cf()
586 check_pad(so, cf, i + 1, so->opt.rxpad_content)) { in isotp_rcv_cf()
628 struct canfd_frame *cf; in isotp_rcv() local
638 cf = (struct canfd_frame *)skb->data; in isotp_rcv()
641 if (ae && cf->data[0] != so->opt.rx_ext_address) in isotp_rcv()
644 n_pci_type = cf->data[ae] & 0xF0; in isotp_rcv()
662 isotp_rcv_fc(so, cf, ae); in isotp_rcv()
674 sf_dl = cf->data[ae] & 0x0F; in isotp_rcv()
676 if (cf->len <= CAN_MAX_DLEN) { in isotp_rcv()
677 isotp_rcv_sf(sk, cf, SF_PCI_SZ4 + ae, skb, sf_dl); in isotp_rcv()
689 isotp_rcv_sf(sk, cf, SF_PCI_SZ8 + ae, skb, in isotp_rcv()
690 cf->data[SF_PCI_SZ4 + ae]); in isotp_rcv()
697 isotp_rcv_ff(sk, cf, ae); in isotp_rcv()
702 isotp_rcv_cf(sk, cf, ae, skb); in isotp_rcv()
710 static void isotp_fill_dataframe(struct canfd_frame *cf, struct isotp_sock *so, in isotp_fill_dataframe() argument
718 cf->can_id = so->txid; in isotp_fill_dataframe()
719 cf->len = num + pcilen; in isotp_fill_dataframe()
724 cf->len = padlen(cf->len); in isotp_fill_dataframe()
725 memset(cf->data, so->opt.txpad_content, cf->len); in isotp_fill_dataframe()
726 } else if (cf->len > CAN_MAX_DLEN) { in isotp_fill_dataframe()
728 cf->len = padlen(cf->len); in isotp_fill_dataframe()
729 memset(cf->data, CAN_ISOTP_DEFAULT_PAD_CONTENT, in isotp_fill_dataframe()
730 cf->len); in isotp_fill_dataframe()
735 cf->data[pcilen + i] = so->tx.buf[so->tx.idx++]; in isotp_fill_dataframe()
738 cf->data[0] = so->opt.ext_address; in isotp_fill_dataframe()
746 struct canfd_frame *cf; in isotp_send_cframe() local
764 cf = (struct canfd_frame *)skb->data; in isotp_send_cframe()
768 isotp_fill_dataframe(cf, so, ae, 0); in isotp_send_cframe()
771 cf->data[ae] = N_PCI_CF | so->tx.sn++; in isotp_send_cframe()
775 cf->flags = so->ll.tx_flags; in isotp_send_cframe()
785 so->cfecho = *(u32 *)cf->data; in isotp_send_cframe()
798 static void isotp_create_fframe(struct canfd_frame *cf, struct isotp_sock *so, in isotp_create_fframe() argument
804 cf->can_id = so->txid; in isotp_create_fframe()
805 cf->len = so->tx.ll_dl; in isotp_create_fframe()
807 cf->data[0] = so->opt.ext_address; in isotp_create_fframe()
812 cf->data[ae] = N_PCI_FF; in isotp_create_fframe()
813 cf->data[ae + 1] = 0; in isotp_create_fframe()
814 cf->data[ae + 2] = (u8)(so->tx.len >> 24) & 0xFFU; in isotp_create_fframe()
815 cf->data[ae + 3] = (u8)(so->tx.len >> 16) & 0xFFU; in isotp_create_fframe()
816 cf->data[ae + 4] = (u8)(so->tx.len >> 8) & 0xFFU; in isotp_create_fframe()
817 cf->data[ae + 5] = (u8)so->tx.len & 0xFFU; in isotp_create_fframe()
821 cf->data[ae] = (u8)(so->tx.len >> 8) | N_PCI_FF; in isotp_create_fframe()
822 cf->data[ae + 1] = (u8)so->tx.len & 0xFFU; in isotp_create_fframe()
828 cf->data[i] = so->tx.buf[so->tx.idx++]; in isotp_create_fframe()
837 struct canfd_frame *cf = (struct canfd_frame *)skb->data; in isotp_rcv_echo() local
840 if (skb->sk != sk || so->cfecho != *(u32 *)cf->data) in isotp_rcv_echo()
924 struct canfd_frame *cf; in isotp_sendmsg() local
989 cf = (struct canfd_frame *)skb->data; in isotp_sendmsg()
1010 isotp_fill_dataframe(cf, so, ae, off); in isotp_sendmsg()
1013 cf->data[ae] = N_PCI_SF; in isotp_sendmsg()
1017 cf->data[SF_PCI_SZ4 + ae] = size; in isotp_sendmsg()
1019 cf->data[ae] |= size; in isotp_sendmsg()
1022 so->cfecho = *(u32 *)cf->data; in isotp_sendmsg()
1026 isotp_create_fframe(cf, so, ae); in isotp_sendmsg()
1039 so->cfecho = *(u32 *)cf->data; in isotp_sendmsg()
1056 cf->flags = so->ll.tx_flags; in isotp_sendmsg()