linux-imx

// SPDX-License-Identifier: GPL-2.0-only

/*

 * Copyright (C) 2014 Fraunhofer ITWM

 *

 * Written by:

 * Phoebe Buckheister <phoebe.buckheister@itwm.fraunhofer.de>

 */

​

#include <linux/ieee802154.h>

​

#include <net/mac802154.h>

#include <net/ieee802154_netdev.h>

​

static int

ieee802154_hdr_push_addr(u8 *buf, const struct ieee802154_addr *addr,

             bool omit_pan)

{

    int pos = 0;

​

    if (addr->mode == IEEE802154_ADDR_NONE)

        return 0;

​

    if (!omit_pan) {

        memcpy(buf + pos, &addr->pan_id, 2);

        pos += 2;

    }

​

    switch (addr->mode) {

    case IEEE802154_ADDR_SHORT:

        memcpy(buf + pos, &addr->short_addr, 2);

        pos += 2;

        break;

​

    case IEEE802154_ADDR_LONG:

        memcpy(buf + pos, &addr->extended_addr, IEEE802154_ADDR_LEN);

        pos += IEEE802154_ADDR_LEN;

        break;

​

    default:

        return -EINVAL;

    }

​

    return pos;

}

​

static int

ieee802154_hdr_push_sechdr(u8 *buf, const struct ieee802154_sechdr *hdr)

{

    int pos = 5;

​

    memcpy(buf, hdr, 1);

    memcpy(buf + 1, &hdr->frame_counter, 4);

​

    switch (hdr->key_id_mode) {

    case IEEE802154_SCF_KEY_IMPLICIT:

        return pos;

​

    case IEEE802154_SCF_KEY_INDEX:

        break;

​

    case IEEE802154_SCF_KEY_SHORT_INDEX:

        memcpy(buf + pos, &hdr->short_src, 4);

        pos += 4;