| /* Copyright (c) 2015, The Linux Foundation. All rights reserved. |
| * |
| * Redistribution and use in source and binary forms, with or without |
| * modification, are permitted provided that the following conditions |
| * are met: |
| * * Redistributions of source code must retain the above copyright |
| * notice, this list of conditions and the following disclaimer. |
| * * Redistributions in binary form must reproduce the above |
| * copyright notice, this list of conditions and the following |
| * disclaimer in the documentation and/or other materials provided |
| * with the distribution. |
| * * Neither the name of The Linux Foundation nor the names of its |
| * contributors may be used to endorse or promote products derived |
| * from this software without specific prior written permission. |
| * |
| * THIS SOFTWARE IS PROVIDED "AS IS" AND ANY EXPRESS OR IMPLIED |
| * WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES OF |
| * MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND NON-INFRINGEMENT |
| * ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR CONTRIBUTORS |
| * BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR |
| * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF |
| * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR |
| * BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, |
| * WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE |
| * OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN |
| * IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE. |
| */ |
| |
| #include "sync.h" |
| #define LOG_TAG "WifiHAL" |
| #include <utils/Log.h> |
| #include <time.h> |
| #include <errno.h> |
| #include <stdlib.h> |
| #include "wificonfigcommand.h" |
| |
| /* Implementation of the API functions exposed in wifi_config.h */ |
| wifi_error wifi_extended_dtim_config_set(wifi_request_id id, |
| wifi_interface_handle iface, |
| int extended_dtim) |
| { |
| int ret = 0; |
| WiFiConfigCommand *wifiConfigCommand; |
| struct nlattr *nlData; |
| interface_info *ifaceInfo = getIfaceInfo(iface); |
| wifi_handle wifiHandle = getWifiHandle(iface); |
| hal_info *info = getHalInfo(wifiHandle); |
| |
| ALOGD("%s: extended_dtim:%d", __FUNCTION__, extended_dtim); |
| |
| wifiConfigCommand = new WiFiConfigCommand( |
| wifiHandle, |
| id, |
| OUI_QCA, |
| QCA_NL80211_VENDOR_SUBCMD_SET_WIFI_CONFIGURATION); |
| |
| if (wifiConfigCommand == NULL) { |
| ALOGE("%s: Error wifiConfigCommand NULL", __FUNCTION__); |
| return WIFI_ERROR_UNKNOWN; |
| } |
| |
| /* Create the NL message. */ |
| ret = wifiConfigCommand->create(); |
| if (ret < 0) { |
| ALOGE("wifi_extended_dtim_config_set: failed to create NL msg. " |
| "Error:%d", ret); |
| goto cleanup; |
| } |
| |
| /* Set the interface Id of the message. */ |
| ret = wifiConfigCommand->set_iface_id(ifaceInfo->name); |
| if (ret < 0) { |
| ALOGE("wifi_extended_dtim_config_set: failed to set iface id. " |
| "Error:%d", ret); |
| goto cleanup; |
| } |
| |
| /* Add the vendor specific attributes for the NL command. */ |
| nlData = wifiConfigCommand->attr_start(NL80211_ATTR_VENDOR_DATA); |
| if (!nlData) { |
| ALOGE("wifi_extended_dtim_config_set: failed attr_start for " |
| "VENDOR_DATA. Error:%d", ret); |
| goto cleanup; |
| } |
| |
| if (wifiConfigCommand->put_u32( |
| QCA_WLAN_VENDOR_ATTR_WIFI_CONFIG_DYNAMIC_DTIM, extended_dtim)) { |
| ALOGE("wifi_extended_dtim_config_set(): failed to put vendor data. " |
| "Error:%d", ret); |
| goto cleanup; |
| } |
| wifiConfigCommand->attr_end(nlData); |
| |
| /* Send the NL msg. */ |
| wifiConfigCommand->waitForRsp(false); |
| ret = wifiConfigCommand->requestEvent(); |
| if (ret != 0) { |
| ALOGE("wifi_extended_dtim_config_set(): requestEvent Error:%d", ret); |
| goto cleanup; |
| } |
| |
| cleanup: |
| delete wifiConfigCommand; |
| return (wifi_error)ret; |
| } |
| |
| /* Set the country code to driver. */ |
| wifi_error wifi_set_country_code(wifi_interface_handle iface, |
| const char* country_code) |
| { |
| int requestId, ret = 0; |
| WiFiConfigCommand *wifiConfigCommand; |
| struct nlattr *nlData; |
| interface_info *ifaceInfo = getIfaceInfo(iface); |
| wifi_handle wifiHandle = getWifiHandle(iface); |
| hal_info *info = getHalInfo(wifiHandle); |
| |
| ALOGD("%s: %s", __FUNCTION__, country_code); |
| |
| /* No request id from caller, so generate one and pass it on to the driver. |
| * Generate it randomly. |
| */ |
| requestId = get_requestid(); |
| |
| wifiConfigCommand = new WiFiConfigCommand( |
| wifiHandle, |
| requestId, |
| OUI_QCA, |
| QCA_NL80211_VENDOR_SUBCMD_SET_WIFI_CONFIGURATION); |
| if (wifiConfigCommand == NULL) { |
| ALOGE("%s: Error wifiConfigCommand NULL", __FUNCTION__); |
| return WIFI_ERROR_UNKNOWN; |
| } |
| |
| /* Create the NL message with NL80211_CMD_REQ_SET_REG NL cmd. */ |
| ret = wifiConfigCommand->create_generic(NL80211_CMD_REQ_SET_REG); |
| if (ret < 0) { |
| ALOGE("wifi_set_country_code: failed to create NL msg. Error:%d", ret); |
| goto cleanup; |
| } |
| |
| if (wifiConfigCommand->put_string(NL80211_ATTR_REG_ALPHA2, country_code)) { |
| ALOGE("wifi_set_country_code: put country code failed. Error:%d", ret); |
| goto cleanup; |
| } |
| |
| /* Send the NL msg. */ |
| wifiConfigCommand->waitForRsp(false); |
| ret = wifiConfigCommand->requestEvent(); |
| if (ret != 0) { |
| ALOGE("wifi_set_country_code(): requestEvent Error:%d", ret); |
| goto cleanup; |
| } |
| usleep(WAIT_TIME_FOR_SET_REG_DOMAIN); |
| |
| cleanup: |
| delete wifiConfigCommand; |
| return (wifi_error)ret; |
| } |
| |
| wifi_error wifi_set_beacon_wifi_iface_stats_averaging_factor( |
| wifi_request_id id, |
| wifi_interface_handle iface, |
| u16 factor) |
| { |
| int ret = 0; |
| WiFiConfigCommand *wifiConfigCommand; |
| struct nlattr *nlData; |
| interface_info *ifaceInfo = getIfaceInfo(iface); |
| wifi_handle wifiHandle = getWifiHandle(iface); |
| hal_info *info = getHalInfo(wifiHandle); |
| |
| ALOGD("%s factor:%u", __FUNCTION__, factor); |
| wifiConfigCommand = new WiFiConfigCommand( |
| wifiHandle, |
| id, |
| OUI_QCA, |
| QCA_NL80211_VENDOR_SUBCMD_SET_WIFI_CONFIGURATION); |
| if (wifiConfigCommand == NULL) { |
| ALOGE("%s: Error wifiConfigCommand NULL", __FUNCTION__); |
| return WIFI_ERROR_UNKNOWN; |
| } |
| |
| /* Create the NL message. */ |
| ret = wifiConfigCommand->create(); |
| if (ret < 0) { |
| ALOGE("wifi_set_beacon_wifi_iface_stats_averaging_factor: failed to " |
| "create NL msg. Error:%d", ret); |
| goto cleanup; |
| } |
| |
| /* Set the interface Id of the message. */ |
| ret = wifiConfigCommand->set_iface_id(ifaceInfo->name); |
| if (ret < 0) { |
| ALOGE("wifi_set_beacon_wifi_iface_stats_averaging_factor: failed to " |
| "set iface id. Error:%d", ret); |
| goto cleanup; |
| } |
| |
| /* Add the vendor specific attributes for the NL command. */ |
| nlData = wifiConfigCommand->attr_start(NL80211_ATTR_VENDOR_DATA); |
| if (!nlData) { |
| ALOGE("wifi_set_beacon_wifi_iface_stats_averaging_factor: failed " |
| "attr_start for VENDOR_DATA. Error:%d", ret); |
| goto cleanup; |
| } |
| |
| if (wifiConfigCommand->put_u32( |
| QCA_WLAN_VENDOR_ATTR_WIFI_CONFIG_STATS_AVG_FACTOR, factor)) { |
| ALOGE("wifi_set_beacon_wifi_iface_stats_averaging_factor(): failed to " |
| "put vendor data. Error:%d", ret); |
| goto cleanup; |
| } |
| wifiConfigCommand->attr_end(nlData); |
| |
| /* Send the NL msg. */ |
| wifiConfigCommand->waitForRsp(false); |
| ret = wifiConfigCommand->requestEvent(); |
| if (ret != 0) { |
| ALOGE("wifi_set_beacon_wifi_iface_stats_averaging_factor(): " |
| "requestEvent Error:%d", ret); |
| goto cleanup; |
| } |
| |
| cleanup: |
| delete wifiConfigCommand; |
| return (wifi_error)ret; |
| } |
| |
| wifi_error wifi_set_guard_time(wifi_request_id id, |
| wifi_interface_handle iface, |
| u32 guard_time) |
| { |
| int ret = 0; |
| WiFiConfigCommand *wifiConfigCommand; |
| struct nlattr *nlData; |
| interface_info *ifaceInfo = getIfaceInfo(iface); |
| wifi_handle wifiHandle = getWifiHandle(iface); |
| hal_info *info = getHalInfo(wifiHandle); |
| |
| ALOGD("%s : guard_time:%u", __FUNCTION__, guard_time); |
| |
| wifiConfigCommand = new WiFiConfigCommand( |
| wifiHandle, |
| id, |
| OUI_QCA, |
| QCA_NL80211_VENDOR_SUBCMD_SET_WIFI_CONFIGURATION); |
| if (wifiConfigCommand == NULL) { |
| ALOGE("%s: Error wifiConfigCommand NULL", __FUNCTION__); |
| return WIFI_ERROR_UNKNOWN; |
| } |
| |
| /* Create the NL message. */ |
| ret = wifiConfigCommand->create(); |
| if (ret < 0) { |
| ALOGE("wifi_set_guard_time: failed to create NL msg. Error:%d", ret); |
| goto cleanup; |
| } |
| |
| /* Set the interface Id of the message. */ |
| ret = wifiConfigCommand->set_iface_id(ifaceInfo->name); |
| if (ret < 0) { |
| ALOGE("wifi_set_guard_time: failed to set iface id. Error:%d", ret); |
| goto cleanup; |
| } |
| |
| /* Add the vendor specific attributes for the NL command. */ |
| nlData = wifiConfigCommand->attr_start(NL80211_ATTR_VENDOR_DATA); |
| if (!nlData) { |
| ALOGE("wifi_set_guard_time: failed attr_start for VENDOR_DATA. " |
| "Error:%d", ret); |
| goto cleanup; |
| } |
| |
| if (wifiConfigCommand->put_u32( |
| QCA_WLAN_VENDOR_ATTR_WIFI_CONFIG_GUARD_TIME, guard_time)) { |
| ALOGE("wifi_set_guard_time: failed to add vendor data."); |
| goto cleanup; |
| } |
| wifiConfigCommand->attr_end(nlData); |
| |
| /* Send the NL msg. */ |
| wifiConfigCommand->waitForRsp(false); |
| ret = wifiConfigCommand->requestEvent(); |
| if (ret != 0) { |
| ALOGE("wifi_set_guard_time(): requestEvent Error:%d", ret); |
| goto cleanup; |
| } |
| |
| cleanup: |
| delete wifiConfigCommand; |
| return (wifi_error)ret; |
| } |
| |
| WiFiConfigCommand::WiFiConfigCommand(wifi_handle handle, |
| int id, u32 vendor_id, |
| u32 subcmd) |
| : WifiVendorCommand(handle, id, vendor_id, subcmd) |
| { |
| /* Initialize the member data variables here */ |
| mWaitforRsp = false; |
| mRequestId = id; |
| } |
| |
| WiFiConfigCommand::~WiFiConfigCommand() |
| { |
| unregisterVendorHandler(mVendor_id, mSubcmd); |
| } |
| |
| /* This function implements creation of Vendor command */ |
| int WiFiConfigCommand::create() { |
| int ret = mMsg.create(NL80211_CMD_VENDOR, 0, 0); |
| if (ret < 0) { |
| return ret; |
| } |
| |
| /* Insert the oui in the msg */ |
| ret = mMsg.put_u32(NL80211_ATTR_VENDOR_ID, mVendor_id); |
| if (ret < 0) |
| goto out; |
| /* Insert the subcmd in the msg */ |
| ret = mMsg.put_u32(NL80211_ATTR_VENDOR_SUBCMD, mSubcmd); |
| if (ret < 0) |
| goto out; |
| out: |
| return ret; |
| } |
| |
| /* This function implements creation of generic NL command */ |
| int WiFiConfigCommand::create_generic(u8 cmdId) { |
| int ret = mMsg.create(cmdId, 0, 0); |
| return ret; |
| } |
| |
| void WiFiConfigCommand::waitForRsp(bool wait) |
| { |
| mWaitforRsp = wait; |
| } |
| |
| /* Callback handlers registered for nl message send */ |
| static int error_handler_wifi_config(struct sockaddr_nl *nla, |
| struct nlmsgerr *err, |
| void *arg) |
| { |
| struct sockaddr_nl *tmp; |
| int *ret = (int *)arg; |
| tmp = nla; |
| *ret = err->error; |
| ALOGE("%s: Error code:%d (%s)", __FUNCTION__, *ret, strerror(-(*ret))); |
| return NL_STOP; |
| } |
| |
| /* Callback handlers registered for nl message send */ |
| static int ack_handler_wifi_config(struct nl_msg *msg, void *arg) |
| { |
| int *ret = (int *)arg; |
| struct nl_msg * a; |
| |
| a = msg; |
| *ret = 0; |
| return NL_STOP; |
| } |
| |
| /* Callback handlers registered for nl message send */ |
| static int finish_handler_wifi_config(struct nl_msg *msg, void *arg) |
| { |
| int *ret = (int *)arg; |
| struct nl_msg * a; |
| |
| a = msg; |
| *ret = 0; |
| return NL_SKIP; |
| } |
| |
| /* |
| * Override base class requestEvent and implement little differently here. |
| * This will send the request message. |
| * We don't wait for any response back in case of wificonfig, |
| * thus no wait for condition. |
| */ |
| int WiFiConfigCommand::requestEvent() |
| { |
| int res = -1; |
| struct nl_cb *cb; |
| |
| cb = nl_cb_alloc(NL_CB_DEFAULT); |
| if (!cb) { |
| ALOGE("%s: Callback allocation failed",__FUNCTION__); |
| res = -1; |
| goto out; |
| } |
| |
| res = nl_send_auto_complete(mInfo->cmd_sock, mMsg.getMessage()); |
| if (res < 0) |
| goto out; |
| res = 1; |
| |
| nl_cb_err(cb, NL_CB_CUSTOM, error_handler_wifi_config, &res); |
| nl_cb_set(cb, NL_CB_FINISH, NL_CB_CUSTOM, finish_handler_wifi_config, |
| &res); |
| nl_cb_set(cb, NL_CB_ACK, NL_CB_CUSTOM, ack_handler_wifi_config, &res); |
| |
| /* Err is populated as part of finish_handler. */ |
| while (res > 0){ |
| nl_recvmsgs(mInfo->cmd_sock, cb); |
| } |
| |
| /* Only wait for the asynchronous event if HDD returns success, res=0 */ |
| if (!res && (mWaitforRsp == true)) { |
| struct timespec abstime; |
| abstime.tv_sec = 4; |
| abstime.tv_nsec = 0; |
| res = mCondition.wait(abstime); |
| if (res == ETIMEDOUT) |
| { |
| ALOGE("%s: Time out happened.", __FUNCTION__); |
| } |
| ALOGD("%s: Command invoked return value:%d, mWaitForRsp=%d", |
| __FUNCTION__, res, mWaitforRsp); |
| } |
| out: |
| /* Cleanup the mMsg */ |
| mMsg.destroy(); |
| return res; |
| } |
| |