Add new features:-
1. AP Auto shut off 2. Energy Detect Threshold Change-Id: I454dd0c999131a0d0910b415cf73590d3458f2ad
This commit is contained in:
@@ -1,437 +1,459 @@
|
||||
/*
|
||||
* Copyright (c) 2010, Code Aurora Forum. 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 Code Aurora Forum, Inc. 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 <stdlib.h>
|
||||
#include <fcntl.h>
|
||||
#include <errno.h>
|
||||
#include <string.h>
|
||||
#include <stdio.h>
|
||||
|
||||
#include <linux/if.h>
|
||||
#include <linux/wireless.h>
|
||||
#include <sys/ioctl.h>
|
||||
#include <sys/socket.h>
|
||||
#include <sys/stat.h>
|
||||
#include <sys/types.h>
|
||||
#include <sys/wait.h>
|
||||
#include <netinet/in.h>
|
||||
#include <arpa/inet.h>
|
||||
|
||||
#define LOG_TAG "QCLDR-"
|
||||
|
||||
#include "cutils/log.h"
|
||||
#include "cutils/memory.h"
|
||||
#include "cutils/misc.h"
|
||||
#include "cutils/properties.h"
|
||||
#include "private/android_filesystem_config.h"
|
||||
|
||||
#include "qsap_api.h"
|
||||
#include "qsap.h"
|
||||
#include "libwpa_client/wpa_ctrl.h"
|
||||
|
||||
#include <sys/system_properties.h>
|
||||
|
||||
#ifndef WIFI_DRIVER_MODULE_PATH
|
||||
#define WIFI_DRIVER_MODULE_PATH "/system/lib/modules/wlan.ko"
|
||||
#endif
|
||||
|
||||
#ifndef WIFI_DRIVER_MODULE_NAME
|
||||
#define WIFI_DRIVER_MODULE_NAME "wlan"
|
||||
#endif
|
||||
|
||||
#ifndef WIFI_SDIO_IF_DRIVER_MODULE_PATH
|
||||
#define WIFI_SDIO_IF_DRIVER_MODULE_PATH "/system/lib/modules/librasdioif.ko"
|
||||
#endif
|
||||
|
||||
#ifndef WIFI_SDIO_IF_DRIVER_MODULE_NAME
|
||||
#define WIFI_SDIO_IF_DRIVER_MODULE_NAME "librasdioif"
|
||||
#endif
|
||||
|
||||
#ifndef WIFI_SDIO_IF_DRIVER_MODULE_ARG
|
||||
#define WIFI_SDIO_IF_DRIVER_MODULE_ARG ""
|
||||
#endif
|
||||
|
||||
#ifdef WIFI_DRIVER_MODULE_ARG
|
||||
#undef WIFI_DRIVER_MODULE_ARG
|
||||
#endif
|
||||
|
||||
#define WIFI_DRIVER_MODULE_ARG "con_mode=1"
|
||||
|
||||
extern int init_module(const char *name, u32, const s8 *);
|
||||
extern int delete_module(const char *name, int);
|
||||
|
||||
static s32 check_driver_loaded( const s8 * tag)
|
||||
{
|
||||
FILE *proc;
|
||||
s8 line[126];
|
||||
|
||||
if ((proc = fopen("/proc/modules", "r")) == NULL) {
|
||||
LOGW("Could not open %s: %s", "/proc/modules", strerror(errno));
|
||||
return 0;
|
||||
}
|
||||
|
||||
while ((fgets(line, sizeof(line), proc)) != NULL) {
|
||||
if (strncmp(line, tag, strlen(tag)) == 0) {
|
||||
fclose(proc);
|
||||
return 1;
|
||||
}
|
||||
}
|
||||
|
||||
fclose(proc);
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
static s32 insmod(const s8 *filename, const s8 *args, const s8 * tag)
|
||||
{
|
||||
#ifndef SDK_TEST
|
||||
void *module;
|
||||
s32 size;
|
||||
s32 ret = 0;
|
||||
|
||||
if ( check_driver_loaded(tag) ) {
|
||||
LOGE("Driver: %s already loaded\n", filename);
|
||||
return ret;
|
||||
}
|
||||
|
||||
LOGD("Loading Driver: %s %s\n", filename, args);
|
||||
|
||||
module = (void*)load_file(filename, (unsigned int*)&size);
|
||||
|
||||
if (!module) {
|
||||
LOGE("Cannot load file: %s\n", filename);
|
||||
return -1;
|
||||
}
|
||||
|
||||
ret = init_module(module, size, args);
|
||||
|
||||
if ( ret ) {
|
||||
LOGE("init_module (%s:%d) failed\n", filename, (int)size);
|
||||
}
|
||||
|
||||
free(module);
|
||||
|
||||
return ret;
|
||||
#else
|
||||
return 0;
|
||||
#endif
|
||||
}
|
||||
|
||||
static s32 rmmod(const s8 *modname)
|
||||
{
|
||||
#ifndef SDK_TEST
|
||||
s32 ret = 0;
|
||||
s32 maxtry = 10;
|
||||
|
||||
while (maxtry-- > 0) {
|
||||
ret = delete_module(modname, O_NONBLOCK | O_EXCL);
|
||||
|
||||
if (ret < 0 && errno == EAGAIN){
|
||||
usleep(50000);
|
||||
} else {
|
||||
break;
|
||||
}
|
||||
}
|
||||
|
||||
if (ret != 0) {
|
||||
LOGD("Unable to unload driver module \"%s\": %s\n",
|
||||
modname, strerror(errno));
|
||||
}
|
||||
|
||||
return ret;
|
||||
#else
|
||||
return 0;
|
||||
#endif
|
||||
}
|
||||
|
||||
static const s8 SDIO_POLLING_ON[] = "/etc/init.qcom.sdio.sh 1";
|
||||
static const s8 SDIO_POLLING_OFF[] = "/etc/init.qcom.sdio.sh 0";
|
||||
|
||||
s32 wifi_qsap_load_driver(void)
|
||||
{
|
||||
s32 size;
|
||||
s32 ret = 0;
|
||||
s32 retry;
|
||||
|
||||
/* Unload the station mode driver first */
|
||||
wifi_qsap_unload_wifi_sta_driver();
|
||||
|
||||
if (system(SDIO_POLLING_ON)) {
|
||||
LOGE("Could not turn on the polling...");
|
||||
}
|
||||
|
||||
ret = insmod(WIFI_SDIO_IF_DRIVER_MODULE_PATH, WIFI_SDIO_IF_DRIVER_MODULE_ARG, WIFI_SDIO_IF_DRIVER_MODULE_NAME " ");
|
||||
|
||||
if ( ret != 0 ) {
|
||||
LOGE("init_module failed sdioif\n");
|
||||
goto end;
|
||||
}
|
||||
|
||||
sched_yield();
|
||||
|
||||
ret = insmod(WIFI_DRIVER_MODULE_PATH, WIFI_DRIVER_MODULE_ARG, WIFI_DRIVER_MODULE_NAME " ");
|
||||
|
||||
if ( ret != 0 ) {
|
||||
LOGE("init_module failed libra_softap\n");
|
||||
goto end;
|
||||
}
|
||||
|
||||
sched_yield();
|
||||
end:
|
||||
if(system(SDIO_POLLING_OFF)) {
|
||||
LOGE("Could not turn off the polling...");
|
||||
}
|
||||
|
||||
return ret;
|
||||
}
|
||||
|
||||
s32 wifi_qsap_unload_wifi_sta_driver(void)
|
||||
{
|
||||
s32 ret = 0;
|
||||
|
||||
if(system(SDIO_POLLING_ON)) {
|
||||
LOGE("Could not turn on the polling...");
|
||||
}
|
||||
|
||||
if ( check_driver_loaded(WIFI_DRIVER_MODULE_NAME " ") ) {
|
||||
if ( rmmod(WIFI_DRIVER_MODULE_NAME) ) {
|
||||
LOGE("Unable to unload the station mode wifi driver...\n");
|
||||
ret = 1;
|
||||
goto end;
|
||||
}
|
||||
}
|
||||
|
||||
sched_yield();
|
||||
|
||||
if ( check_driver_loaded(WIFI_SDIO_IF_DRIVER_MODULE_NAME " ") ) {
|
||||
if ( rmmod(WIFI_SDIO_IF_DRIVER_MODULE_NAME) ) {
|
||||
LOGE("Unable to unload the station mode librasdioif driver\n");
|
||||
ret = 1;
|
||||
goto end;
|
||||
}
|
||||
}
|
||||
|
||||
end:
|
||||
if(system(SDIO_POLLING_OFF)) {
|
||||
LOGE("Could not turn off the polling...");
|
||||
}
|
||||
sched_yield();
|
||||
return 0;
|
||||
}
|
||||
|
||||
s32 wifi_qsap_unload_driver()
|
||||
{
|
||||
s32 ret = 0;
|
||||
|
||||
if(system(SDIO_POLLING_ON)) {
|
||||
LOGE("Could not turn on the polling...");
|
||||
}
|
||||
|
||||
if ( check_driver_loaded(WIFI_DRIVER_MODULE_NAME " ") ) {
|
||||
if ( rmmod(WIFI_DRIVER_MODULE_NAME) ) {
|
||||
LOGE("Unable to unload the libra_softap driver\n");
|
||||
ret = 1;
|
||||
goto end;
|
||||
}
|
||||
}
|
||||
|
||||
sched_yield();
|
||||
|
||||
if ( check_driver_loaded(WIFI_SDIO_IF_DRIVER_MODULE_NAME " ") ) {
|
||||
if ( rmmod(WIFI_SDIO_IF_DRIVER_MODULE_NAME) ) {
|
||||
LOGE("Unable to unload the librasdioif driver\n");
|
||||
ret = 1;
|
||||
goto end;
|
||||
}
|
||||
}
|
||||
end:
|
||||
if(system(SDIO_POLLING_OFF)) {
|
||||
LOGE("Could not turn off the polling...");
|
||||
}
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
s32 wifi_qsap_stop_bss(void)
|
||||
{
|
||||
#define QCIEEE80211_IOCTL_STOPBSS (SIOCIWFIRSTPRIV + 6)
|
||||
s32 sock;
|
||||
s32 ret = eERR_STOP_BSS;
|
||||
s8 cmd[] = "stopbss";
|
||||
s8 interface[128];
|
||||
s8 *iface;
|
||||
s32 len = 128;
|
||||
struct iwreq wrq;
|
||||
struct iw_priv_args *priv_ptr;
|
||||
|
||||
if(NULL == (iface = qsap_get_config_value(CONFIG_FILE, "interface", interface, (u32*)&len))) {
|
||||
LOGE("%s :interface error \n", __func__);
|
||||
return ret;
|
||||
}
|
||||
|
||||
/* Issue the stopbss command to driver */
|
||||
sock = socket(AF_INET, SOCK_DGRAM, 0);
|
||||
|
||||
if (sock < 0) {
|
||||
LOGE("Failed to open socket");
|
||||
return eERR_STOP_BSS;
|
||||
}
|
||||
|
||||
strncpy(wrq.ifr_name, iface, sizeof(wrq.ifr_name));
|
||||
wrq.u.data.length = sizeof(cmd);
|
||||
wrq.u.data.pointer = cmd;
|
||||
wrq.u.data.flags = 0;
|
||||
|
||||
ret = ioctl(sock, QCIEEE80211_IOCTL_STOPBSS, &wrq);
|
||||
|
||||
/* Here IOCTL is always returning non Zero: temporary fix untill driver is fixed*/
|
||||
ret = 0;
|
||||
close(sock);
|
||||
|
||||
if (ret) {
|
||||
LOGE("IOCTL stopbss failed: %ld", ret);
|
||||
ret = eERR_STOP_BSS;
|
||||
} else {
|
||||
LOGD("STOP BSS ISSUED");
|
||||
ret = eSUCCESS;
|
||||
}
|
||||
|
||||
sched_yield();
|
||||
return ret;
|
||||
}
|
||||
|
||||
s32 is_softap_enabled(void)
|
||||
{
|
||||
s8 stat[32] = {0};
|
||||
|
||||
if ( property_get("init.svc.hostapd", stat, NULL) &&
|
||||
(strcmp(stat, "running") == 0)) {
|
||||
LOGD("HOSTAPD enabled \n");
|
||||
return ENABLE;
|
||||
}
|
||||
|
||||
LOGD("HOSTAPD disabled \n");
|
||||
return DISABLE;
|
||||
}
|
||||
|
||||
s32 commit(void)
|
||||
{
|
||||
#ifndef SDK_TEST
|
||||
s32 ret = eERR_COMMIT;
|
||||
|
||||
if ( is_softap_enabled() ) {
|
||||
/** Stop BSS */
|
||||
if(eSUCCESS != wifi_qsap_stop_bss()) {
|
||||
LOGE("%s: stop bss failed \n", __func__);
|
||||
return ret;
|
||||
}
|
||||
sleep(1);
|
||||
}
|
||||
|
||||
ret = wifi_qsap_start_softap();
|
||||
|
||||
if( eSUCCESS != ret )
|
||||
wifi_qsap_unload_driver();
|
||||
|
||||
return ret;
|
||||
#else
|
||||
return eSUCCESS;
|
||||
#endif
|
||||
}
|
||||
|
||||
s32 wifi_qsap_start_softap()
|
||||
{
|
||||
s32 retry = 4;
|
||||
|
||||
LOGD("Starting Soft AP...\n");
|
||||
|
||||
while(--retry ) {
|
||||
/** Stop hostapd */
|
||||
if(0 != property_set("ctl.start", "hostapd")) {
|
||||
LOGE("failed \n");
|
||||
continue;
|
||||
}
|
||||
|
||||
sleep(1);
|
||||
|
||||
if ( is_softap_enabled() ) {
|
||||
LOGD("success \n");
|
||||
return eSUCCESS;
|
||||
}
|
||||
}
|
||||
|
||||
LOGE("Unable to start the SoftAP\n");
|
||||
return eERR_START_SAP;
|
||||
}
|
||||
|
||||
s32 wifi_qsap_stop_softap()
|
||||
{
|
||||
if ( is_softap_enabled() ) {
|
||||
LOGD("Stopping BSS ..... ");
|
||||
|
||||
/** Stop the BSS */
|
||||
if (eSUCCESS != wifi_qsap_stop_bss()) {
|
||||
LOGE("failed \n");
|
||||
return eERR_STOP_SAP;
|
||||
}
|
||||
sleep(1);
|
||||
}
|
||||
|
||||
return eSUCCESS;
|
||||
}
|
||||
|
||||
s32 wifi_qsap_reload_softap()
|
||||
{
|
||||
s32 ret = eERR_RELOAD_SAP;
|
||||
|
||||
/** SDK API to reload the firmware */
|
||||
if (eSUCCESS != wifi_qsap_stop_softap()) {
|
||||
return ret;
|
||||
}
|
||||
|
||||
if (eSUCCESS != wifi_qsap_unload_driver()) {
|
||||
return ret;
|
||||
}
|
||||
|
||||
usleep(500000);
|
||||
|
||||
if (eSUCCESS != wifi_qsap_load_driver()) {
|
||||
return ret;
|
||||
}
|
||||
|
||||
sleep(1);
|
||||
|
||||
if (eSUCCESS != wifi_qsap_start_softap()) {
|
||||
wifi_qsap_unload_driver();
|
||||
return ret;
|
||||
}
|
||||
|
||||
return eSUCCESS;
|
||||
}
|
||||
/*
|
||||
* Copyright (c) 2010, Code Aurora Forum. 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 Code Aurora Forum, Inc. 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 <stdlib.h>
|
||||
#include <fcntl.h>
|
||||
#include <errno.h>
|
||||
#include <string.h>
|
||||
#include <stdio.h>
|
||||
|
||||
#include <linux/if.h>
|
||||
#include <linux/wireless.h>
|
||||
#include <sys/ioctl.h>
|
||||
#include <sys/socket.h>
|
||||
#include <sys/stat.h>
|
||||
#include <sys/types.h>
|
||||
#include <sys/wait.h>
|
||||
#include <netinet/in.h>
|
||||
#include <arpa/inet.h>
|
||||
|
||||
#define LOG_TAG "QCLDR-"
|
||||
|
||||
#include "cutils/log.h"
|
||||
#include "cutils/memory.h"
|
||||
#include "cutils/misc.h"
|
||||
#include "cutils/properties.h"
|
||||
#include "private/android_filesystem_config.h"
|
||||
|
||||
#include "qsap_api.h"
|
||||
#include "qsap.h"
|
||||
#include "libwpa_client/wpa_ctrl.h"
|
||||
|
||||
#include <sys/system_properties.h>
|
||||
|
||||
#ifndef WIFI_DRIVER_MODULE_PATH
|
||||
#define WIFI_DRIVER_MODULE_PATH "/system/lib/modules/wlan.ko"
|
||||
#endif
|
||||
|
||||
#ifndef WIFI_DRIVER_MODULE_NAME
|
||||
#define WIFI_DRIVER_MODULE_NAME "wlan"
|
||||
#endif
|
||||
|
||||
#ifndef WIFI_SDIO_IF_DRIVER_MODULE_PATH
|
||||
#define WIFI_SDIO_IF_DRIVER_MODULE_PATH "/system/lib/modules/librasdioif.ko"
|
||||
#endif
|
||||
|
||||
#ifndef WIFI_SDIO_IF_DRIVER_MODULE_NAME
|
||||
#define WIFI_SDIO_IF_DRIVER_MODULE_NAME "librasdioif"
|
||||
#endif
|
||||
|
||||
#ifndef WIFI_SDIO_IF_DRIVER_MODULE_ARG
|
||||
#define WIFI_SDIO_IF_DRIVER_MODULE_ARG ""
|
||||
#endif
|
||||
|
||||
#ifdef WIFI_DRIVER_MODULE_ARG
|
||||
#undef WIFI_DRIVER_MODULE_ARG
|
||||
#endif
|
||||
|
||||
#define WIFI_DRIVER_MODULE_ARG "con_mode=1"
|
||||
|
||||
extern int init_module(const char *name, u32, const s8 *);
|
||||
extern int delete_module(const char *name, int);
|
||||
|
||||
static s32 check_driver_loaded( const s8 * tag)
|
||||
{
|
||||
FILE *proc;
|
||||
s8 line[126];
|
||||
|
||||
if ((proc = fopen("/proc/modules", "r")) == NULL) {
|
||||
LOGW("Could not open %s: %s", "/proc/modules", strerror(errno));
|
||||
return 0;
|
||||
}
|
||||
|
||||
while ((fgets(line, sizeof(line), proc)) != NULL) {
|
||||
if (strncmp(line, tag, strlen(tag)) == 0) {
|
||||
fclose(proc);
|
||||
return 1;
|
||||
}
|
||||
}
|
||||
|
||||
fclose(proc);
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
static s32 insmod(const s8 *filename, const s8 *args, const s8 * tag)
|
||||
{
|
||||
#ifndef SDK_TEST
|
||||
void *module;
|
||||
s32 size;
|
||||
s32 ret = 0;
|
||||
|
||||
if ( check_driver_loaded(tag) ) {
|
||||
LOGE("Driver: %s already loaded\n", filename);
|
||||
return ret;
|
||||
}
|
||||
|
||||
LOGD("Loading Driver: %s %s\n", filename, args);
|
||||
|
||||
module = (void*)load_file(filename, (unsigned int*)&size);
|
||||
|
||||
if (!module) {
|
||||
LOGE("Cannot load file: %s\n", filename);
|
||||
return -1;
|
||||
}
|
||||
|
||||
ret = init_module(module, size, args);
|
||||
|
||||
if ( ret ) {
|
||||
LOGE("init_module (%s:%d) failed\n", filename, (int)size);
|
||||
}
|
||||
|
||||
free(module);
|
||||
|
||||
return ret;
|
||||
#else
|
||||
return 0;
|
||||
#endif
|
||||
}
|
||||
|
||||
static s32 rmmod(const s8 *modname)
|
||||
{
|
||||
#ifndef SDK_TEST
|
||||
s32 ret = 0;
|
||||
s32 maxtry = 10;
|
||||
|
||||
while (maxtry-- > 0) {
|
||||
ret = delete_module(modname, O_NONBLOCK | O_EXCL);
|
||||
|
||||
if (ret < 0 && errno == EAGAIN){
|
||||
usleep(50000);
|
||||
} else {
|
||||
break;
|
||||
}
|
||||
}
|
||||
|
||||
if (ret != 0) {
|
||||
LOGD("Unable to unload driver module \"%s\": %s\n",
|
||||
modname, strerror(errno));
|
||||
}
|
||||
|
||||
return ret;
|
||||
#else
|
||||
return 0;
|
||||
#endif
|
||||
}
|
||||
|
||||
static const s8 SDIO_POLLING_ON[] = "/etc/init.qcom.sdio.sh 1";
|
||||
static const s8 SDIO_POLLING_OFF[] = "/etc/init.qcom.sdio.sh 0";
|
||||
|
||||
s32 wifi_qsap_load_driver(void)
|
||||
{
|
||||
s32 size;
|
||||
s32 ret = 0;
|
||||
s32 retry;
|
||||
|
||||
/* Unload the station mode driver first */
|
||||
wifi_qsap_unload_wifi_sta_driver();
|
||||
|
||||
if (system(SDIO_POLLING_ON)) {
|
||||
LOGE("Could not turn on the polling...");
|
||||
}
|
||||
|
||||
ret = insmod(WIFI_SDIO_IF_DRIVER_MODULE_PATH, WIFI_SDIO_IF_DRIVER_MODULE_ARG, WIFI_SDIO_IF_DRIVER_MODULE_NAME " ");
|
||||
|
||||
if ( ret != 0 ) {
|
||||
LOGE("init_module failed sdioif\n");
|
||||
ret = eERR_LOAD_FAILED_SDIOIF;
|
||||
goto end;
|
||||
}
|
||||
|
||||
sched_yield();
|
||||
|
||||
ret = insmod(WIFI_DRIVER_MODULE_PATH, WIFI_DRIVER_MODULE_ARG, WIFI_DRIVER_MODULE_NAME " ");
|
||||
|
||||
if ( ret != 0 ) {
|
||||
if ( check_driver_loaded(WIFI_SDIO_IF_DRIVER_MODULE_NAME " ") ) {
|
||||
if ( rmmod(WIFI_SDIO_IF_DRIVER_MODULE_NAME) ) {
|
||||
LOGE("Unable to unload the station mode librasdioif driver\n");
|
||||
}
|
||||
}
|
||||
LOGE("init_module failed libra_softap\n");
|
||||
ret = eERR_LOAD_FAILED_SOFTAP;
|
||||
goto end;
|
||||
}
|
||||
|
||||
sched_yield();
|
||||
|
||||
ret = eSUCCESS;
|
||||
|
||||
end:
|
||||
if(system(SDIO_POLLING_OFF)) {
|
||||
LOGE("Could not turn off the polling...");
|
||||
}
|
||||
|
||||
return ret;
|
||||
}
|
||||
|
||||
s32 wifi_qsap_unload_wifi_sta_driver(void)
|
||||
{
|
||||
s32 ret = 0;
|
||||
|
||||
if(system(SDIO_POLLING_ON)) {
|
||||
LOGE("Could not turn on the polling...");
|
||||
}
|
||||
|
||||
if ( check_driver_loaded(WIFI_DRIVER_MODULE_NAME " ") ) {
|
||||
if ( rmmod(WIFI_DRIVER_MODULE_NAME) ) {
|
||||
LOGE("Unable to unload the station mode wifi driver...\n");
|
||||
ret = 1;
|
||||
goto end;
|
||||
}
|
||||
}
|
||||
|
||||
sched_yield();
|
||||
|
||||
if ( check_driver_loaded(WIFI_SDIO_IF_DRIVER_MODULE_NAME " ") ) {
|
||||
if ( rmmod(WIFI_SDIO_IF_DRIVER_MODULE_NAME) ) {
|
||||
LOGE("Unable to unload the station mode librasdioif driver\n");
|
||||
ret = 1;
|
||||
goto end;
|
||||
}
|
||||
}
|
||||
|
||||
end:
|
||||
if(system(SDIO_POLLING_OFF)) {
|
||||
LOGE("Could not turn off the polling...");
|
||||
}
|
||||
sched_yield();
|
||||
return 0;
|
||||
}
|
||||
|
||||
s32 wifi_qsap_unload_driver()
|
||||
{
|
||||
s32 ret = eSUCCESS;
|
||||
|
||||
if(system(SDIO_POLLING_ON)) {
|
||||
LOGE("Could not turn on the polling...");
|
||||
}
|
||||
|
||||
if ( check_driver_loaded(WIFI_DRIVER_MODULE_NAME " ") ) {
|
||||
if ( rmmod(WIFI_DRIVER_MODULE_NAME) ) {
|
||||
LOGE("Unable to unload the libra_softap driver\n");
|
||||
ret = eERR_UNLOAD_FAILED_SOFTAP;
|
||||
goto end;
|
||||
}
|
||||
}
|
||||
|
||||
sched_yield();
|
||||
|
||||
if ( check_driver_loaded(WIFI_SDIO_IF_DRIVER_MODULE_NAME " ") ) {
|
||||
if ( rmmod(WIFI_SDIO_IF_DRIVER_MODULE_NAME) ) {
|
||||
LOGE("Unable to unload the librasdioif driver\n");
|
||||
ret = eERR_UNLOAD_FAILED_SDIO;
|
||||
goto end;
|
||||
}
|
||||
}
|
||||
end:
|
||||
if(system(SDIO_POLLING_OFF)) {
|
||||
LOGE("Could not turn off the polling...");
|
||||
}
|
||||
|
||||
return ret;
|
||||
}
|
||||
|
||||
s32 wifi_qsap_stop_bss(void)
|
||||
{
|
||||
#define QCIEEE80211_IOCTL_STOPBSS (SIOCIWFIRSTPRIV + 6)
|
||||
s32 sock;
|
||||
s32 ret = eERR_STOP_BSS;
|
||||
s8 cmd[] = "stopbss";
|
||||
s8 interface[128];
|
||||
s8 *iface;
|
||||
s32 len = 128;
|
||||
struct iwreq wrq;
|
||||
struct iw_priv_args *priv_ptr;
|
||||
|
||||
if(ENABLE != is_softap_enabled()) {
|
||||
ret = eERR_BSS_NOT_STARTED;
|
||||
return ret;
|
||||
}
|
||||
|
||||
if(NULL == (iface = qsap_get_config_value(CONFIG_FILE, "interface", interface, (u32*)&len))) {
|
||||
LOGE("%s :interface error \n", __func__);
|
||||
return ret;
|
||||
}
|
||||
|
||||
/* Issue the stopbss command to driver */
|
||||
sock = socket(AF_INET, SOCK_DGRAM, 0);
|
||||
|
||||
if (sock < 0) {
|
||||
LOGE("Failed to open socket");
|
||||
return eERR_STOP_BSS;
|
||||
}
|
||||
|
||||
strncpy(wrq.ifr_name, iface, sizeof(wrq.ifr_name));
|
||||
wrq.u.data.length = sizeof(cmd);
|
||||
wrq.u.data.pointer = cmd;
|
||||
wrq.u.data.flags = 0;
|
||||
|
||||
ret = ioctl(sock, QCIEEE80211_IOCTL_STOPBSS, &wrq);
|
||||
|
||||
/* Here IOCTL is always returning non Zero: temporary fix untill driver is fixed*/
|
||||
ret = 0;
|
||||
close(sock);
|
||||
|
||||
if (ret) {
|
||||
LOGE("IOCTL stopbss failed: %ld", ret);
|
||||
ret = eERR_STOP_BSS;
|
||||
} else {
|
||||
LOGD("STOP BSS ISSUED");
|
||||
ret = eSUCCESS;
|
||||
}
|
||||
|
||||
sched_yield();
|
||||
return ret;
|
||||
}
|
||||
|
||||
s32 is_softap_enabled(void)
|
||||
{
|
||||
s8 stat[32] = {0};
|
||||
|
||||
if ( property_get("init.svc.hostapd", stat, NULL) &&
|
||||
(strcmp(stat, "running") == 0)) {
|
||||
LOGD("HOSTAPD enabled \n");
|
||||
return ENABLE;
|
||||
}
|
||||
|
||||
LOGD("HOSTAPD disabled \n");
|
||||
return DISABLE;
|
||||
}
|
||||
|
||||
s32 commit(void)
|
||||
{
|
||||
#ifndef SDK_TEST
|
||||
s32 ret = eERR_COMMIT;
|
||||
|
||||
if ( is_softap_enabled() ) {
|
||||
/** Stop BSS */
|
||||
if(eSUCCESS != (ret = wifi_qsap_stop_bss())) {
|
||||
LOGE("%s: stop bss failed \n", __func__);
|
||||
return ret;
|
||||
}
|
||||
sleep(1);
|
||||
}
|
||||
|
||||
ret = wifi_qsap_start_softap();
|
||||
|
||||
if( eSUCCESS != ret )
|
||||
wifi_qsap_unload_driver();
|
||||
|
||||
return ret;
|
||||
#else
|
||||
return eSUCCESS;
|
||||
#endif
|
||||
}
|
||||
|
||||
s32 wifi_qsap_start_softap()
|
||||
{
|
||||
s32 retry = 4;
|
||||
|
||||
LOGD("Starting Soft AP...\n");
|
||||
|
||||
/* Delete control interface if it was left over because of previous crash */
|
||||
if ( !is_softap_enabled() ) {
|
||||
qsap_del_ctrl_iface();
|
||||
}
|
||||
|
||||
while(--retry ) {
|
||||
/** Stop hostapd */
|
||||
if(0 != property_set("ctl.start", "hostapd")) {
|
||||
LOGE("failed \n");
|
||||
continue;
|
||||
}
|
||||
|
||||
sleep(1);
|
||||
|
||||
if ( is_softap_enabled() ) {
|
||||
LOGD("success \n");
|
||||
return eSUCCESS;
|
||||
}
|
||||
}
|
||||
|
||||
LOGE("Unable to start the SoftAP\n");
|
||||
return eERR_START_SAP;
|
||||
}
|
||||
|
||||
s32 wifi_qsap_stop_softap()
|
||||
{
|
||||
s32 ret = eSUCCESS;
|
||||
|
||||
if ( is_softap_enabled() ) {
|
||||
LOGD("Stopping BSS ..... ");
|
||||
|
||||
/** Stop the BSS */
|
||||
if (eSUCCESS != (ret = wifi_qsap_stop_bss()) ) {
|
||||
LOGE("failed \n");
|
||||
return ret;
|
||||
}
|
||||
sleep(1);
|
||||
}
|
||||
|
||||
return ret;
|
||||
}
|
||||
|
||||
s32 wifi_qsap_reload_softap()
|
||||
{
|
||||
s32 ret = eERR_RELOAD_SAP;
|
||||
|
||||
/** SDK API to reload the firmware */
|
||||
if (eSUCCESS != (ret = wifi_qsap_stop_softap())) {
|
||||
return ret;
|
||||
}
|
||||
|
||||
if (eSUCCESS != (ret = wifi_qsap_unload_driver())) {
|
||||
return ret;
|
||||
}
|
||||
|
||||
usleep(500000);
|
||||
|
||||
if (eSUCCESS != (ret = wifi_qsap_load_driver())) {
|
||||
return ret;
|
||||
}
|
||||
|
||||
sleep(1);
|
||||
|
||||
if (eSUCCESS != (ret = wifi_qsap_start_softap())) {
|
||||
wifi_qsap_unload_driver();
|
||||
return ret;
|
||||
}
|
||||
|
||||
return eSUCCESS;
|
||||
}
|
||||
|
||||
@@ -48,6 +48,7 @@
|
||||
#define QCSAP_IOCTL_GET_CHANNEL (SIOCIWFIRSTPRIV+9)
|
||||
#define QCSAP_IOCTL_ASSOC_STA_MACADDR (SIOCIWFIRSTPRIV+10)
|
||||
#define QCSAP_IOCTL_DISASSOC_STA (SIOCIWFIRSTPRIV+11)
|
||||
#define QCSAP_IOCTL_AP_STATS (SIOCIWFIRSTPRIV+12)
|
||||
|
||||
//#define LOG_TAG "QCSDK-"
|
||||
|
||||
@@ -134,6 +135,9 @@ static s8 *cmd_list[eCMD_LAST] = {
|
||||
"country_code",
|
||||
"intra_bss_forward",
|
||||
"regulatory_domain",
|
||||
"apstat",
|
||||
"auto_shut_off_time",
|
||||
"energy_detect_threshold",
|
||||
};
|
||||
|
||||
static s8 *qsap_str[eSTR_LAST] = {
|
||||
@@ -153,7 +157,9 @@ static s8 *qsap_str[eSTR_LAST] = {
|
||||
"ieee80211n",
|
||||
"ctrl_interface",
|
||||
"interface",
|
||||
"eap_server"
|
||||
"eap_server",
|
||||
"gAPAutoShutOff",
|
||||
"gEnablePhyAgcListenMode",
|
||||
};
|
||||
|
||||
/** Supported operating mode */
|
||||
@@ -775,7 +781,7 @@ static void qsap_remove_from_file(s8 *pfile, s8 *pVal, s8 *presp, u32 *plen)
|
||||
}
|
||||
|
||||
if(MAX_CONF_LINE_LEN == snprintf(buf, MAX_CONF_LINE_LEN, "%s~", pfile)) {
|
||||
buf[MAX_CONF_LINE_LEN] = '\0';
|
||||
buf[MAX_CONF_LINE_LEN-1] = '\0';
|
||||
}
|
||||
|
||||
/** Open a temporary file */
|
||||
@@ -827,7 +833,7 @@ static void qsap_remove_from_file(s8 *pfile, s8 *pVal, s8 *presp, u32 *plen)
|
||||
fclose(ftmp);
|
||||
|
||||
if(MAX_CONF_LINE_LEN == snprintf(buf, MAX_CONF_LINE_LEN, "%s~", pfile)) {
|
||||
buf[MAX_CONF_LINE_LEN] = '\0';
|
||||
buf[MAX_CONF_LINE_LEN-1] = '\0';
|
||||
}
|
||||
|
||||
/** Restore the configuration file */
|
||||
@@ -1106,6 +1112,10 @@ int qsap_get_operating_channel(s32 *pchan)
|
||||
s8 *pif;
|
||||
int ret;
|
||||
|
||||
if(ENABLE != is_softap_enabled()) {
|
||||
goto error;
|
||||
}
|
||||
|
||||
if(NULL == (pif = qsap_get_config_value(pconffile, qsap_str[STR_INTERFACE], interface, &len))) {
|
||||
LOGE("%s :interface error \n", __func__);
|
||||
goto error;
|
||||
@@ -1209,6 +1219,10 @@ void qsap_get_associated_sta_mac(s8 *presp, u32 *plen)
|
||||
u32 recvLen;
|
||||
u32 tlen;
|
||||
|
||||
if(ENABLE != is_softap_enabled()) {
|
||||
goto error;
|
||||
}
|
||||
|
||||
if(NULL == (pif = qsap_get_config_value(pconffile, qsap_str[STR_INTERFACE], interface, &len))) {
|
||||
LOGE("%s :interface error \n", __func__);
|
||||
goto error;
|
||||
@@ -1290,6 +1304,90 @@ static void qsap_read_wep_key(s8 *pfile, s8 *pcmd, s8 *presp, u32 *plen, s8 *var
|
||||
return;
|
||||
}
|
||||
|
||||
void qsap_read_ap_stats(s8 *presp, u32 *plen)
|
||||
{
|
||||
int sock, ret;
|
||||
struct iwreq wrq;
|
||||
s8 interface[MAX_CONF_LINE_LEN];
|
||||
u32 len = MAX_CONF_LINE_LEN;
|
||||
s8 *pif;
|
||||
s8 *pbuf, *pout;
|
||||
u32 recvLen;
|
||||
u32 tlen;
|
||||
|
||||
if(ENABLE != is_softap_enabled()) {
|
||||
*plen = snprintf(presp, *plen, "%s", ERR_SOFTAP_NOT_STARTED);
|
||||
return;
|
||||
}
|
||||
|
||||
if(NULL == (pif = qsap_get_config_value(pconffile, qsap_str[STR_INTERFACE], interface, &len))) {
|
||||
LOGE("%s :interface error \n", __func__);
|
||||
goto error;
|
||||
}
|
||||
interface[len] = '\0';
|
||||
|
||||
sock = socket(AF_INET, SOCK_DGRAM, 0);
|
||||
if(sock < 0) {
|
||||
LOGE("%s :socket failure \n", __func__);
|
||||
goto error;
|
||||
}
|
||||
|
||||
pbuf = (s8 *)malloc(MAX_RESP_LEN);
|
||||
if(NULL == pbuf) {
|
||||
LOGE("%s :No memory \n", __func__);
|
||||
goto error;
|
||||
}
|
||||
|
||||
strncpy(wrq.ifr_name, pif, sizeof(wrq.ifr_name));
|
||||
wrq.u.data.length = MAX_RESP_LEN;
|
||||
wrq.u.data.pointer = (void *)pbuf;
|
||||
wrq.u.data.flags = 0;
|
||||
|
||||
ret = ioctl(sock, QCSAP_IOCTL_AP_STATS, &wrq);
|
||||
if(ret < 0) {
|
||||
LOGE("%s :ioctl failure \n", __func__);
|
||||
free(pbuf);
|
||||
goto error;
|
||||
}
|
||||
|
||||
if(*plen == (recvLen = snprintf(presp, *plen, "%s %s=%s", SUCCESS, cmd_list[eCMD_AP_STATISTICS], pbuf))){
|
||||
presp[recvLen-1] = '\0';
|
||||
}
|
||||
|
||||
*plen = recvLen;
|
||||
|
||||
free(pbuf);
|
||||
|
||||
return;
|
||||
|
||||
error:
|
||||
*plen = snprintf(presp, *plen, "%s", ERR_UNKNOWN);
|
||||
|
||||
return;
|
||||
}
|
||||
|
||||
void qsap_read_autoshutoff(s8 *presp, u32 *plen)
|
||||
{
|
||||
u32 tlen, time = 0;
|
||||
s8 *ptime;
|
||||
|
||||
tlen = *plen;
|
||||
|
||||
if(NULL == (ptime = qsap_get_config_value(fIni, qsap_str[STR_AP_AUTOSHUTOFF], presp, &tlen))) {
|
||||
/** unable to read the AP shutoff time */
|
||||
LOGE("%s :Failed to read AP shutoff time\n", __func__);
|
||||
}
|
||||
else {
|
||||
time = atoi(ptime);
|
||||
time = time / 60; /** Convert seconds to minutes */
|
||||
}
|
||||
|
||||
*plen = snprintf(presp, *plen, "success %s=%ld", cmd_list[eCMD_AP_AUTOSHUTOFF], time);
|
||||
|
||||
return;
|
||||
}
|
||||
|
||||
|
||||
/**
|
||||
* @brief
|
||||
* Get the configuration information from the softAP configuration
|
||||
@@ -1429,6 +1527,18 @@ static void qsap_get_from_config(esap_cmd_t cNum, s8 *presp, u32 *plen)
|
||||
qsap_read_cfg(fIni, qsap_str[STR_COUNTRY_CODE_IN_INI], presp, plen, cmd_list[eCMD_COUNTRY_CODE], GET_ENABLED_ONLY);
|
||||
break;
|
||||
|
||||
case eCMD_AP_STATISTICS:
|
||||
qsap_read_ap_stats(presp, plen);
|
||||
break;
|
||||
|
||||
case eCMD_AP_AUTOSHUTOFF:
|
||||
qsap_read_autoshutoff(presp, plen);
|
||||
break;
|
||||
|
||||
case eCMD_AP_ENERGY_DETECT_TH:
|
||||
qsap_read_cfg(fIni, qsap_str[STR_AP_ENERGY_DETECT_TH], presp, plen, cmd_list[eCMD_AP_ENERGY_DETECT_TH], GET_ENABLED_ONLY);
|
||||
break;
|
||||
|
||||
default:
|
||||
/** Error case */
|
||||
*plen = snprintf(presp, *plen, "%s", ERR_INVALID_ARG);
|
||||
@@ -1576,7 +1686,7 @@ static s16 wifi_qsap_reset_to_default(s8 *pcfgfile, s8 *pdefault)
|
||||
}
|
||||
|
||||
if(MAX_CONF_LINE_LEN == snprintf(buf, MAX_CONF_LINE_LEN, "%s~", pcfgfile)) {
|
||||
buf[MAX_CONF_LINE_LEN] = '\0';
|
||||
buf[MAX_CONF_LINE_LEN-1] = '\0';
|
||||
}
|
||||
|
||||
ftmp = fopen(buf, "w+");
|
||||
@@ -1594,7 +1704,7 @@ static s16 wifi_qsap_reset_to_default(s8 *pcfgfile, s8 *pdefault)
|
||||
fclose(ftmp);
|
||||
|
||||
if(MAX_CONF_LINE_LEN == snprintf(buf, MAX_CONF_LINE_LEN, "%s~", pcfgfile)) {
|
||||
buf[MAX_CONF_LINE_LEN] = '\0';
|
||||
buf[MAX_CONF_LINE_LEN-1] = '\0';
|
||||
}
|
||||
|
||||
if(eERR_UNKNOWN == rename(buf, pcfgfile))
|
||||
@@ -1607,6 +1717,39 @@ static s16 wifi_qsap_reset_to_default(s8 *pcfgfile, s8 *pdefault)
|
||||
}
|
||||
|
||||
#define CTRL_IFACE_PATH_LEN (128)
|
||||
|
||||
void qsap_del_ctrl_iface(void)
|
||||
{
|
||||
u32 len;
|
||||
s8 dst_path[CTRL_IFACE_PATH_LEN], *pcif, *pif;
|
||||
s8 interface[64];
|
||||
s8 path[CTRL_IFACE_PATH_LEN + 64];
|
||||
|
||||
len = CTRL_IFACE_PATH_LEN;
|
||||
|
||||
if(NULL == (pcif = qsap_get_config_value(pconffile, qsap_str[STR_CTRL_INTERFACE], dst_path, &len))) {
|
||||
LOGE("%s :ctrl_iface path error \n", __func__);
|
||||
goto error;
|
||||
}
|
||||
|
||||
len = 64;
|
||||
|
||||
if(NULL == (pif = qsap_get_config_value(pconffile, qsap_str[STR_INTERFACE], interface, &len))) {
|
||||
LOGE("%s :interface error \n", __func__);
|
||||
goto error;
|
||||
}
|
||||
|
||||
if((int)sizeof(path) <= snprintf(path, sizeof(path)-1, "%s/%s", pcif, pif)) {
|
||||
LOGE("Iface path : error, %s \n", path);
|
||||
goto error;
|
||||
}
|
||||
|
||||
unlink(path);
|
||||
|
||||
error:
|
||||
return;
|
||||
}
|
||||
|
||||
static int qsap_send_cmd_to_hostapd(s8 *pcmd)
|
||||
{
|
||||
int sock;
|
||||
@@ -1895,6 +2038,10 @@ void qsap_disassociate_sta(s8 *pVal, s8 *presp, u32 *plen)
|
||||
u32 len = MAX_CONF_LINE_LEN;
|
||||
s8 *pif;
|
||||
|
||||
if(ENABLE != is_softap_enabled()) {
|
||||
goto end;
|
||||
}
|
||||
|
||||
if(NULL == (pif = qsap_get_config_value(pconffile, qsap_str[STR_INTERFACE], pbuf, &len))) {
|
||||
LOGE("%s :interface error \n", __func__);
|
||||
goto end;
|
||||
@@ -2561,6 +2708,26 @@ static void qsap_handle_set_request(s8 *pcmd, s8 *presp, u32 *plen)
|
||||
ini = INI_CONF_FILE;
|
||||
break;
|
||||
|
||||
case eCMD_AP_AUTOSHUTOFF:
|
||||
value = atoi(pVal);
|
||||
if(TRUE != IS_VALID_APSHUTOFFTIME(value))
|
||||
goto error;
|
||||
|
||||
snprintf(pVal, MAX_INT_STR, "%ld", value*60);
|
||||
cNum = STR_AP_AUTOSHUTOFF;
|
||||
ini = INI_CONF_FILE;
|
||||
break;
|
||||
|
||||
case eCMD_AP_ENERGY_DETECT_TH:
|
||||
value = atoi(pVal);
|
||||
if(TRUE != IS_VALID_ENERGY_DETECT_TH(value))
|
||||
goto error;
|
||||
|
||||
snprintf(pVal, MAX_INT_STR, "%ld", value);
|
||||
cNum = STR_AP_ENERGY_DETECT_TH;
|
||||
ini = INI_CONF_FILE;
|
||||
break;
|
||||
|
||||
default: ;
|
||||
/** Do not goto error, in default case */
|
||||
}
|
||||
|
||||
File diff suppressed because it is too large
Load Diff
Reference in New Issue
Block a user