Lines Matching +full:addr +full:- +full:mode
1 // SPDX-License-Identifier: GPL-2.0-only
15 ieee802154_hdr_push_addr(u8 *buf, const struct ieee802154_addr *addr, in ieee802154_hdr_push_addr() argument
20 if (addr->mode == IEEE802154_ADDR_NONE) in ieee802154_hdr_push_addr()
24 memcpy(buf + pos, &addr->pan_id, 2); in ieee802154_hdr_push_addr()
28 switch (addr->mode) { in ieee802154_hdr_push_addr()
30 memcpy(buf + pos, &addr->short_addr, 2); in ieee802154_hdr_push_addr()
35 memcpy(buf + pos, &addr->extended_addr, IEEE802154_ADDR_LEN); in ieee802154_hdr_push_addr()
40 return -EINVAL; in ieee802154_hdr_push_addr()
52 memcpy(buf + 1, &hdr->frame_counter, 4); in ieee802154_hdr_push_sechdr()
54 switch (hdr->key_id_mode) { in ieee802154_hdr_push_sechdr()
62 memcpy(buf + pos, &hdr->short_src, 4); in ieee802154_hdr_push_sechdr()
67 memcpy(buf + pos, &hdr->extended_src, IEEE802154_ADDR_LEN); in ieee802154_hdr_push_sechdr()
72 buf[pos++] = hdr->key_id; in ieee802154_hdr_push_sechdr()
83 struct ieee802154_hdr_fc *fc = &hdr->fc; in ieee802154_hdr_push()
85 buf[pos++] = hdr->seq; in ieee802154_hdr_push()
87 fc->dest_addr_mode = hdr->dest.mode; in ieee802154_hdr_push()
89 rc = ieee802154_hdr_push_addr(buf + pos, &hdr->dest, false); in ieee802154_hdr_push()
91 return -EINVAL; in ieee802154_hdr_push()
94 fc->source_addr_mode = hdr->source.mode; in ieee802154_hdr_push()
96 if (hdr->source.pan_id == hdr->dest.pan_id && in ieee802154_hdr_push()
97 hdr->dest.mode != IEEE802154_ADDR_NONE) in ieee802154_hdr_push()
98 fc->intra_pan = true; in ieee802154_hdr_push()
100 rc = ieee802154_hdr_push_addr(buf + pos, &hdr->source, fc->intra_pan); in ieee802154_hdr_push()
102 return -EINVAL; in ieee802154_hdr_push()
105 if (fc->security_enabled) { in ieee802154_hdr_push()
106 fc->version = 1; in ieee802154_hdr_push()
108 rc = ieee802154_hdr_push_sechdr(buf + pos, &hdr->sec); in ieee802154_hdr_push()
110 return -EINVAL; in ieee802154_hdr_push()
127 struct ieee802154_mac_cmd_pl *mac_pl = &frame->mac_pl; in ieee802154_mac_cmd_push()
128 struct ieee802154_hdr *mhr = &frame->mhr; in ieee802154_mac_cmd_push()
137 skb->mac_len = ret; in ieee802154_mac_cmd_push()
149 struct ieee802154_beacon_hdr *mac_pl = &beacon->mac_pl; in ieee802154_beacon_push()
150 struct ieee802154_hdr *mhr = &beacon->mhr; in ieee802154_beacon_push()
159 skb->mac_len = ret; in ieee802154_beacon_push()
163 if (mac_pl->pend_short_addr_count || mac_pl->pend_ext_addr_count) in ieee802154_beacon_push()
164 return -EOPNOTSUPP; in ieee802154_beacon_push()
171 ieee802154_hdr_get_addr(const u8 *buf, int mode, bool omit_pan, in ieee802154_hdr_get_addr() argument
172 struct ieee802154_addr *addr) in ieee802154_hdr_get_addr() argument
176 addr->mode = mode; in ieee802154_hdr_get_addr()
178 if (mode == IEEE802154_ADDR_NONE) in ieee802154_hdr_get_addr()
182 memcpy(&addr->pan_id, buf + pos, 2); in ieee802154_hdr_get_addr()
186 if (mode == IEEE802154_ADDR_SHORT) { in ieee802154_hdr_get_addr()
187 memcpy(&addr->short_addr, buf + pos, 2); in ieee802154_hdr_get_addr()
190 memcpy(&addr->extended_addr, buf + pos, IEEE802154_ADDR_LEN); in ieee802154_hdr_get_addr()
195 static int ieee802154_hdr_addr_len(int mode, bool omit_pan) in ieee802154_hdr_addr_len() argument
199 switch (mode) { in ieee802154_hdr_addr_len()
203 default: return -EINVAL; in ieee802154_hdr_addr_len()
213 memcpy(&hdr->frame_counter, buf + 1, 4); in ieee802154_hdr_get_sechdr()
215 switch (hdr->key_id_mode) { in ieee802154_hdr_get_sechdr()
223 memcpy(&hdr->short_src, buf + pos, 4); in ieee802154_hdr_get_sechdr()
228 memcpy(&hdr->extended_src, buf + pos, IEEE802154_ADDR_LEN); in ieee802154_hdr_get_sechdr()
233 hdr->key_id = buf[pos++]; in ieee802154_hdr_get_sechdr()
254 dlen = ieee802154_hdr_addr_len(hdr->fc.dest_addr_mode, false); in ieee802154_hdr_minlen()
255 slen = ieee802154_hdr_addr_len(hdr->fc.source_addr_mode, in ieee802154_hdr_minlen()
256 hdr->fc.intra_pan); in ieee802154_hdr_minlen()
259 return -EINVAL; in ieee802154_hdr_minlen()
261 return 3 + dlen + slen + hdr->fc.security_enabled; in ieee802154_hdr_minlen()
269 pos += ieee802154_hdr_get_addr(buf + pos, hdr->fc.dest_addr_mode, in ieee802154_hdr_get_addrs()
270 false, &hdr->dest); in ieee802154_hdr_get_addrs()
271 pos += ieee802154_hdr_get_addr(buf + pos, hdr->fc.source_addr_mode, in ieee802154_hdr_get_addrs()
272 hdr->fc.intra_pan, &hdr->source); in ieee802154_hdr_get_addrs()
274 if (hdr->fc.intra_pan) in ieee802154_hdr_get_addrs()
275 hdr->source.pan_id = hdr->dest.pan_id; in ieee802154_hdr_get_addrs()
286 return -EINVAL; in ieee802154_hdr_pull()
288 memcpy(hdr, skb->data, 3); in ieee802154_hdr_pull()
292 return -EINVAL; in ieee802154_hdr_pull()
294 pos += ieee802154_hdr_get_addrs(skb->data + pos, hdr); in ieee802154_hdr_pull()
296 if (hdr->fc.security_enabled) { in ieee802154_hdr_pull()
297 int want = pos + ieee802154_hdr_sechdr_len(skb->data[pos]); in ieee802154_hdr_pull()
300 return -EINVAL; in ieee802154_hdr_pull()
302 pos += ieee802154_hdr_get_sechdr(skb->data + pos, &hdr->sec); in ieee802154_hdr_pull()
314 return -EINVAL; in ieee802154_mac_cmd_pl_pull()
316 memcpy(mac_pl, skb->data, sizeof(*mac_pl)); in ieee802154_mac_cmd_pl_pull()
330 return -EINVAL; in ieee802154_hdr_peek_addrs()
336 return -EINVAL; in ieee802154_hdr_peek_addrs()
351 return -EINVAL; in ieee802154_hdr_peek()
353 if (hdr->fc.security_enabled) { in ieee802154_hdr_peek()
358 return -EINVAL; in ieee802154_hdr_peek()
360 pos += ieee802154_hdr_get_sechdr(buf + pos, &hdr->sec); in ieee802154_hdr_peek()
371 if (hdr->fc.security_enabled) { in ieee802154_max_payload()
372 hlen += ieee802154_sechdr_lengths[hdr->sec.key_id_mode] - 1; in ieee802154_max_payload()
373 hlen += ieee802154_sechdr_authtag_len(&hdr->sec); in ieee802154_max_payload()
376 return IEEE802154_MTU - hlen - IEEE802154_MFR_SIZE; in ieee802154_max_payload()