SoftapController.cpp revision fbd11c41aeb535723b78a61087fb436e64891055
15af38c360587ca2eef0badf6137ccf018f8cd4aaDmitry Shmidt/* 25af38c360587ca2eef0badf6137ccf018f8cd4aaDmitry Shmidt * Copyright (C) 2008 The Android Open Source Project 35af38c360587ca2eef0badf6137ccf018f8cd4aaDmitry Shmidt * 45af38c360587ca2eef0badf6137ccf018f8cd4aaDmitry Shmidt * Licensed under the Apache License, Version 2.0 (the "License"); 55af38c360587ca2eef0badf6137ccf018f8cd4aaDmitry Shmidt * you may not use this file except in compliance with the License. 65af38c360587ca2eef0badf6137ccf018f8cd4aaDmitry Shmidt * You may obtain a copy of the License at 75af38c360587ca2eef0badf6137ccf018f8cd4aaDmitry Shmidt * 85af38c360587ca2eef0badf6137ccf018f8cd4aaDmitry Shmidt * http://www.apache.org/licenses/LICENSE-2.0 95af38c360587ca2eef0badf6137ccf018f8cd4aaDmitry Shmidt * 105af38c360587ca2eef0badf6137ccf018f8cd4aaDmitry Shmidt * Unless required by applicable law or agreed to in writing, software 115af38c360587ca2eef0badf6137ccf018f8cd4aaDmitry Shmidt * distributed under the License is distributed on an "AS IS" BASIS, 125af38c360587ca2eef0badf6137ccf018f8cd4aaDmitry Shmidt * WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied. 135af38c360587ca2eef0badf6137ccf018f8cd4aaDmitry Shmidt * See the License for the specific language governing permissions and 145af38c360587ca2eef0badf6137ccf018f8cd4aaDmitry Shmidt * limitations under the License. 155af38c360587ca2eef0badf6137ccf018f8cd4aaDmitry Shmidt */ 165af38c360587ca2eef0badf6137ccf018f8cd4aaDmitry Shmidt 175af38c360587ca2eef0badf6137ccf018f8cd4aaDmitry Shmidt#include <stdlib.h> 185af38c360587ca2eef0badf6137ccf018f8cd4aaDmitry Shmidt#include <errno.h> 195af38c360587ca2eef0badf6137ccf018f8cd4aaDmitry Shmidt#include <fcntl.h> 205af38c360587ca2eef0badf6137ccf018f8cd4aaDmitry Shmidt 215af38c360587ca2eef0badf6137ccf018f8cd4aaDmitry Shmidt#include <sys/socket.h> 225af38c360587ca2eef0badf6137ccf018f8cd4aaDmitry Shmidt#include <sys/stat.h> 235af38c360587ca2eef0badf6137ccf018f8cd4aaDmitry Shmidt#include <sys/types.h> 245af38c360587ca2eef0badf6137ccf018f8cd4aaDmitry Shmidt#include <sys/wait.h> 255af38c360587ca2eef0badf6137ccf018f8cd4aaDmitry Shmidt 265af38c360587ca2eef0badf6137ccf018f8cd4aaDmitry Shmidt#include <netinet/in.h> 275af38c360587ca2eef0badf6137ccf018f8cd4aaDmitry Shmidt#include <arpa/inet.h> 285af38c360587ca2eef0badf6137ccf018f8cd4aaDmitry Shmidt 2984c65a62fe7b053fed7f20274ca7379627a87b79Dmitry Shmidt#include <linux/wireless.h> 3084c65a62fe7b053fed7f20274ca7379627a87b79Dmitry Shmidt 31a2d7e3e7d6e3f163f06e522378c6e2bd5cee28f8Kenny Root#include <openssl/evp.h> 32a2d7e3e7d6e3f163f06e522378c6e2bd5cee28f8Kenny Root#include <openssl/sha.h> 33a2d7e3e7d6e3f163f06e522378c6e2bd5cee28f8Kenny Root 345af38c360587ca2eef0badf6137ccf018f8cd4aaDmitry Shmidt#define LOG_TAG "SoftapController" 355af38c360587ca2eef0badf6137ccf018f8cd4aaDmitry Shmidt#include <cutils/log.h> 365af38c360587ca2eef0badf6137ccf018f8cd4aaDmitry Shmidt 375af38c360587ca2eef0badf6137ccf018f8cd4aaDmitry Shmidt#include "SoftapController.h" 385af38c360587ca2eef0badf6137ccf018f8cd4aaDmitry Shmidt 395af38c360587ca2eef0badf6137ccf018f8cd4aaDmitry ShmidtSoftapController::SoftapController() { 405af38c360587ca2eef0badf6137ccf018f8cd4aaDmitry Shmidt mPid = 0; 4184c65a62fe7b053fed7f20274ca7379627a87b79Dmitry Shmidt mSock = socket(AF_INET, SOCK_DGRAM, 0); 4284c65a62fe7b053fed7f20274ca7379627a87b79Dmitry Shmidt if (mSock < 0) 4384c65a62fe7b053fed7f20274ca7379627a87b79Dmitry Shmidt LOGE("Failed to open socket"); 4484c65a62fe7b053fed7f20274ca7379627a87b79Dmitry Shmidt memset(mIface, 0, sizeof(mIface)); 455af38c360587ca2eef0badf6137ccf018f8cd4aaDmitry Shmidt} 465af38c360587ca2eef0badf6137ccf018f8cd4aaDmitry Shmidt 475af38c360587ca2eef0badf6137ccf018f8cd4aaDmitry ShmidtSoftapController::~SoftapController() { 4884c65a62fe7b053fed7f20274ca7379627a87b79Dmitry Shmidt if (mSock >= 0) 4984c65a62fe7b053fed7f20274ca7379627a87b79Dmitry Shmidt close(mSock); 5084c65a62fe7b053fed7f20274ca7379627a87b79Dmitry Shmidt} 5184c65a62fe7b053fed7f20274ca7379627a87b79Dmitry Shmidt 52fbd11c41aeb535723b78a61087fb436e64891055jmzhuint SoftapController::setCommand(char *iface, const char *fname) { 536665fb2adf78beddde21f7f3088a695646ca8c57Dmitry Shmidt char tBuf[SOFTAP_MAX_BUFFER_SIZE]; 5484c65a62fe7b053fed7f20274ca7379627a87b79Dmitry Shmidt struct iwreq wrq; 5584c65a62fe7b053fed7f20274ca7379627a87b79Dmitry Shmidt struct iw_priv_args *priv_ptr; 56fbd11c41aeb535723b78a61087fb436e64891055jmzhu int i, j, ret; 57fbd11c41aeb535723b78a61087fb436e64891055jmzhu int cmd = 0, sub_cmd = 0; 5884c65a62fe7b053fed7f20274ca7379627a87b79Dmitry Shmidt 5984c65a62fe7b053fed7f20274ca7379627a87b79Dmitry Shmidt strncpy(wrq.ifr_name, iface, sizeof(wrq.ifr_name)); 606665fb2adf78beddde21f7f3088a695646ca8c57Dmitry Shmidt wrq.u.data.pointer = tBuf; 616665fb2adf78beddde21f7f3088a695646ca8c57Dmitry Shmidt wrq.u.data.length = sizeof(tBuf) / sizeof(struct iw_priv_args); 6284c65a62fe7b053fed7f20274ca7379627a87b79Dmitry Shmidt wrq.u.data.flags = 0; 6384c65a62fe7b053fed7f20274ca7379627a87b79Dmitry Shmidt if ((ret = ioctl(mSock, SIOCGIWPRIV, &wrq)) < 0) { 6484c65a62fe7b053fed7f20274ca7379627a87b79Dmitry Shmidt LOGE("SIOCGIPRIV failed: %d", ret); 6584c65a62fe7b053fed7f20274ca7379627a87b79Dmitry Shmidt return ret; 6684c65a62fe7b053fed7f20274ca7379627a87b79Dmitry Shmidt } 67fbd11c41aeb535723b78a61087fb436e64891055jmzhu 6884c65a62fe7b053fed7f20274ca7379627a87b79Dmitry Shmidt priv_ptr = (struct iw_priv_args *)wrq.u.data.pointer; 69fbd11c41aeb535723b78a61087fb436e64891055jmzhu for(i=0; i < wrq.u.data.length;i++) { 70fbd11c41aeb535723b78a61087fb436e64891055jmzhu if (strcmp(priv_ptr[i].name, fname) == 0) { 71fbd11c41aeb535723b78a61087fb436e64891055jmzhu cmd = priv_ptr[i].cmd; 72fbd11c41aeb535723b78a61087fb436e64891055jmzhu break; 73fbd11c41aeb535723b78a61087fb436e64891055jmzhu } 7484c65a62fe7b053fed7f20274ca7379627a87b79Dmitry Shmidt } 75c3539e22bd7a59a12542b9ad961f7d7f0db9a8dfDmitry Shmidt 76fbd11c41aeb535723b78a61087fb436e64891055jmzhu if (i == wrq.u.data.length) { 77fbd11c41aeb535723b78a61087fb436e64891055jmzhu LOGE("iface:%s, fname: %s - function not supported", iface, fname); 786665fb2adf78beddde21f7f3088a695646ca8c57Dmitry Shmidt return -1; 796665fb2adf78beddde21f7f3088a695646ca8c57Dmitry Shmidt } 806665fb2adf78beddde21f7f3088a695646ca8c57Dmitry Shmidt 81fbd11c41aeb535723b78a61087fb436e64891055jmzhu if (cmd < SIOCDEVPRIVATE) { 82fbd11c41aeb535723b78a61087fb436e64891055jmzhu for(j=0; j < i; j++) { 83fbd11c41aeb535723b78a61087fb436e64891055jmzhu if ((priv_ptr[j].set_args == priv_ptr[i].set_args) && 84fbd11c41aeb535723b78a61087fb436e64891055jmzhu (priv_ptr[j].get_args == priv_ptr[i].get_args) && 85fbd11c41aeb535723b78a61087fb436e64891055jmzhu (priv_ptr[j].name[0] == '\0')) 86fbd11c41aeb535723b78a61087fb436e64891055jmzhu break; 87fbd11c41aeb535723b78a61087fb436e64891055jmzhu } 88fbd11c41aeb535723b78a61087fb436e64891055jmzhu if (j == i) { 89fbd11c41aeb535723b78a61087fb436e64891055jmzhu LOGE("iface:%s, fname: %s - invalid private ioctl", iface, fname); 90fbd11c41aeb535723b78a61087fb436e64891055jmzhu return -1; 91fbd11c41aeb535723b78a61087fb436e64891055jmzhu } 92fbd11c41aeb535723b78a61087fb436e64891055jmzhu sub_cmd = cmd; 93fbd11c41aeb535723b78a61087fb436e64891055jmzhu cmd = priv_ptr[j].cmd; 94fbd11c41aeb535723b78a61087fb436e64891055jmzhu } 95fbd11c41aeb535723b78a61087fb436e64891055jmzhu 966665fb2adf78beddde21f7f3088a695646ca8c57Dmitry Shmidt strncpy(wrq.ifr_name, iface, sizeof(wrq.ifr_name)); 976665fb2adf78beddde21f7f3088a695646ca8c57Dmitry Shmidt if (*mBuf != 0) 986665fb2adf78beddde21f7f3088a695646ca8c57Dmitry Shmidt wrq.u.data.length = strlen(mBuf) + 1; 996665fb2adf78beddde21f7f3088a695646ca8c57Dmitry Shmidt else 1006665fb2adf78beddde21f7f3088a695646ca8c57Dmitry Shmidt wrq.u.data.length = 0; 1016665fb2adf78beddde21f7f3088a695646ca8c57Dmitry Shmidt wrq.u.data.pointer = mBuf; 102fbd11c41aeb535723b78a61087fb436e64891055jmzhu wrq.u.data.flags = sub_cmd; 103fbd11c41aeb535723b78a61087fb436e64891055jmzhu ret = ioctl(mSock, cmd, &wrq); 1046665fb2adf78beddde21f7f3088a695646ca8c57Dmitry Shmidt return ret; 1056665fb2adf78beddde21f7f3088a695646ca8c57Dmitry Shmidt} 1066665fb2adf78beddde21f7f3088a695646ca8c57Dmitry Shmidt 1076665fb2adf78beddde21f7f3088a695646ca8c57Dmitry Shmidtint SoftapController::startDriver(char *iface) { 1086665fb2adf78beddde21f7f3088a695646ca8c57Dmitry Shmidt int ret; 1096665fb2adf78beddde21f7f3088a695646ca8c57Dmitry Shmidt 110c3539e22bd7a59a12542b9ad961f7d7f0db9a8dfDmitry Shmidt if (mSock < 0) { 111a165913421c5bed00a1f0b8e79e35e55b82aebbeDmitry Shmidt LOGE("Softap driver start - failed to open socket"); 112c3539e22bd7a59a12542b9ad961f7d7f0db9a8dfDmitry Shmidt return -1; 113c3539e22bd7a59a12542b9ad961f7d7f0db9a8dfDmitry Shmidt } 114c3539e22bd7a59a12542b9ad961f7d7f0db9a8dfDmitry Shmidt if (!iface || (iface[0] == '\0')) { 115a165913421c5bed00a1f0b8e79e35e55b82aebbeDmitry Shmidt LOGD("Softap driver start - wrong interface"); 116c3539e22bd7a59a12542b9ad961f7d7f0db9a8dfDmitry Shmidt iface = mIface; 117c3539e22bd7a59a12542b9ad961f7d7f0db9a8dfDmitry Shmidt } 1186665fb2adf78beddde21f7f3088a695646ca8c57Dmitry Shmidt 1196665fb2adf78beddde21f7f3088a695646ca8c57Dmitry Shmidt *mBuf = 0; 1206665fb2adf78beddde21f7f3088a695646ca8c57Dmitry Shmidt ret = setCommand(iface, "START"); 121a165913421c5bed00a1f0b8e79e35e55b82aebbeDmitry Shmidt usleep(AP_DRIVER_START_DELAY); 122a165913421c5bed00a1f0b8e79e35e55b82aebbeDmitry Shmidt LOGD("Softap driver start: %d", ret); 123c3539e22bd7a59a12542b9ad961f7d7f0db9a8dfDmitry Shmidt return ret; 124c3539e22bd7a59a12542b9ad961f7d7f0db9a8dfDmitry Shmidt} 125c3539e22bd7a59a12542b9ad961f7d7f0db9a8dfDmitry Shmidt 126c3539e22bd7a59a12542b9ad961f7d7f0db9a8dfDmitry Shmidtint SoftapController::stopDriver(char *iface) { 1276665fb2adf78beddde21f7f3088a695646ca8c57Dmitry Shmidt int ret; 128c3539e22bd7a59a12542b9ad961f7d7f0db9a8dfDmitry Shmidt 129c3539e22bd7a59a12542b9ad961f7d7f0db9a8dfDmitry Shmidt if (mSock < 0) { 130a165913421c5bed00a1f0b8e79e35e55b82aebbeDmitry Shmidt LOGE("Softap driver stop - failed to open socket"); 131c3539e22bd7a59a12542b9ad961f7d7f0db9a8dfDmitry Shmidt return -1; 132c3539e22bd7a59a12542b9ad961f7d7f0db9a8dfDmitry Shmidt } 133c3539e22bd7a59a12542b9ad961f7d7f0db9a8dfDmitry Shmidt if (!iface || (iface[0] == '\0')) { 134a165913421c5bed00a1f0b8e79e35e55b82aebbeDmitry Shmidt LOGD("Softap driver stop - wrong interface"); 135c3539e22bd7a59a12542b9ad961f7d7f0db9a8dfDmitry Shmidt iface = mIface; 136c3539e22bd7a59a12542b9ad961f7d7f0db9a8dfDmitry Shmidt } 1376665fb2adf78beddde21f7f3088a695646ca8c57Dmitry Shmidt *mBuf = 0; 1386665fb2adf78beddde21f7f3088a695646ca8c57Dmitry Shmidt ret = setCommand(iface, "STOP"); 139a165913421c5bed00a1f0b8e79e35e55b82aebbeDmitry Shmidt LOGD("Softap driver stop: %d", ret); 140c3539e22bd7a59a12542b9ad961f7d7f0db9a8dfDmitry Shmidt return ret; 141c3539e22bd7a59a12542b9ad961f7d7f0db9a8dfDmitry Shmidt} 142c3539e22bd7a59a12542b9ad961f7d7f0db9a8dfDmitry Shmidt 1435af38c360587ca2eef0badf6137ccf018f8cd4aaDmitry Shmidtint SoftapController::startSoftap() { 1445af38c360587ca2eef0badf6137ccf018f8cd4aaDmitry Shmidt pid_t pid = 1; 1456665fb2adf78beddde21f7f3088a695646ca8c57Dmitry Shmidt int ret = 0; 1465af38c360587ca2eef0badf6137ccf018f8cd4aaDmitry Shmidt 1475af38c360587ca2eef0badf6137ccf018f8cd4aaDmitry Shmidt if (mPid) { 1485af38c360587ca2eef0badf6137ccf018f8cd4aaDmitry Shmidt LOGE("Softap already started"); 149a165913421c5bed00a1f0b8e79e35e55b82aebbeDmitry Shmidt return 0; 1505af38c360587ca2eef0badf6137ccf018f8cd4aaDmitry Shmidt } 15184c65a62fe7b053fed7f20274ca7379627a87b79Dmitry Shmidt if (mSock < 0) { 152c3539e22bd7a59a12542b9ad961f7d7f0db9a8dfDmitry Shmidt LOGE("Softap startap - failed to open socket"); 15384c65a62fe7b053fed7f20274ca7379627a87b79Dmitry Shmidt return -1; 15484c65a62fe7b053fed7f20274ca7379627a87b79Dmitry Shmidt } 1555af38c360587ca2eef0badf6137ccf018f8cd4aaDmitry Shmidt#if 0 1565af38c360587ca2eef0badf6137ccf018f8cd4aaDmitry Shmidt if ((pid = fork()) < 0) { 1575af38c360587ca2eef0badf6137ccf018f8cd4aaDmitry Shmidt LOGE("fork failed (%s)", strerror(errno)); 1585af38c360587ca2eef0badf6137ccf018f8cd4aaDmitry Shmidt return -1; 1595af38c360587ca2eef0badf6137ccf018f8cd4aaDmitry Shmidt } 1605af38c360587ca2eef0badf6137ccf018f8cd4aaDmitry Shmidt#endif 16184c65a62fe7b053fed7f20274ca7379627a87b79Dmitry Shmidt /* system("iwpriv wl0.1 AP_BSS_START"); */ 1625af38c360587ca2eef0badf6137ccf018f8cd4aaDmitry Shmidt if (!pid) { 16384c65a62fe7b053fed7f20274ca7379627a87b79Dmitry Shmidt /* start hostapd */ 16484c65a62fe7b053fed7f20274ca7379627a87b79Dmitry Shmidt return ret; 1655af38c360587ca2eef0badf6137ccf018f8cd4aaDmitry Shmidt } else { 1666665fb2adf78beddde21f7f3088a695646ca8c57Dmitry Shmidt *mBuf = 0; 1676665fb2adf78beddde21f7f3088a695646ca8c57Dmitry Shmidt ret = setCommand(mIface, "AP_BSS_START"); 16884c65a62fe7b053fed7f20274ca7379627a87b79Dmitry Shmidt if (ret) { 169c3539e22bd7a59a12542b9ad961f7d7f0db9a8dfDmitry Shmidt LOGE("Softap startap - failed: %d", ret); 17084c65a62fe7b053fed7f20274ca7379627a87b79Dmitry Shmidt } 17184c65a62fe7b053fed7f20274ca7379627a87b79Dmitry Shmidt else { 17284c65a62fe7b053fed7f20274ca7379627a87b79Dmitry Shmidt mPid = pid; 173c3539e22bd7a59a12542b9ad961f7d7f0db9a8dfDmitry Shmidt LOGD("Softap startap - Ok"); 1743df450af1c2e35d854768a508b6905c6794f7a74Dmitry Shmidt usleep(AP_BSS_START_DELAY); 17584c65a62fe7b053fed7f20274ca7379627a87b79Dmitry Shmidt } 1765af38c360587ca2eef0badf6137ccf018f8cd4aaDmitry Shmidt } 17784c65a62fe7b053fed7f20274ca7379627a87b79Dmitry Shmidt return ret; 1785af38c360587ca2eef0badf6137ccf018f8cd4aaDmitry Shmidt 1795af38c360587ca2eef0badf6137ccf018f8cd4aaDmitry Shmidt} 1805af38c360587ca2eef0badf6137ccf018f8cd4aaDmitry Shmidt 1815af38c360587ca2eef0badf6137ccf018f8cd4aaDmitry Shmidtint SoftapController::stopSoftap() { 1826665fb2adf78beddde21f7f3088a695646ca8c57Dmitry Shmidt int ret; 18384c65a62fe7b053fed7f20274ca7379627a87b79Dmitry Shmidt 1845af38c360587ca2eef0badf6137ccf018f8cd4aaDmitry Shmidt if (mPid == 0) { 1855af38c360587ca2eef0badf6137ccf018f8cd4aaDmitry Shmidt LOGE("Softap already stopped"); 1865af38c360587ca2eef0badf6137ccf018f8cd4aaDmitry Shmidt return 0; 1875af38c360587ca2eef0badf6137ccf018f8cd4aaDmitry Shmidt } 18884c65a62fe7b053fed7f20274ca7379627a87b79Dmitry Shmidt if (mSock < 0) { 189c3539e22bd7a59a12542b9ad961f7d7f0db9a8dfDmitry Shmidt LOGE("Softap stopap - failed to open socket"); 19084c65a62fe7b053fed7f20274ca7379627a87b79Dmitry Shmidt return -1; 19184c65a62fe7b053fed7f20274ca7379627a87b79Dmitry Shmidt } 1926665fb2adf78beddde21f7f3088a695646ca8c57Dmitry Shmidt *mBuf = 0; 1936665fb2adf78beddde21f7f3088a695646ca8c57Dmitry Shmidt ret = setCommand(mIface, "AP_BSS_STOP"); 1945af38c360587ca2eef0badf6137ccf018f8cd4aaDmitry Shmidt#if 0 1955af38c360587ca2eef0badf6137ccf018f8cd4aaDmitry Shmidt LOGD("Stopping Softap service"); 1965af38c360587ca2eef0badf6137ccf018f8cd4aaDmitry Shmidt kill(mPid, SIGTERM); 1975af38c360587ca2eef0badf6137ccf018f8cd4aaDmitry Shmidt waitpid(mPid, NULL, 0); 1985af38c360587ca2eef0badf6137ccf018f8cd4aaDmitry Shmidt#endif 1995af38c360587ca2eef0badf6137ccf018f8cd4aaDmitry Shmidt mPid = 0; 20084c65a62fe7b053fed7f20274ca7379627a87b79Dmitry Shmidt LOGD("Softap service stopped: %d", ret); 2013df450af1c2e35d854768a508b6905c6794f7a74Dmitry Shmidt usleep(AP_BSS_STOP_DELAY); 20284c65a62fe7b053fed7f20274ca7379627a87b79Dmitry Shmidt return ret; 2035af38c360587ca2eef0badf6137ccf018f8cd4aaDmitry Shmidt} 2045af38c360587ca2eef0badf6137ccf018f8cd4aaDmitry Shmidt 2055af38c360587ca2eef0badf6137ccf018f8cd4aaDmitry Shmidtbool SoftapController::isSoftapStarted() { 2065af38c360587ca2eef0badf6137ccf018f8cd4aaDmitry Shmidt return (mPid != 0 ? true : false); 2075af38c360587ca2eef0badf6137ccf018f8cd4aaDmitry Shmidt} 2085af38c360587ca2eef0badf6137ccf018f8cd4aaDmitry Shmidt 2097977d67059ef94eefa9b14038df156b416fef877Dmitry Shmidtint SoftapController::addParam(int pos, const char *cmd, const char *arg) 2107977d67059ef94eefa9b14038df156b416fef877Dmitry Shmidt{ 2117977d67059ef94eefa9b14038df156b416fef877Dmitry Shmidt if (pos < 0) 2127977d67059ef94eefa9b14038df156b416fef877Dmitry Shmidt return pos; 2137977d67059ef94eefa9b14038df156b416fef877Dmitry Shmidt if ((unsigned)(pos + strlen(cmd) + strlen(arg) + 1) >= sizeof(mBuf)) { 2147977d67059ef94eefa9b14038df156b416fef877Dmitry Shmidt LOGE("Command line is too big"); 2157977d67059ef94eefa9b14038df156b416fef877Dmitry Shmidt return -1; 2167977d67059ef94eefa9b14038df156b416fef877Dmitry Shmidt } 2177977d67059ef94eefa9b14038df156b416fef877Dmitry Shmidt pos += sprintf(&mBuf[pos], "%s=%s,", cmd, arg); 2187977d67059ef94eefa9b14038df156b416fef877Dmitry Shmidt return pos; 2197977d67059ef94eefa9b14038df156b416fef877Dmitry Shmidt} 2207977d67059ef94eefa9b14038df156b416fef877Dmitry Shmidt 22184c65a62fe7b053fed7f20274ca7379627a87b79Dmitry Shmidt/* 22284c65a62fe7b053fed7f20274ca7379627a87b79Dmitry Shmidt * Arguments: 22384c65a62fe7b053fed7f20274ca7379627a87b79Dmitry Shmidt * argv[2] - wlan interface 22484c65a62fe7b053fed7f20274ca7379627a87b79Dmitry Shmidt * argv[3] - softap interface 2257977d67059ef94eefa9b14038df156b416fef877Dmitry Shmidt * argv[4] - SSID 2267977d67059ef94eefa9b14038df156b416fef877Dmitry Shmidt * argv[5] - Security 2277977d67059ef94eefa9b14038df156b416fef877Dmitry Shmidt * argv[6] - Key 2287977d67059ef94eefa9b14038df156b416fef877Dmitry Shmidt * argv[7] - Channel 2297977d67059ef94eefa9b14038df156b416fef877Dmitry Shmidt * argv[8] - Preamble 2307977d67059ef94eefa9b14038df156b416fef877Dmitry Shmidt * argv[9] - Max SCB 23184c65a62fe7b053fed7f20274ca7379627a87b79Dmitry Shmidt */ 2325af38c360587ca2eef0badf6137ccf018f8cd4aaDmitry Shmidtint SoftapController::setSoftap(int argc, char *argv[]) { 233a2d7e3e7d6e3f163f06e522378c6e2bd5cee28f8Kenny Root unsigned char psk[SHA256_DIGEST_LENGTH]; 234a2d7e3e7d6e3f163f06e522378c6e2bd5cee28f8Kenny Root char psk_str[2*SHA256_DIGEST_LENGTH+1]; 2356665fb2adf78beddde21f7f3088a695646ca8c57Dmitry Shmidt int ret, i = 0; 2366665fb2adf78beddde21f7f3088a695646ca8c57Dmitry Shmidt char *ssid, *iface; 23784c65a62fe7b053fed7f20274ca7379627a87b79Dmitry Shmidt 23884c65a62fe7b053fed7f20274ca7379627a87b79Dmitry Shmidt if (mSock < 0) { 2397977d67059ef94eefa9b14038df156b416fef877Dmitry Shmidt LOGE("Softap set - failed to open socket"); 24084c65a62fe7b053fed7f20274ca7379627a87b79Dmitry Shmidt return -1; 24184c65a62fe7b053fed7f20274ca7379627a87b79Dmitry Shmidt } 24284c65a62fe7b053fed7f20274ca7379627a87b79Dmitry Shmidt if (argc < 4) { 2437977d67059ef94eefa9b14038df156b416fef877Dmitry Shmidt LOGE("Softap set - missing arguments"); 24484c65a62fe7b053fed7f20274ca7379627a87b79Dmitry Shmidt return -1; 24584c65a62fe7b053fed7f20274ca7379627a87b79Dmitry Shmidt } 24684c65a62fe7b053fed7f20274ca7379627a87b79Dmitry Shmidt 24784c65a62fe7b053fed7f20274ca7379627a87b79Dmitry Shmidt strncpy(mIface, argv[3], sizeof(mIface)); 2486665fb2adf78beddde21f7f3088a695646ca8c57Dmitry Shmidt iface = argv[2]; 2497977d67059ef94eefa9b14038df156b416fef877Dmitry Shmidt 2507977d67059ef94eefa9b14038df156b416fef877Dmitry Shmidt /* Create command line */ 2517977d67059ef94eefa9b14038df156b416fef877Dmitry Shmidt i = addParam(i, "ASCII_CMD", "AP_CFG"); 2527977d67059ef94eefa9b14038df156b416fef877Dmitry Shmidt if (argc > 4) { 253321f95a95cd41e0f58a72ca4f382d7e0a7f26d01Dmitry Shmidt ssid = argv[4]; 2547977d67059ef94eefa9b14038df156b416fef877Dmitry Shmidt } else { 255321f95a95cd41e0f58a72ca4f382d7e0a7f26d01Dmitry Shmidt ssid = (char *)"AndroidAP"; 2567977d67059ef94eefa9b14038df156b416fef877Dmitry Shmidt } 257321f95a95cd41e0f58a72ca4f382d7e0a7f26d01Dmitry Shmidt i = addParam(i, "SSID", ssid); 2587977d67059ef94eefa9b14038df156b416fef877Dmitry Shmidt if (argc > 5) { 2597977d67059ef94eefa9b14038df156b416fef877Dmitry Shmidt i = addParam(i, "SEC", argv[5]); 2607977d67059ef94eefa9b14038df156b416fef877Dmitry Shmidt } else { 2617977d67059ef94eefa9b14038df156b416fef877Dmitry Shmidt i = addParam(i, "SEC", "open"); 2627977d67059ef94eefa9b14038df156b416fef877Dmitry Shmidt } 2637977d67059ef94eefa9b14038df156b416fef877Dmitry Shmidt if (argc > 6) { 264321f95a95cd41e0f58a72ca4f382d7e0a7f26d01Dmitry Shmidt int j; 265a2d7e3e7d6e3f163f06e522378c6e2bd5cee28f8Kenny Root // Use the PKCS#5 PBKDF2 with 4096 iterations 266a2d7e3e7d6e3f163f06e522378c6e2bd5cee28f8Kenny Root PKCS5_PBKDF2_HMAC_SHA1(argv[6], strlen(argv[6]), 267a2d7e3e7d6e3f163f06e522378c6e2bd5cee28f8Kenny Root reinterpret_cast<const unsigned char *>(ssid), strlen(ssid), 268a2d7e3e7d6e3f163f06e522378c6e2bd5cee28f8Kenny Root 4096, SHA256_DIGEST_LENGTH, psk); 269a2d7e3e7d6e3f163f06e522378c6e2bd5cee28f8Kenny Root for (j=0; j < SHA256_DIGEST_LENGTH; j++) { 270321f95a95cd41e0f58a72ca4f382d7e0a7f26d01Dmitry Shmidt sprintf(&psk_str[j<<1], "%02x", psk[j]); 271321f95a95cd41e0f58a72ca4f382d7e0a7f26d01Dmitry Shmidt } 272321f95a95cd41e0f58a72ca4f382d7e0a7f26d01Dmitry Shmidt psk_str[j<<1] = '\0'; 273321f95a95cd41e0f58a72ca4f382d7e0a7f26d01Dmitry Shmidt i = addParam(i, "KEY", psk_str); 2747977d67059ef94eefa9b14038df156b416fef877Dmitry Shmidt } else { 2757977d67059ef94eefa9b14038df156b416fef877Dmitry Shmidt i = addParam(i, "KEY", "12345678"); 2767977d67059ef94eefa9b14038df156b416fef877Dmitry Shmidt } 2777977d67059ef94eefa9b14038df156b416fef877Dmitry Shmidt if (argc > 7) { 2787977d67059ef94eefa9b14038df156b416fef877Dmitry Shmidt i = addParam(i, "CHANNEL", argv[7]); 2797977d67059ef94eefa9b14038df156b416fef877Dmitry Shmidt } else { 2807977d67059ef94eefa9b14038df156b416fef877Dmitry Shmidt i = addParam(i, "CHANNEL", "6"); 2817977d67059ef94eefa9b14038df156b416fef877Dmitry Shmidt } 2827977d67059ef94eefa9b14038df156b416fef877Dmitry Shmidt if (argc > 8) { 2837977d67059ef94eefa9b14038df156b416fef877Dmitry Shmidt i = addParam(i, "PREAMBLE", argv[8]); 2847977d67059ef94eefa9b14038df156b416fef877Dmitry Shmidt } else { 2857977d67059ef94eefa9b14038df156b416fef877Dmitry Shmidt i = addParam(i, "PREAMBLE", "0"); 2867977d67059ef94eefa9b14038df156b416fef877Dmitry Shmidt } 2877977d67059ef94eefa9b14038df156b416fef877Dmitry Shmidt if (argc > 9) { 2887977d67059ef94eefa9b14038df156b416fef877Dmitry Shmidt i = addParam(i, "MAX_SCB", argv[9]); 2897977d67059ef94eefa9b14038df156b416fef877Dmitry Shmidt } else { 2907977d67059ef94eefa9b14038df156b416fef877Dmitry Shmidt i = addParam(i, "MAX_SCB", "8"); 2917977d67059ef94eefa9b14038df156b416fef877Dmitry Shmidt } 2927977d67059ef94eefa9b14038df156b416fef877Dmitry Shmidt if ((i < 0) || ((unsigned)(i + 4) >= sizeof(mBuf))) { 2937977d67059ef94eefa9b14038df156b416fef877Dmitry Shmidt LOGE("Softap set - command is too big"); 2947977d67059ef94eefa9b14038df156b416fef877Dmitry Shmidt return i; 29584c65a62fe7b053fed7f20274ca7379627a87b79Dmitry Shmidt } 2967977d67059ef94eefa9b14038df156b416fef877Dmitry Shmidt sprintf(&mBuf[i], "END"); 29784c65a62fe7b053fed7f20274ca7379627a87b79Dmitry Shmidt 29884c65a62fe7b053fed7f20274ca7379627a87b79Dmitry Shmidt /* system("iwpriv eth0 WL_AP_CFG ASCII_CMD=AP_CFG,SSID=\"AndroidAP\",SEC=\"open\",KEY=12345,CHANNEL=1,PREAMBLE=0,MAX_SCB=8,END"); */ 2996665fb2adf78beddde21f7f3088a695646ca8c57Dmitry Shmidt ret = setCommand(iface, "AP_SET_CFG"); 30084c65a62fe7b053fed7f20274ca7379627a87b79Dmitry Shmidt if (ret) { 30184c65a62fe7b053fed7f20274ca7379627a87b79Dmitry Shmidt LOGE("Softap set - failed: %d", ret); 30284c65a62fe7b053fed7f20274ca7379627a87b79Dmitry Shmidt } 30384c65a62fe7b053fed7f20274ca7379627a87b79Dmitry Shmidt else { 30484c65a62fe7b053fed7f20274ca7379627a87b79Dmitry Shmidt LOGD("Softap set - Ok"); 3053df450af1c2e35d854768a508b6905c6794f7a74Dmitry Shmidt usleep(AP_SET_CFG_DELAY); 30684c65a62fe7b053fed7f20274ca7379627a87b79Dmitry Shmidt } 30784c65a62fe7b053fed7f20274ca7379627a87b79Dmitry Shmidt return ret; 3085af38c360587ca2eef0badf6137ccf018f8cd4aaDmitry Shmidt} 30931fd6c5f3e9c39a13b028718dba5921a4300988cDmitry Shmidt 31031fd6c5f3e9c39a13b028718dba5921a4300988cDmitry Shmidt/* 31131fd6c5f3e9c39a13b028718dba5921a4300988cDmitry Shmidt * Arguments: 31231fd6c5f3e9c39a13b028718dba5921a4300988cDmitry Shmidt * argv[2] - interface name 31331fd6c5f3e9c39a13b028718dba5921a4300988cDmitry Shmidt * argv[3] - AP or STA 31431fd6c5f3e9c39a13b028718dba5921a4300988cDmitry Shmidt */ 31531fd6c5f3e9c39a13b028718dba5921a4300988cDmitry Shmidtint SoftapController::fwReloadSoftap(int argc, char *argv[]) 31631fd6c5f3e9c39a13b028718dba5921a4300988cDmitry Shmidt{ 3176665fb2adf78beddde21f7f3088a695646ca8c57Dmitry Shmidt int ret, i = 0; 31831fd6c5f3e9c39a13b028718dba5921a4300988cDmitry Shmidt char *iface; 31931fd6c5f3e9c39a13b028718dba5921a4300988cDmitry Shmidt 32031fd6c5f3e9c39a13b028718dba5921a4300988cDmitry Shmidt if (mSock < 0) { 32131fd6c5f3e9c39a13b028718dba5921a4300988cDmitry Shmidt LOGE("Softap fwrealod - failed to open socket"); 32231fd6c5f3e9c39a13b028718dba5921a4300988cDmitry Shmidt return -1; 32331fd6c5f3e9c39a13b028718dba5921a4300988cDmitry Shmidt } 32431fd6c5f3e9c39a13b028718dba5921a4300988cDmitry Shmidt if (argc < 4) { 32531fd6c5f3e9c39a13b028718dba5921a4300988cDmitry Shmidt LOGE("Softap fwreload - missing arguments"); 32631fd6c5f3e9c39a13b028718dba5921a4300988cDmitry Shmidt return -1; 32731fd6c5f3e9c39a13b028718dba5921a4300988cDmitry Shmidt } 32831fd6c5f3e9c39a13b028718dba5921a4300988cDmitry Shmidt 32931fd6c5f3e9c39a13b028718dba5921a4300988cDmitry Shmidt iface = argv[2]; 33031fd6c5f3e9c39a13b028718dba5921a4300988cDmitry Shmidt 33131fd6c5f3e9c39a13b028718dba5921a4300988cDmitry Shmidt if (strcmp(argv[3], "AP") == 0) { 33231fd6c5f3e9c39a13b028718dba5921a4300988cDmitry Shmidt#ifdef WIFI_DRIVER_FW_AP_PATH 33331fd6c5f3e9c39a13b028718dba5921a4300988cDmitry Shmidt sprintf(mBuf, "FW_PATH=%s", WIFI_DRIVER_FW_AP_PATH); 33431fd6c5f3e9c39a13b028718dba5921a4300988cDmitry Shmidt#endif 33531fd6c5f3e9c39a13b028718dba5921a4300988cDmitry Shmidt } else { 33631fd6c5f3e9c39a13b028718dba5921a4300988cDmitry Shmidt#ifdef WIFI_DRIVER_FW_STA_PATH 33731fd6c5f3e9c39a13b028718dba5921a4300988cDmitry Shmidt sprintf(mBuf, "FW_PATH=%s", WIFI_DRIVER_FW_STA_PATH); 33831fd6c5f3e9c39a13b028718dba5921a4300988cDmitry Shmidt#endif 33931fd6c5f3e9c39a13b028718dba5921a4300988cDmitry Shmidt } 3406665fb2adf78beddde21f7f3088a695646ca8c57Dmitry Shmidt ret = setCommand(iface, "WL_FW_RELOAD"); 34131fd6c5f3e9c39a13b028718dba5921a4300988cDmitry Shmidt if (ret) { 34231fd6c5f3e9c39a13b028718dba5921a4300988cDmitry Shmidt LOGE("Softap fwReload - failed: %d", ret); 34331fd6c5f3e9c39a13b028718dba5921a4300988cDmitry Shmidt } 34431fd6c5f3e9c39a13b028718dba5921a4300988cDmitry Shmidt else { 34531fd6c5f3e9c39a13b028718dba5921a4300988cDmitry Shmidt LOGD("Softap fwReload - Ok"); 34631fd6c5f3e9c39a13b028718dba5921a4300988cDmitry Shmidt } 34731fd6c5f3e9c39a13b028718dba5921a4300988cDmitry Shmidt return ret; 34831fd6c5f3e9c39a13b028718dba5921a4300988cDmitry Shmidt} 349