Lines Matching refs:mod
99 struct cf_mod *mod);
133 struct cf_mod mod;
154 struct cf_mod *mod) { op ; }
156 MODFUNC(mod_and_id, cf->can_id &= mod->modframe.and.can_id)
157 MODFUNC(mod_and_len, cf->len &= mod->modframe.and.len)
158 MODFUNC(mod_and_flags, cf->flags &= mod->modframe.and.flags)
159 MODFUNC(mod_and_data, *(u64 *)cf->data &= *(u64 *)mod->modframe.and.data)
160 MODFUNC(mod_or_id, cf->can_id |= mod->modframe.or.can_id)
161 MODFUNC(mod_or_len, cf->len |= mod->modframe.or.len)
162 MODFUNC(mod_or_flags, cf->flags |= mod->modframe.or.flags)
163 MODFUNC(mod_or_data, *(u64 *)cf->data |= *(u64 *)mod->modframe.or.data)
164 MODFUNC(mod_xor_id, cf->can_id ^= mod->modframe.xor.can_id)
165 MODFUNC(mod_xor_len, cf->len ^= mod->modframe.xor.len)
166 MODFUNC(mod_xor_flags, cf->flags ^= mod->modframe.xor.flags)
167 MODFUNC(mod_xor_data, *(u64 *)cf->data ^= *(u64 *)mod->modframe.xor.data)
168 MODFUNC(mod_set_id, cf->can_id = mod->modframe.set.can_id)
169 MODFUNC(mod_set_len, cf->len = mod->modframe.set.len)
170 MODFUNC(mod_set_flags, cf->flags = mod->modframe.set.flags)
171 MODFUNC(mod_set_data, *(u64 *)cf->data = *(u64 *)mod->modframe.set.data)
173 static void mod_and_fddata(struct canfd_frame *cf, struct cf_mod *mod)
178 *(u64 *)(cf->data + i) &= *(u64 *)(mod->modframe.and.data + i);
181 static void mod_or_fddata(struct canfd_frame *cf, struct cf_mod *mod)
186 *(u64 *)(cf->data + i) |= *(u64 *)(mod->modframe.or.data + i);
189 static void mod_xor_fddata(struct canfd_frame *cf, struct cf_mod *mod)
194 *(u64 *)(cf->data + i) ^= *(u64 *)(mod->modframe.xor.data + i);
197 static void mod_set_fddata(struct canfd_frame *cf, struct cf_mod *mod)
199 memcpy(cf->data, mod->modframe.set.data, CANFD_MAX_DLEN);
447 if (gwj->mod.modfunc[0])
470 while (modidx < MAX_MODFUNCTIONS && gwj->mod.modfunc[modidx])
471 (*gwj->mod.modfunc[modidx++])(cf, &gwj->mod);
487 if (gwj->mod.csumfunc.crc8)
488 (*gwj->mod.csumfunc.crc8)(cf, &gwj->mod.csum.crc8);
490 if (gwj->mod.csumfunc.xor)
491 (*gwj->mod.csumfunc.xor)(cf, &gwj->mod.csum.xor);
588 if (gwj->mod.modtype.and) {
589 memcpy(&mb.cf, &gwj->mod.modframe.and, sizeof(mb.cf));
590 mb.modtype = gwj->mod.modtype.and;
595 if (gwj->mod.modtype.or) {
596 memcpy(&mb.cf, &gwj->mod.modframe.or, sizeof(mb.cf));
597 mb.modtype = gwj->mod.modtype.or;
602 if (gwj->mod.modtype.xor) {
603 memcpy(&mb.cf, &gwj->mod.modframe.xor, sizeof(mb.cf));
604 mb.modtype = gwj->mod.modtype.xor;
609 if (gwj->mod.modtype.set) {
610 memcpy(&mb.cf, &gwj->mod.modframe.set, sizeof(mb.cf));
611 mb.modtype = gwj->mod.modtype.set;
618 if (gwj->mod.modtype.and) {
619 memcpy(&mb.cf, &gwj->mod.modframe.and, sizeof(mb.cf));
620 mb.modtype = gwj->mod.modtype.and;
625 if (gwj->mod.modtype.or) {
626 memcpy(&mb.cf, &gwj->mod.modframe.or, sizeof(mb.cf));
627 mb.modtype = gwj->mod.modtype.or;
632 if (gwj->mod.modtype.xor) {
633 memcpy(&mb.cf, &gwj->mod.modframe.xor, sizeof(mb.cf));
634 mb.modtype = gwj->mod.modtype.xor;
639 if (gwj->mod.modtype.set) {
640 memcpy(&mb.cf, &gwj->mod.modframe.set, sizeof(mb.cf));
641 mb.modtype = gwj->mod.modtype.set;
647 if (gwj->mod.uid) {
648 if (nla_put_u32(skb, CGW_MOD_UID, gwj->mod.uid) < 0)
652 if (gwj->mod.csumfunc.crc8) {
654 &gwj->mod.csum.crc8) < 0)
658 if (gwj->mod.csumfunc.xor) {
660 &gwj->mod.csum.xor) < 0)
732 static int cgw_parse_attr(struct nlmsghdr *nlh, struct cf_mod *mod,
741 memset(mod, 0, sizeof(*mod));
762 canfdframecpy(&mod->modframe.and, &mb.cf);
763 mod->modtype.and = mb.modtype;
766 mod->modfunc[modidx++] = mod_and_id;
769 mod->modfunc[modidx++] = mod_and_len;
772 mod->modfunc[modidx++] = mod_and_flags;
775 mod->modfunc[modidx++] = mod_and_fddata;
781 canfdframecpy(&mod->modframe.or, &mb.cf);
782 mod->modtype.or = mb.modtype;
785 mod->modfunc[modidx++] = mod_or_id;
788 mod->modfunc[modidx++] = mod_or_len;
791 mod->modfunc[modidx++] = mod_or_flags;
794 mod->modfunc[modidx++] = mod_or_fddata;
800 canfdframecpy(&mod->modframe.xor, &mb.cf);
801 mod->modtype.xor = mb.modtype;
804 mod->modfunc[modidx++] = mod_xor_id;
807 mod->modfunc[modidx++] = mod_xor_len;
810 mod->modfunc[modidx++] = mod_xor_flags;
813 mod->modfunc[modidx++] = mod_xor_fddata;
819 canfdframecpy(&mod->modframe.set, &mb.cf);
820 mod->modtype.set = mb.modtype;
823 mod->modfunc[modidx++] = mod_set_id;
826 mod->modfunc[modidx++] = mod_set_len;
829 mod->modfunc[modidx++] = mod_set_flags;
832 mod->modfunc[modidx++] = mod_set_fddata;
840 canframecpy(&mod->modframe.and, &mb.cf);
841 mod->modtype.and = mb.modtype;
844 mod->modfunc[modidx++] = mod_and_id;
847 mod->modfunc[modidx++] = mod_and_len;
850 mod->modfunc[modidx++] = mod_and_data;
856 canframecpy(&mod->modframe.or, &mb.cf);
857 mod->modtype.or = mb.modtype;
860 mod->modfunc[modidx++] = mod_or_id;
863 mod->modfunc[modidx++] = mod_or_len;
866 mod->modfunc[modidx++] = mod_or_data;
872 canframecpy(&mod->modframe.xor, &mb.cf);
873 mod->modtype.xor = mb.modtype;
876 mod->modfunc[modidx++] = mod_xor_id;
879 mod->modfunc[modidx++] = mod_xor_len;
882 mod->modfunc[modidx++] = mod_xor_data;
888 canframecpy(&mod->modframe.set, &mb.cf);
889 mod->modtype.set = mb.modtype;
892 mod->modfunc[modidx++] = mod_set_id;
895 mod->modfunc[modidx++] = mod_set_len;
898 mod->modfunc[modidx++] = mod_set_data;
912 nla_memcpy(&mod->csum.crc8, tb[CGW_CS_CRC8],
920 mod->csumfunc.crc8 = cgw_csum_crc8_rel;
922 mod->csumfunc.crc8 = cgw_csum_crc8_pos;
924 mod->csumfunc.crc8 = cgw_csum_crc8_neg;
935 nla_memcpy(&mod->csum.xor, tb[CGW_CS_XOR],
943 mod->csumfunc.xor = cgw_csum_xor_rel;
945 mod->csumfunc.xor = cgw_csum_xor_pos;
947 mod->csumfunc.xor = cgw_csum_xor_neg;
951 nla_memcpy(&mod->uid, tb[CGW_MOD_UID], sizeof(u32));
994 struct cf_mod mod;
1013 err = cgw_parse_attr(nlh, &mod, CGW_TYPE_CAN_CAN, &ccgw, &limhops);
1017 if (mod.uid) {
1022 if (gwj->mod.uid != mod.uid)
1031 memcpy(&gwj->mod, &mod, sizeof(mod));
1053 memcpy(&gwj->mod, &mod, sizeof(mod));
1108 struct cf_mod mod;
1127 err = cgw_parse_attr(nlh, &mod, CGW_TYPE_CAN_CAN, &ccgw, &limhops);
1150 if (gwj->mod.uid || mod.uid) {
1151 if (gwj->mod.uid != mod.uid)
1155 if (memcmp(&gwj->mod, &mod, sizeof(mod)))