drivers/staging/otus/wrap_sec.c

/*
 * Copyright (c) 2007-2008 Atheros Communications Inc.
 *
 * Permission to use, copy, modify, and/or distribute this software for any
 * purpose with or without fee is hereby granted, provided that the above
 * copyright notice and this permission notice appear in all copies.
 *
 * THE SOFTWARE IS PROVIDED "AS IS" AND THE AUTHOR DISCLAIMS ALL WARRANTIES
 * WITH REGARD TO THIS SOFTWARE INCLUDING ALL IMPLIED WARRANTIES OF
 * MERCHANTABILITY AND FITNESS. IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR
 * ANY SPECIAL, DIRECT, INDIRECT, OR CONSEQUENTIAL DAMAGES OR ANY DAMAGES
 * WHATSOEVER RESULTING FROM LOSS OF USE, DATA OR PROFITS, WHETHER IN AN
 * ACTION OF CONTRACT, NEGLIGENCE OR OTHER TORTIOUS ACTION, ARISING OUT OF
 * OR IN CONNECTION WITH THE USE OR PERFORMANCE OF THIS SOFTWARE.
 */
/*                                                                      */
/*  Module Name : wrap_sec.c                                            */
/*                                                                      */
/*  Abstract                                                            */
/*     This module contains wrapper functions for CENC.                 */
/*                                                                      */
/*  NOTES                                                               */
/*     Platform dependent.                                              */
/*                                                                      */
/************************************************************************/

#include "oal_dt.h"
#include "usbdrv.h"

#include <linux/netlink.h>

#if WIRELESS_EXT > 12
#include <net/iw_handler.h>
#endif

#ifdef ZM_ENABLE_CENC
extern int zfLnxCencSendMsg(struct sock *netlink_sk, u_int8_t *msg, int len);

u16_t zfLnxCencAsocNotify(zdev_t* dev, u16_t* macAddr, u8_t* body, u16_t bodySize, u16_t port)
{
    struct usbdrv_private *macp = (struct usbdrv_private *)dev->priv;
    struct zydas_cenc_sta_info cenc_info;
    //struct sock *netlink_sk;
    u8_t ie_len;
    int ii;

    /* Create NETLINK socket */
    //netlink_sk = netlink_kernel_create(NETLINK_USERSOCK, NULL);

    if (macp->netlink_sk == NULL)
    {
        printk(KERN_ERR "NETLINK Socket is NULL\n");
        return -1;
    }

    memset(&cenc_info, 0, sizeof(cenc_info));

    //memcpy(cenc_info.gsn, vap->iv_cencmsk_keys.wk_txiv, ZM_CENC_IV_LEN);
    zfiWlanQueryGSN(dev, cenc_info.gsn, port);
    cenc_info.datalen += ZM_CENC_IV_LEN;
    ie_len = body[1] + 2;
    memcpy(cenc_info.wie, body, ie_len);
    cenc_info.datalen += ie_len;

    memcpy(cenc_info.sta_mac, macAddr, 6);
    cenc_info.msg_type = ZM_CENC_WAI_REQUEST;
    cenc_info.datalen += 6 + 2;

    printk(KERN_ERR "===== zfwCencSendMsg, bodySize: %d =====\n", bodySize);

    for(ii = 0; ii < bodySize; ii++)
    {
        printk(KERN_ERR "%02x ", body[ii]);

        if ((ii & 0xf) == 0xf)
        {
            printk(KERN_ERR "\n");
        }
    }

    zfLnxCencSendMsg(macp->netlink_sk, (u8_t *)&cenc_info, cenc_info.datalen+4);

    /* Close NETLINK socket */
    //sock_release(netlink_sk);

    return 0;
}
#endif //ZM_ENABLE_CENC

u8_t zfwCencHandleBeaconProbrespon(zdev_t* dev, u8_t *pWIEc,
        u8_t *pPeerSSIDc, u8_t *pPeerAddrc)
{
    return 0;
}

u8_t zfwGetPktEncExemptionActionType(zdev_t* dev, zbuf_t* buf)
{
    return ZM_ENCRYPTION_EXEMPT_NO_EXEMPTION;
}

void copyToIntTxBuffer(zdev_t* dev, zbuf_t* buf, u8_t* src,
                         u16_t offset, u16_t length)
{
    u16_t i;

    for(i=0; i<length;i++)
    {
        //zmw_tx_buf_writeb(dev, buf, offset+i, src[i]);
        *(u8_t*)((u8_t*)buf->data+offset+i) = src[i];
    }
}

u16_t zfwStaAddIeWpaRsn(zdev_t* dev, zbuf_t* buf, u16_t offset, u8_t frameType)
{
    struct usbdrv_private *macp = dev->ml_priv;
    //zm_msg1_mm(ZM_LV_0, "CWY - add wpaie content Length : ", macp->supIe[1]);
    if (macp->supIe[1] != 0)
    {
        copyToIntTxBuffer(dev, buf, macp->supIe, offset, macp->supIe[1]+2);
        //memcpy(buf->data[offset], macp->supIe, macp->supIe[1]+2);
        offset += (macp->supIe[1]+2);
    }

    return offset;
}

/* Leave an empty line below to remove warning message on some compiler */