drivers/staging/otus/wrap_sec.c

   1 /*
   2  * Copyright (c) 2007-2008 Atheros Communications Inc.
   3  *
   4  * Permission to use, copy, modify, and/or distribute this software for any
   5  * purpose with or without fee is hereby granted, provided that the above
   6  * copyright notice and this permission notice appear in all copies.
   7  *
   8  * THE SOFTWARE IS PROVIDED "AS IS" AND THE AUTHOR DISCLAIMS ALL WARRANTIES
   9  * WITH REGARD TO THIS SOFTWARE INCLUDING ALL IMPLIED WARRANTIES OF
  10  * MERCHANTABILITY AND FITNESS. IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR
  11  * ANY SPECIAL, DIRECT, INDIRECT, OR CONSEQUENTIAL DAMAGES OR ANY DAMAGES
  12  * WHATSOEVER RESULTING FROM LOSS OF USE, DATA OR PROFITS, WHETHER IN AN
  13  * ACTION OF CONTRACT, NEGLIGENCE OR OTHER TORTIOUS ACTION, ARISING OUT OF
  14  * OR IN CONNECTION WITH THE USE OR PERFORMANCE OF THIS SOFTWARE.
  15  */
  16 /*                                                                      */
  17 /*  Module Name : wrap_sec.c                                            */
  18 /*                                                                      */
  19 /*  Abstract                                                            */
  20 /*     This module contains wrapper functions for CENC.                 */
  21 /*                                                                      */
  22 /*  NOTES                                                               */
  23 /*     Platform dependent.                                              */
  24 /*                                                                      */
  25 /************************************************************************/
  26
  27 #include "oal_dt.h"
  28 #include "usbdrv.h"
  29
  30 #include <linux/netlink.h>
  31 #include <net/iw_handler.h>
  32
  33 #ifdef ZM_ENABLE_CENC
  34 extern int zfLnxCencSendMsg(struct sock *netlink_sk, u_int8_t *msg, int len);
  35
  36 u16_t zfLnxCencAsocNotify(zdev_t* dev, u16_t* macAddr, u8_t* body, u16_t bodySize, u16_t port)
  37 {
  38     struct usbdrv_private *macp = (struct usbdrv_private *)dev->priv;
  39     struct zydas_cenc_sta_info cenc_info;
  40     //struct sock *netlink_sk;
  41     u8_t ie_len;
  42     int ii;
  43
  44     /* Create NETLINK socket */
  45     //netlink_sk = netlink_kernel_create(NETLINK_USERSOCK, NULL);
  46
  47     if (macp->netlink_sk == NULL)
  48     {
  49         printk(KERN_ERR "NETLINK Socket is NULL\n");
  50         return -1;
  51     }
  52
  53     memset(&cenc_info, 0, sizeof(cenc_info));
  54
  55     //memcpy(cenc_info.gsn, vap->iv_cencmsk_keys.wk_txiv, ZM_CENC_IV_LEN);
  56     zfiWlanQueryGSN(dev, cenc_info.gsn, port);
  57     cenc_info.datalen += ZM_CENC_IV_LEN;
  58     ie_len = body[1] + 2;
  59     memcpy(cenc_info.wie, body, ie_len);
  60     cenc_info.datalen += ie_len;
  61
  62     memcpy(cenc_info.sta_mac, macAddr, 6);
  63     cenc_info.msg_type = ZM_CENC_WAI_REQUEST;
  64     cenc_info.datalen += 6 + 2;
  65
  66     printk(KERN_ERR "===== zfwCencSendMsg, bodySize: %d =====\n", bodySize);
  67
  68     for(ii = 0; ii < bodySize; ii++)
  69     {
  70         printk(KERN_ERR "%02x ", body[ii]);
  71
  72         if ((ii & 0xf) == 0xf)
  73         {
  74             printk(KERN_ERR "\n");
  75         }
  76     }
  77
  78     zfLnxCencSendMsg(macp->netlink_sk, (u8_t *)&cenc_info, cenc_info.datalen+4);
  79
  80     /* Close NETLINK socket */
  81     //sock_release(netlink_sk);
  82
  83     return 0;
  84 }
  85 #endif //ZM_ENABLE_CENC
  86
  87 u8_t zfwCencHandleBeaconProbrespon(zdev_t* dev, u8_t *pWIEc,
  88         u8_t *pPeerSSIDc, u8_t *pPeerAddrc)
  89 {
  90     return 0;
  91 }
  92
  93 u8_t zfwGetPktEncExemptionActionType(zdev_t* dev, zbuf_t* buf)
  94 {
  95     return ZM_ENCRYPTION_EXEMPT_NO_EXEMPTION;
  96 }
  97
  98 void copyToIntTxBuffer(zdev_t* dev, zbuf_t* buf, u8_t* src,
  99                          u16_t offset, u16_t length)
 100 {
 101     u16_t i;
 102
 103     for(i=0; i<length;i++)
 104     {
 105         //zmw_tx_buf_writeb(dev, buf, offset+i, src[i]);
 106         *(u8_t*)((u8_t*)buf->data+offset+i) = src[i];
 107     }
 108 }
 109
 110 u16_t zfwStaAddIeWpaRsn(zdev_t* dev, zbuf_t* buf, u16_t offset, u8_t frameType)
 111 {
 112     struct usbdrv_private *macp = dev->ml_priv;
 113     //zm_msg1_mm(ZM_LV_0, "CWY - add wpaie content Length : ", macp->supIe[1]);
 114     if (macp->supIe[1] != 0)
 115     {
 116         copyToIntTxBuffer(dev, buf, macp->supIe, offset, macp->supIe[1]+2);
 117         //memcpy(buf->data[offset], macp->supIe, macp->supIe[1]+2);
 118         offset += (macp->supIe[1]+2);
 119     }
 120
 121     return offset;
 122 }
 123
 124 /* Leave an empty line below to remove warning message on some compiler */