/*
* 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 <sys/socket.h>
#include <sys/stat.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 "SoftapController.h"
SoftapController::SoftapController() {
mPid = 0;
mSock = socket(AF_INET, SOCK_DGRAM, 0);
if (mSock < 0)
LOGE("Failed to open socket");
memset(mIface, 0, sizeof(mIface));
}
SoftapController::~SoftapController() {
if (mSock >= 0)
close(mSock);
}
int SoftapController::getPrivFuncNum(char *iface, const char *fname) {
struct iwreq wrq;
struct iw_priv_args *priv_ptr;
int i, ret;
strncpy(wrq.ifr_name, iface, sizeof(wrq.ifr_name));
wrq.u.data.pointer = mBuf;
wrq.u.data.length = sizeof(mBuf) / sizeof(struct iw_priv_args);
wrq.u.data.flags = 0;
if ((ret = ioctl(mSock, SIOCGIWPRIV, &wrq)) < 0) {
LOGE("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)
return priv_ptr[i].cmd;
}
return -1;
}
int SoftapController::startDriver(char *iface) {
struct iwreq wrq;
int fnum, ret;
if (mSock < 0) {
LOGE("Softap driver start - failed to open socket");
return -1;
}
if (!iface || (iface[0] == '\0')) {
LOGD("Softap driver start - wrong interface");
iface = mIface;
}
fnum = getPrivFuncNum(iface, "START");
if (fnum < 0) {
LOGE("Softap driver start - function not supported");
return -1;
}
strncpy(wrq.ifr_name, iface, sizeof(wrq.ifr_name));
wrq.u.data.length = 0;
wrq.u.data.pointer = mBuf;
wrq.u.data.flags = 0;
ret = ioctl(mSock, fnum, &wrq);
usleep(AP_DRIVER_START_DELAY);
LOGD("Softap driver start: %d", ret);
return ret;
}
int SoftapController::stopDriver(char *iface) {
struct iwreq wrq;
int fnum, ret;
if (mSock < 0) {
LOGE("Softap driver stop - failed to open socket");
return -1;
}
if (!iface || (iface[0] == '\0')) {
LOGD("Softap driver stop - wrong interface");
iface = mIface;
}
fnum = getPrivFuncNum(iface, "STOP");
if (fnum < 0) {
LOGE("Softap driver stop - function not supported");
return -1;
}
strncpy(wrq.ifr_name, iface, sizeof(wrq.ifr_name));
wrq.u.data.length = 0;
wrq.u.data.pointer = mBuf;
wrq.u.data.flags = 0;
ret = ioctl(mSock, fnum, &wrq);
LOGD("Softap driver stop: %d", ret);
return ret;
}
int SoftapController::startSoftap() {
struct iwreq wrq;
pid_t pid = 1;
int fnum, ret = 0;
if (mPid) {
LOGE("Softap already started");
return 0;
}
if (mSock < 0) {
LOGE("Softap startap - failed to open socket");
return -1;
}
#if 0
if ((pid = fork()) < 0) {
LOGE("fork failed (%s)", strerror(errno));
return -1;
}
#endif
/* system("iwpriv wl0.1 AP_BSS_START"); */
if (!pid) {
/* start hostapd */
return ret;
} else {
fnum = getPrivFuncNum(mIface, "AP_BSS_START");
if (fnum < 0) {
LOGE("Softap startap - function not supported");
return -1;
}
strncpy(wrq.ifr_name, mIface, sizeof(wrq.ifr_name));
wrq.u.data.length = 0;
wrq.u.data.pointer = mBuf;
wrq.u.data.flags = 0;
ret = ioctl(mSock, fnum, &wrq);
if (ret) {
LOGE("Softap startap - failed: %d", ret);
}
else {
mPid = pid;
LOGD("Softap startap - Ok");
usleep(AP_BSS_START_DELAY);
}
}
return ret;
}
int SoftapController::stopSoftap() {
struct iwreq wrq;
int fnum, ret;
if (mPid == 0) {
LOGE("Softap already stopped");
return 0;
}
if (mSock < 0) {
LOGE("Softap stopap - failed to open socket");
return -1;
}
fnum = getPrivFuncNum(mIface, "AP_BSS_STOP");
if (fnum < 0) {
LOGE("Softap stopap - function not supported");
return -1;
}
strncpy(wrq.ifr_name, mIface, sizeof(wrq.ifr_name));
wrq.u.data.length = 0;
wrq.u.data.pointer = mBuf;
wrq.u.data.flags = 0;
ret = ioctl(mSock, fnum, &wrq);
#if 0
LOGD("Stopping Softap service");
kill(mPid, SIGTERM);
waitpid(mPid, NULL, 0);
#endif
mPid = 0;
LOGD("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)) {
LOGE("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[]) {
unsigned char psk[SHA256_DIGEST_LENGTH];
char psk_str[2*SHA256_DIGEST_LENGTH+1];
struct iwreq wrq;
int fnum, ret, i = 0;
char *ssid;
if (mSock < 0) {
LOGE("Softap set - failed to open socket");
return -1;
}
if (argc < 4) {
LOGE("Softap set - missing arguments");
return -1;
}
fnum = getPrivFuncNum(argv[2], "AP_SET_CFG");
if (fnum < 0) {
LOGE("Softap set - function not supported");
return -1;
}
strncpy(mIface, argv[3], sizeof(mIface));
strncpy(wrq.ifr_name, argv[2], sizeof(wrq.ifr_name));
/* 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) {
int j;
// Use the PKCS#5 PBKDF2 with 4096 iterations
PKCS5_PBKDF2_HMAC_SHA1(argv[6], strlen(argv[6]),
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';
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))) {
LOGE("Softap set - command is too big");
return i;
}
sprintf(&mBuf[i], "END");
wrq.u.data.length = strlen(mBuf) + 1;
wrq.u.data.pointer = mBuf;
wrq.u.data.flags = 0;
/* 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 = ioctl(mSock, fnum, &wrq);
if (ret) {
LOGE("Softap set - failed: %d", ret);
}
else {
LOGD("Softap set - Ok");
usleep(AP_SET_CFG_DELAY);
}
return ret;
}
/*
* Arguments:
* argv[2] - interface name
* argv[3] - AP or STA
*/
int SoftapController::fwReloadSoftap(int argc, char *argv[])
{
struct iwreq wrq;
int fnum, ret, i = 0;
char *iface;
if (mSock < 0) {
LOGE("Softap fwrealod - failed to open socket");
return -1;
}
if (argc < 4) {
LOGE("Softap fwreload - missing arguments");
return -1;
}
iface = argv[2];
fnum = getPrivFuncNum(iface, "WL_FW_RELOAD");
if (fnum < 0) {
LOGE("Softap fwReload - function not supported");
return -1;
}
if (strcmp(argv[3], "AP") == 0) {
#ifdef WIFI_DRIVER_FW_AP_PATH
sprintf(mBuf, "FW_PATH=%s", WIFI_DRIVER_FW_AP_PATH);
#endif
} else {
#ifdef WIFI_DRIVER_FW_STA_PATH
sprintf(mBuf, "FW_PATH=%s", WIFI_DRIVER_FW_STA_PATH);
#endif
}
strncpy(wrq.ifr_name, iface, sizeof(wrq.ifr_name));
wrq.u.data.length = strlen(mBuf) + 1;
wrq.u.data.pointer = mBuf;
wrq.u.data.flags = 0;
ret = ioctl(mSock, fnum, &wrq);
if (ret) {
LOGE("Softap fwReload - failed: %d", ret);
}
else {
LOGD("Softap fwReload - Ok");
}
return ret;
}