/*
|
* Copyright 2016, The Android Open Source Project
|
*
|
* Licensed under the Apache License, Version 2.0 (the "License");
|
* you may not use this file except in compliance with the License.
|
* You may obtain a copy of the License at
|
*
|
* http://www.apache.org/licenses/LICENSE-2.0
|
*
|
* Unless required by applicable law or agreed to in writing, software
|
* distributed under the License is distributed on an "AS IS" BASIS,
|
* WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied.
|
* See the License for the specific language governing permissions and
|
* limitations under the License.
|
*/
|
|
#include "hardware_legacy/wifi.h"
|
|
#include <fcntl.h>
|
#include <stdlib.h>
|
#include <unistd.h>
|
|
#include <android-base/logging.h>
|
#include <cutils/misc.h>
|
#include <cutils/properties.h>
|
#include <sys/syscall.h>
|
|
extern "C" int init_module(void *, unsigned long, const char *);
|
extern "C" int delete_module(const char *, unsigned int);
|
|
#ifndef WIFI_DRIVER_FW_PATH_STA
|
#define WIFI_DRIVER_FW_PATH_STA NULL
|
#endif
|
#ifndef WIFI_DRIVER_FW_PATH_AP
|
#define WIFI_DRIVER_FW_PATH_AP NULL
|
#endif
|
#ifndef WIFI_DRIVER_FW_PATH_P2P
|
#define WIFI_DRIVER_FW_PATH_P2P NULL
|
#endif
|
|
#ifndef WIFI_DRIVER_MODULE_ARG
|
#define WIFI_DRIVER_MODULE_ARG ""
|
#endif
|
|
static const char DRIVER_PROP_NAME[] = "wlan.driver.status";
|
static bool is_driver_loaded = false;
|
#ifdef WIFI_DRIVER_MODULE_PATH
|
#ifndef BOARD_WIFI_VENDOR_COMMON
|
static const char DRIVER_MODULE_NAME[] = WIFI_DRIVER_MODULE_NAME;
|
static const char DRIVER_MODULE_TAG[] = WIFI_DRIVER_MODULE_NAME " ";
|
static const char DRIVER_MODULE_PATH[] = WIFI_DRIVER_MODULE_PATH;
|
static const char DRIVER_MODULE_ARG[] = WIFI_DRIVER_MODULE_ARG;
|
static const char MODULE_FILE[] = "/proc/modules";
|
#endif
|
#endif
|
|
#include "wifi_hal_hook.h"
|
|
static int insmod(const char *filename, const char *args) {
|
int ret;
|
int fd;
|
|
fd = TEMP_FAILURE_RETRY(open(filename, O_RDONLY | O_CLOEXEC | O_NOFOLLOW));
|
if (fd < 0) {
|
PLOG(ERROR) << "Failed to open " << filename;
|
return -1;
|
}
|
|
ret = syscall(__NR_finit_module, fd, args, 0);
|
|
close(fd);
|
if (ret < 0) {
|
PLOG(ERROR) << "finit_module return: " << ret;
|
}
|
|
return ret;
|
}
|
|
static int rmmod(const char *modname) {
|
int ret = -1;
|
int maxtry = 10;
|
|
while (maxtry-- > 0) {
|
ret = delete_module(modname, O_NONBLOCK | O_EXCL);
|
if (ret < 0 && errno == EAGAIN)
|
usleep(500000);
|
else
|
break;
|
}
|
|
if (ret != 0)
|
PLOG(DEBUG) << "Unable to unload driver module '" << modname << "'";
|
return ret;
|
}
|
|
#ifdef WIFI_DRIVER_STATE_CTRL_PARAM
|
int wifi_change_driver_state(const char *state) {
|
int len;
|
int fd;
|
int ret = 0;
|
|
if (!state) return -1;
|
fd = TEMP_FAILURE_RETRY(open(WIFI_DRIVER_STATE_CTRL_PARAM, O_WRONLY));
|
if (fd < 0) {
|
PLOG(ERROR) << "Failed to open driver state control param";
|
return -1;
|
}
|
len = strlen(state) + 1;
|
if (TEMP_FAILURE_RETRY(write(fd, state, len)) != len) {
|
PLOG(ERROR) << "Failed to write driver state control param";
|
ret = -1;
|
}
|
close(fd);
|
return ret;
|
}
|
#endif
|
|
int is_wifi_driver_loaded() {
|
char driver_status[PROPERTY_VALUE_MAX];
|
#ifdef WIFI_DRIVER_MODULE_PATH
|
FILE *proc;
|
char line[sizeof(DRIVER_MODULE_TAG) + 20];
|
#endif
|
|
if (!property_get(DRIVER_PROP_NAME, driver_status, NULL)) {
|
return 0; /* driver not loaded */
|
}
|
|
if (!is_driver_loaded) {
|
/*
|
* If thread exit abnormal, dure to "is_driver_loaded" cannot
|
* hold it's value before, we cannot get driver real status
|
* from it. Here we just print some debug info rather than
|
* return.
|
return 0;
|
*/
|
LOG(INFO) << "Driver " << DRIVER_MODULE_NAME \
|
<< " not load? I'm not sure.";
|
} /* driver not loaded */
|
|
#ifdef WIFI_DRIVER_MODULE_PATH
|
/*
|
* If the property says the driver is loaded, check to
|
* make sure that the property setting isn't just left
|
* over from a previous manual shutdown or a runtime
|
* crash.
|
*/
|
if ((proc = fopen(MODULE_FILE, "r")) == NULL) {
|
PLOG(WARNING) << "Could not open " << MODULE_FILE;
|
is_driver_loaded = false;
|
if (strcmp(driver_status, "unloaded") != 0) {
|
property_set(DRIVER_PROP_NAME, "unloaded");
|
}
|
return 0;
|
}
|
while ((fgets(line, sizeof(line), proc)) != NULL) {
|
if (strncmp(line, DRIVER_MODULE_TAG, strlen(DRIVER_MODULE_TAG)) == 0) {
|
fclose(proc);
|
return 1;
|
}
|
}
|
fclose(proc);
|
is_driver_loaded = false;
|
if (strcmp(driver_status, "unloaded") != 0) {
|
property_set(DRIVER_PROP_NAME, "unloaded");
|
}
|
return 0;
|
#else
|
return 1;
|
#endif
|
}
|
|
int wifi_load_driver() {
|
#ifdef WIFI_DRIVER_MODULE_PATH
|
if (is_wifi_driver_loaded()) {
|
return 0;
|
}
|
|
if (insmod(DRIVER_MODULE_PATH, DRIVER_MODULE_ARG) < 0) return -1;
|
#endif
|
|
#ifdef WIFI_DRIVER_STATE_CTRL_PARAM
|
if (is_wifi_driver_loaded()) {
|
return 0;
|
}
|
|
if (wifi_change_driver_state(WIFI_DRIVER_STATE_ON) < 0) {
|
#ifdef WIFI_DRIVER_MODULE_PATH
|
PLOG(WARNING) << "Driver unloading, err='fail to change driver state'";
|
if (rmmod(DRIVER_MODULE_NAME) == 0) {
|
PLOG(DEBUG) << "Driver unloaded";
|
} else {
|
// Set driver prop to "ok", expect HL to restart Wi-Fi.
|
PLOG(DEBUG) << "Driver unload failed! set driver prop to 'ok'.";
|
property_set(DRIVER_PROP_NAME, "ok");
|
}
|
#endif
|
return -1;
|
}
|
#endif
|
is_driver_loaded = true;
|
return 0;
|
}
|
|
int wifi_unload_driver() {
|
if (!is_wifi_driver_loaded()) {
|
return 0;
|
}
|
#ifdef WIFI_DRIVER_MODULE_PATH
|
if (rmmod(DRIVER_MODULE_NAME) == 0) {
|
int count = 20; /* wait at most 10 seconds for completion */
|
while (count-- > 0) {
|
if (!is_wifi_driver_loaded()) break;
|
usleep(500000);
|
}
|
usleep(500000); /* allow card removal */
|
if (count) {
|
return 0;
|
}
|
return -1;
|
} else
|
return -1;
|
#else
|
#ifdef WIFI_DRIVER_STATE_CTRL_PARAM
|
if (is_wifi_driver_loaded()) {
|
if (wifi_change_driver_state(WIFI_DRIVER_STATE_OFF) < 0) return -1;
|
}
|
#endif
|
is_driver_loaded = false;
|
property_set(DRIVER_PROP_NAME, "unloaded");
|
return 0;
|
#endif
|
}
|
|
const char *wifi_get_fw_path(int fw_type) {
|
switch (fw_type) {
|
case WIFI_GET_FW_PATH_STA:
|
return WIFI_DRIVER_FW_PATH_STA;
|
case WIFI_GET_FW_PATH_AP:
|
return WIFI_DRIVER_FW_PATH_AP;
|
case WIFI_GET_FW_PATH_P2P:
|
return WIFI_DRIVER_FW_PATH_P2P;
|
}
|
return NULL;
|
}
|
|
int wifi_change_fw_path(const char *fwpath) {
|
int len;
|
int fd;
|
int ret = 0;
|
|
if (!fwpath) return ret;
|
fd = TEMP_FAILURE_RETRY(open(WIFI_DRIVER_FW_PATH_PARAM, O_WRONLY));
|
if (fd < 0) {
|
PLOG(ERROR) << "Failed to open wlan fw path param";
|
return -1;
|
}
|
len = strlen(fwpath) + 1;
|
if (TEMP_FAILURE_RETRY(write(fd, fwpath, len)) != len) {
|
PLOG(ERROR) << "Failed to write wlan fw path param";
|
ret = -1;
|
}
|
close(fd);
|
return ret;
|
}
|
