/*
* Copyright (C) 2008 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 <stdlib.h>
#include <errno.h>
#include <fcntl.h>
#include <string.h>
#include <sys/socket.h>
#include <sys/stat.h>
#include <sys/ioctl.h>
#include <sys/types.h>
#include <sys/wait.h>
#include <netinet/in.h>
#include <arpa/inet.h>
#include <linux/wireless.h>
#include <openssl/evp.h>
#include <openssl/sha.h>
#define LOG_TAG "SoftapController"
#include <cutils/log.h>
#include <netutils/ifc.h>
#include <private/android_filesystem_config.h>
#include "wifi.h"
#include "SoftapController.h"
static const char HOSTAPD_CONF_FILE[] = "/data/misc/wifi/hostapd.conf";
SoftapController::SoftapController() {
mPid = 0;
mSock = socket(AF_INET, SOCK_DGRAM, 0);
if (mSock < 0)
ALOGE("Failed to open socket");
memset(mIface, 0, sizeof(mIface));
}
SoftapController::~SoftapController() {
if (mSock >= 0)
close(mSock);
}
int SoftapController::setCommand(char *iface, const char *fname, unsigned buflen) {
#ifdef HAVE_HOSTAPD
return 0;
#else
char tBuf[SOFTAP_MAX_BUFFER_SIZE];
struct iwreq wrq;
struct iw_priv_args *priv_ptr;
int i, j, ret;
int cmd = 0, sub_cmd = 0;
strncpy(wrq.ifr_name, iface, sizeof(wrq.ifr_name));
wrq.u.data.pointer = tBuf;
wrq.u.data.length = sizeof(tBuf) / sizeof(struct iw_priv_args);
wrq.u.data.flags = 0;
if ((ret = ioctl(mSock, SIOCGIWPRIV, &wrq)) < 0) {
ALOGE("SIOCGIPRIV failed: %d", ret);
return ret;
}
priv_ptr = (struct iw_priv_args *)wrq.u.data.pointer;
for(i=0; i < wrq.u.data.length;i++) {
if (strcmp(priv_ptr[i].name, fname) == 0) {
cmd = priv_ptr[i].cmd;
break;
}
}
if (i == wrq.u.data.length) {
ALOGE("iface:%s, fname: %s - function not supported", iface, fname);
return -1;
}
if (cmd < SIOCDEVPRIVATE) {
for(j=0; j < i; j++) {
if ((priv_ptr[j].set_args == priv_ptr[i].set_args) &&
(priv_ptr[j].get_args == priv_ptr[i].get_args) &&
(priv_ptr[j].name[0] == '\0'))
break;
}
if (j == i) {
ALOGE("iface:%s, fname: %s - invalid private ioctl", iface, fname);
return -1;
}
sub_cmd = cmd;
cmd = priv_ptr[j].cmd;
}
strncpy(wrq.ifr_name, iface, sizeof(wrq.ifr_name));
if ((buflen == 0) && (*mBuf != 0))
wrq.u.data.length = strlen(mBuf) + 1;
else
wrq.u.data.length = buflen;
wrq.u.data.pointer = mBuf;
wrq.u.data.flags = sub_cmd;
ret = ioctl(mSock, cmd, &wrq);
return ret;
#endif
}
int SoftapController::startDriver(char *iface) {
int ret;
if (mSock < 0) {
ALOGE("Softap driver start - failed to open socket");
return -1;
}
if (!iface || (iface[0] == '\0')) {
ALOGD("Softap driver start - wrong interface");
iface = mIface;
}
*mBuf = 0;
ret = setCommand(iface, "START");
if (ret < 0) {
ALOGE("Softap driver start: %d", ret);
return ret;
}
#ifdef HAVE_HOSTAPD
ifc_init();
ret = ifc_up(iface);
ifc_close();
#endif
usleep(AP_DRIVER_START_DELAY);
ALOGD("Softap driver start: %d", ret);
return ret;
}
int SoftapController::stopDriver(char *iface) {
int ret;
if (mSock < 0) {
ALOGE("Softap driver stop - failed to open socket");
return -1;
}
if (!iface || (iface[0] == '\0')) {
ALOGD("Softap driver stop - wrong interface");
iface = mIface;
}
*mBuf = 0;
#ifdef HAVE_HOSTAPD
ifc_init();
ret = ifc_down(iface);
ifc_close();
if (ret < 0) {
ALOGE("Softap %s down: %d", iface, ret);
}
#endif
ret = setCommand(iface, "STOP");
ALOGD("Softap driver stop: %d", ret);
return ret;
}
int SoftapController::startSoftap() {
pid_t pid = 1;
int ret = 0;
if (mPid) {
ALOGE("Softap already started");
return 0;
}
if (mSock < 0) {
ALOGE("Softap startap - failed to open socket");
return -1;
}
#ifdef HAVE_HOSTAPD
if ((pid = fork()) < 0) {
ALOGE("fork failed (%s)", strerror(errno));
return -1;
}
#endif
if (!pid) {
#ifdef HAVE_HOSTAPD
ensure_entropy_file_exists();
if (execl("/system/bin/hostapd", "/system/bin/hostapd",
"-e", WIFI_ENTROPY_FILE,
HOSTAPD_CONF_FILE, (char *) NULL)) {
ALOGE("execl failed (%s)", strerror(errno));
}
#endif
ALOGE("Should never get here!");
return -1;
} else {
*mBuf = 0;
ret = setCommand(mIface, "AP_BSS_START");
if (ret) {
ALOGE("Softap startap - failed: %d", ret);
}
else {
mPid = pid;
ALOGD("Softap startap - Ok");
usleep(AP_BSS_START_DELAY);
}
}
return ret;
}
int SoftapController::stopSoftap() {
int ret;
if (mPid == 0) {
ALOGE("Softap already stopped");
return 0;
}
#ifdef HAVE_HOSTAPD
ALOGD("Stopping Softap service");
kill(mPid, SIGTERM);
waitpid(mPid, NULL, 0);
#endif
if (mSock < 0) {
ALOGE("Softap stopap - failed to open socket");
return -1;
}
*mBuf = 0;
ret = setCommand(mIface, "AP_BSS_STOP");
mPid = 0;
ALOGD("Softap service stopped: %d", ret);
usleep(AP_BSS_STOP_DELAY);
return ret;
}
bool SoftapController::isSoftapStarted() {
return (mPid != 0 ? true : false);
}
int SoftapController::addParam(int pos, const char *cmd, const char *arg)
{
if (pos < 0)
return pos;
if ((unsigned)(pos + strlen(cmd) + strlen(arg) + 1) >= sizeof(mBuf)) {
ALOGE("Command line is too big");
return -1;
}
pos += sprintf(&mBuf[pos], "%s=%s,", cmd, arg);
return pos;
}
/*
* Arguments:
* argv[2] - wlan interface
* argv[3] - softap interface
* argv[4] - SSID
* argv[5] - Security
* argv[6] - Key
* argv[7] - Channel
* argv[8] - Preamble
* argv[9] - Max SCB
*/
int SoftapController::setSoftap(int argc, char *argv[]) {
char psk_str[2*SHA256_DIGEST_LENGTH+1];
int ret = 0, i = 0, fd;
char *ssid, *iface;
if (mSock < 0) {
ALOGE("Softap set - failed to open socket");
return -1;
}
if (argc < 4) {
ALOGE("Softap set - missing arguments");
return -1;
}
strncpy(mIface, argv[3], sizeof(mIface));
iface = argv[2];
#ifdef HAVE_HOSTAPD
char *wbuf = NULL;
char *fbuf = NULL;
if (argc > 4) {
ssid = argv[4];
} else {
ssid = (char *)"AndroidAP";
}
asprintf(&wbuf, "interface=%s\ndriver=nl80211\nctrl_interface="
"/data/misc/wifi/hostapd\nssid=%s\nchannel=6\nieee80211n=1\n",
iface, ssid);
if (argc > 5) {
if (!strcmp(argv[5], "wpa-psk")) {
generatePsk(ssid, argv[6], psk_str);
asprintf(&fbuf, "%swpa=1\nwpa_pairwise=TKIP CCMP\nwpa_psk=%s\n", wbuf, psk_str);
} else if (!strcmp(argv[5], "wpa2-psk")) {
generatePsk(ssid, argv[6], psk_str);
asprintf(&fbuf, "%swpa=2\nrsn_pairwise=CCMP\nwpa_psk=%s\n", wbuf, psk_str);
} else if (!strcmp(argv[5], "open")) {
asprintf(&fbuf, "%s", wbuf);
}
} else {
asprintf(&fbuf, "%s", wbuf);
}
fd = open(HOSTAPD_CONF_FILE, O_CREAT | O_TRUNC | O_WRONLY, 0660);
if (fd < 0) {
ALOGE("Cannot update \"%s\": %s", HOSTAPD_CONF_FILE, strerror(errno));
free(wbuf);
free(fbuf);
return -1;
}
if (write(fd, fbuf, strlen(fbuf)) < 0) {
ALOGE("Cannot write to \"%s\": %s", HOSTAPD_CONF_FILE, strerror(errno));
ret = -1;
}
close(fd);
free(wbuf);
free(fbuf);
/* Note: apparently open can fail to set permissions correctly at times */
if (chmod(HOSTAPD_CONF_FILE, 0660) < 0) {
ALOGE("Error changing permissions of %s to 0660: %s",
HOSTAPD_CONF_FILE, strerror(errno));
unlink(HOSTAPD_CONF_FILE);
return -1;
}
if (chown(HOSTAPD_CONF_FILE, AID_SYSTEM, AID_WIFI) < 0) {
ALOGE("Error changing group ownership of %s to %d: %s",
HOSTAPD_CONF_FILE, AID_WIFI, strerror(errno));
unlink(HOSTAPD_CONF_FILE);
return -1;
}
#else
/* Create command line */
i = addParam(i, "ASCII_CMD", "AP_CFG");
if (argc > 4) {
ssid = argv[4];
} else {
ssid = (char *)"AndroidAP";
}
i = addParam(i, "SSID", ssid);
if (argc > 5) {
i = addParam(i, "SEC", argv[5]);
} else {
i = addParam(i, "SEC", "open");
}
if (argc > 6) {
generatePsk(ssid, argv[6], psk_str);
i = addParam(i, "KEY", psk_str);
} else {
i = addParam(i, "KEY", "12345678");
}
if (argc > 7) {
i = addParam(i, "CHANNEL", argv[7]);
} else {
i = addParam(i, "CHANNEL", "6");
}
if (argc > 8) {
i = addParam(i, "PREAMBLE", argv[8]);
} else {
i = addParam(i, "PREAMBLE", "0");
}
if (argc > 9) {
i = addParam(i, "MAX_SCB", argv[9]);
} else {
i = addParam(i, "MAX_SCB", "8");
}
if ((i < 0) || ((unsigned)(i + 4) >= sizeof(mBuf))) {
ALOGE("Softap set - command is too big");
return i;
}
sprintf(&mBuf[i], "END");
/* system("iwpriv eth0 WL_AP_CFG ASCII_CMD=AP_CFG,SSID=\"AndroidAP\",SEC=\"open\",KEY=12345,CHANNEL=1,PREAMBLE=0,MAX_SCB=8,END"); */
ret = setCommand(iface, "AP_SET_CFG");
if (ret) {
ALOGE("Softap set - failed: %d", ret);
}
else {
ALOGD("Softap set - Ok");
usleep(AP_SET_CFG_DELAY);
}
#endif
return ret;
}
void SoftapController::generatePsk(char *ssid, char *passphrase, char *psk_str) {
unsigned char psk[SHA256_DIGEST_LENGTH];
int j;
// Use the PKCS#5 PBKDF2 with 4096 iterations
PKCS5_PBKDF2_HMAC_SHA1(passphrase, strlen(passphrase),
reinterpret_cast<const unsigned char *>(ssid), strlen(ssid),
4096, SHA256_DIGEST_LENGTH, psk);
for (j=0; j < SHA256_DIGEST_LENGTH; j++) {
sprintf(&psk_str[j<<1], "%02x", psk[j]);
}
psk_str[j<<1] = '\0';
}
/*
* Arguments:
* argv[2] - interface name
* argv[3] - AP or STA
*/
int SoftapController::fwReloadSoftap(int argc, char *argv[])
{
int ret, i = 0;
char *iface;
char *fwpath;
if (mSock < 0) {
ALOGE("Softap fwrealod - failed to open socket");
return -1;
}
if (argc < 4) {
ALOGE("Softap fwreload - missing arguments");
return -1;
}
iface = argv[2];
if (strcmp(argv[3], "AP") == 0) {
fwpath = (char *)wifi_get_fw_path(WIFI_GET_FW_PATH_AP);
} else if (strcmp(argv[3], "P2P") == 0) {
fwpath = (char *)wifi_get_fw_path(WIFI_GET_FW_PATH_P2P);
} else {
fwpath = (char *)wifi_get_fw_path(WIFI_GET_FW_PATH_STA);
}
if (!fwpath)
return -1;
#ifdef HAVE_HOSTAPD
ret = wifi_change_fw_path((const char *)fwpath);
#else
sprintf(mBuf, "FW_PATH=%s", fwpath);
ret = setCommand(iface, "WL_FW_RELOAD");
#endif
if (ret) {
ALOGE("Softap fwReload - failed: %d", ret);
}
else {
ALOGD("Softap fwReload - Ok");
}
return ret;
}
int SoftapController::clientsSoftap(char **retbuf)
{
int ret;
if (mSock < 0) {
ALOGE("Softap clients - failed to open socket");
return -1;
}
*mBuf = 0;
ret = setCommand(mIface, "AP_GET_STA_LIST", SOFTAP_MAX_BUFFER_SIZE);
if (ret) {
ALOGE("Softap clients - failed: %d", ret);
} else {
asprintf(retbuf, "Softap clients:%s", mBuf);
ALOGD("Softap clients:%s", mBuf);
}
return ret;
}