| /* |
| * Copyright (c) 2012-2013, 2017-2018 The Linux Foundation. All rights reserved. |
| * |
| * Previously licensed under the ISC license by Qualcomm Atheros, 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. |
| */ |
| |
| /* |
| * This file was originally distributed by Qualcomm Atheros, Inc. |
| * under proprietary terms before Copyright ownership was assigned |
| * to the Linux Foundation. |
| */ |
| |
| /****************************************************************************** |
| * wlan_btc_svc.c |
| * |
| ******************************************************************************/ |
| #include <wlan_nlink_srv.h> |
| #include <wlan_btc_svc.h> |
| #include <halTypes.h> |
| #include <vos_status.h> |
| #include <btcApi.h> |
| #include <wlan_hdd_includes.h> |
| #include <vos_trace.h> |
| // Global variables |
| static struct hdd_context_s *pHddCtx; |
| |
| static int gWiFiChannel; /* WiFi associated channel 1-13, or 0 (none) */ |
| static int gAmpChannel; /* AMP associated channel 1-13, or 0 (none) */ |
| static int gBtcDriverMode = WLAN_HDD_INFRA_STATION; /* Driver mode in BTC */ |
| |
| |
| // Forward declrarion |
| static int btc_msg_callback (struct sk_buff * skb); |
| /* |
| * Send a netlink message to the user space. |
| * Destination pid as zero implies broadcast |
| */ |
| void send_btc_nlink_msg (int type, int dest_pid) |
| { |
| struct sk_buff *skb; |
| struct nlmsghdr *nlh; |
| tAniMsgHdr *aniHdr; |
| tWlanAssocData *assocData; |
| uint32_t skb_size = NLMSG_SPACE(WLAN_NL_MAX_PAYLOAD); |
| skb = alloc_skb(skb_size, GFP_KERNEL); |
| if(skb == NULL) { |
| VOS_TRACE( VOS_MODULE_ID_HDD, VOS_TRACE_LEVEL_ERROR, |
| "BTC: alloc_skb failed\n"); |
| return; |
| } |
| vos_mem_zero(skb->data, skb_size); |
| nlh = (struct nlmsghdr *)skb->data; |
| nlh->nlmsg_pid = 0; /* from kernel */ |
| nlh->nlmsg_flags = 0; |
| nlh->nlmsg_seq = 0; |
| nlh->nlmsg_type = WLAN_NL_MSG_BTC; |
| aniHdr = NLMSG_DATA(nlh); |
| aniHdr->type = type; |
| |
| /* Set BTC driver mode correctly based on received events type */ |
| if(type == WLAN_BTC_SOFTAP_BSS_START) |
| { |
| /* Event is SoftAP BSS Start set BTC driver mode to SoftAP */ |
| gBtcDriverMode = WLAN_HDD_SOFTAP; |
| } |
| if(type == WLAN_STA_ASSOC_DONE_IND) |
| { |
| /* Event is STA Assoc done set BTC driver mode to INFRA STA*/ |
| gBtcDriverMode = WLAN_HDD_INFRA_STATION; |
| } |
| |
| switch( type ) |
| { |
| case WLAN_STA_DISASSOC_DONE_IND: |
| VOS_TRACE( VOS_MODULE_ID_HDD, VOS_TRACE_LEVEL_INFO_LOW, |
| "WiFi unassociated; gAmpChannel %d gWiFiChannel %d", gAmpChannel, gWiFiChannel); |
| |
| /* If AMP is using a channel (non-zero), no message sent. |
| Or, if WiFi wasn't using a channel before, no message sent. |
| Logic presumes same channel has to be used for WiFi and AMP if both are active. |
| In any case, track the WiFi channel in use (none) */ |
| if((gAmpChannel != 0) || (gWiFiChannel == 0)) |
| { |
| VOS_TRACE( VOS_MODULE_ID_HDD, VOS_TRACE_LEVEL_INFO_LOW, |
| "No msg for AFH will be sent"); |
| gWiFiChannel = 0; |
| kfree_skb(skb); |
| return; |
| } |
| gWiFiChannel = 0; |
| |
| /* No Break: Fall into next cases */ |
| |
| case WLAN_MODULE_UP_IND: |
| case WLAN_MODULE_DOWN_IND: |
| aniHdr->length = 0; |
| nlh->nlmsg_len = NLMSG_LENGTH((sizeof(tAniMsgHdr))); |
| skb_put(skb, NLMSG_SPACE(sizeof(tAniMsgHdr))); |
| break; |
| case WLAN_BTC_SOFTAP_BSS_START: |
| case WLAN_BTC_QUERY_STATE_RSP: |
| case WLAN_STA_ASSOC_DONE_IND: |
| aniHdr->length = sizeof(tWlanAssocData); |
| nlh->nlmsg_len = NLMSG_LENGTH((sizeof(tAniMsgHdr) + sizeof(tWlanAssocData))); |
| assocData = ( tWlanAssocData *)((char*)aniHdr + sizeof(tAniMsgHdr)); |
| |
| assocData->channel = hdd_get_operating_channel( pHddCtx, gBtcDriverMode ); |
| |
| VOS_TRACE( VOS_MODULE_ID_HDD, VOS_TRACE_LEVEL_INFO_LOW, |
| "New WiFi channel %d gAmpChannel %d gWiFiChannel %d", |
| assocData->channel, gAmpChannel, gWiFiChannel); |
| |
| /* If WiFi has finished associating */ |
| if(type == WLAN_STA_ASSOC_DONE_IND) |
| { |
| /* If AMP is using a channel (non-zero), no message sent. |
| Or, if the WiFi channel did not change, no message sent. |
| Logic presumes same channel has to be used for WiFi and AMP if both are active. |
| In any case, track the WiFi channel in use (1-13 or none, in assocData->channel) */ |
| if((gAmpChannel != 0) || (assocData->channel == gWiFiChannel)) |
| { |
| VOS_TRACE( VOS_MODULE_ID_HDD, VOS_TRACE_LEVEL_INFO_LOW, |
| "No msg for AFH will be sent"); |
| gWiFiChannel = assocData->channel; |
| kfree_skb(skb); |
| return; |
| } |
| } |
| if(type == WLAN_BTC_SOFTAP_BSS_START) |
| { |
| /*Replace WLAN_BTC_SOFTAP_BSS_START by WLAN_STA_ASSOC_DONE_IND*/ |
| aniHdr->type = WLAN_STA_ASSOC_DONE_IND; |
| } |
| gWiFiChannel = assocData->channel; |
| skb_put(skb, NLMSG_SPACE((sizeof(tAniMsgHdr)+ sizeof(tWlanAssocData)))); |
| break; |
| |
| case WLAN_AMP_ASSOC_DONE_IND: |
| |
| /* This is an overloaded type. It means that AMP is connected (dest_pid is channel 1-13), |
| or it means AMP is now disconnected (dest_pid is 0) */ |
| |
| VOS_TRACE( VOS_MODULE_ID_HDD, VOS_TRACE_LEVEL_INFO_LOW, |
| "New AMP channel %d gAmpChannel %d gWiFiChannel %d", dest_pid, gAmpChannel, gWiFiChannel); |
| /* If WiFi is using a channel (non-zero), no message sent. |
| Or, if the AMP channel did not change, no message sent. |
| Logic presumes same channel has to be used for WiFi and AMP if both are active. |
| In any case, track the AMP channel in use (1-13 or none, in dest_pid) */ |
| if((gWiFiChannel != 0) || (dest_pid == gAmpChannel)) |
| { |
| VOS_TRACE( VOS_MODULE_ID_HDD, VOS_TRACE_LEVEL_INFO_LOW, |
| "No msg for AFH will be sent"); |
| gAmpChannel = dest_pid; |
| kfree_skb(skb); |
| return; |
| } |
| |
| gAmpChannel = dest_pid; |
| |
| /* Fix overloaded parameters and finish message formatting */ |
| if(dest_pid != 0) |
| { |
| aniHdr->type = WLAN_STA_ASSOC_DONE_IND; |
| aniHdr->length = sizeof(tWlanAssocData); |
| nlh->nlmsg_len = NLMSG_LENGTH((sizeof(tAniMsgHdr) + sizeof(tWlanAssocData))); |
| assocData = ( tWlanAssocData *)((char*)aniHdr + sizeof(tAniMsgHdr)); |
| assocData->channel = dest_pid; |
| skb_put(skb, NLMSG_SPACE((sizeof(tAniMsgHdr)+ sizeof(tWlanAssocData)))); |
| } |
| else |
| { |
| aniHdr->type = WLAN_STA_DISASSOC_DONE_IND; |
| aniHdr->length = 0; |
| nlh->nlmsg_len = NLMSG_LENGTH((sizeof(tAniMsgHdr))); |
| skb_put(skb, NLMSG_SPACE(sizeof(tAniMsgHdr))); |
| } |
| dest_pid = 0; |
| break; |
| |
| default: |
| VOS_TRACE( VOS_MODULE_ID_HDD, VOS_TRACE_LEVEL_ERROR, |
| "BTC: Attempt to send unknown nlink message %d\n", type); |
| kfree_skb(skb); |
| return; |
| } |
| if(dest_pid == 0) |
| (void)nl_srv_bcast(skb); |
| else |
| (void)nl_srv_ucast(skb, dest_pid, MSG_DONTWAIT); |
| } |
| /* |
| * Activate BTC handler. This will register a handler to receive |
| * netlink messages addressed to WLAN_NL_MSG_BTC from user space |
| */ |
| int btc_activate_service(void *pAdapter) |
| { |
| pHddCtx = (struct hdd_context_s*)pAdapter; |
| |
| //Register the msg handler for msgs addressed to ANI_NL_MSG_BTC |
| nl_srv_register(WLAN_NL_MSG_BTC, btc_msg_callback); |
| return 0; |
| } |
| |
| /**--------------------------------------------------------------------------- |
| |
| \brief btc_deactivate_service() - Deactivate btc message handler |
| |
| This function unregisters a handler to receive netlink messages |
| addressed to WLAN_NL_MSG_BTC from user space. |
| |
| \return - none |
| --------------------------------------------------------------------------*/ |
| void btc_deactivate_service() |
| { |
| //unregister the msg handler for msgs addressed to ANI_NL_MSG_BTC |
| nl_srv_unregister(WLAN_NL_MSG_BTC, btc_msg_callback); |
| } |
| /* |
| * Callback function invoked by Netlink service for all netlink |
| * messages (from user space) addressed to WLAN_NL_MSG_BTC |
| */ |
| int btc_msg_callback (struct sk_buff * skb) |
| { |
| struct nlmsghdr *nlh; |
| tAniMsgHdr *msg_hdr; |
| tSmeBtEvent *btEvent = NULL; |
| nlh = (struct nlmsghdr *)skb->data; |
| msg_hdr = NLMSG_DATA(nlh); |
| |
| /* Continue with parsing payload. */ |
| switch(msg_hdr->type) |
| { |
| case WLAN_BTC_QUERY_STATE_REQ: |
| VOS_TRACE( VOS_MODULE_ID_HDD, VOS_TRACE_LEVEL_INFO, |
| "BTC: Received probe from BTC Service\n"); |
| send_btc_nlink_msg(WLAN_BTC_QUERY_STATE_RSP, nlh->nlmsg_pid); |
| break; |
| case WLAN_BTC_BT_EVENT_IND: |
| VOS_TRACE( VOS_MODULE_ID_HDD, VOS_TRACE_LEVEL_INFO, |
| "BTC: Received Bluetooth event indication\n"); |
| if(msg_hdr->length != sizeof(tSmeBtEvent)) { |
| VOS_TRACE( VOS_MODULE_ID_HDD, VOS_TRACE_LEVEL_ERROR, |
| "BTC: Size mismatch in BT event data\n"); |
| break; |
| } |
| btEvent = (tSmeBtEvent*)((char*)msg_hdr + sizeof(tAniMsgHdr)); |
| (void)sme_BtcSignalBtEvent(pHddCtx->hHal, btEvent); |
| break; |
| default: |
| VOS_TRACE( VOS_MODULE_ID_HDD, VOS_TRACE_LEVEL_ERROR, |
| "BTC: Received Invalid Msg type [%d]\n", msg_hdr->type); |
| break; |
| } |
| return 0; |
| } |