248 lines
6.7 KiB
C
248 lines
6.7 KiB
C
/*
|
|
* Copyright (c) 2015 iComm-semi Ltd.
|
|
*
|
|
* This program is free software: you can redistribute it and/or modify
|
|
* it under the terms of the GNU General Public License as published by
|
|
* the Free Software Foundation, either version 3 of the License, or
|
|
* (at your option) any later version.
|
|
* This program is distributed in the hope that it will be useful, but
|
|
* WITHOUT ANY WARRANTY; without even the implied warranty of
|
|
* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.
|
|
* See the GNU General Public License for more details.
|
|
* You should have received a copy of the GNU General Public License
|
|
* along with this program. If not, see <http://www.gnu.org/licenses/>.
|
|
*/
|
|
|
|
#include <stdio.h>
|
|
#include <stdlib.h>
|
|
#include <unistd.h>
|
|
#include <stdint.h>
|
|
#include <string.h>
|
|
#include <sys/socket.h>
|
|
#include <sys/errno.h>
|
|
#include <sys/time.h>
|
|
#include <signal.h>
|
|
#include <linux/netlink.h>
|
|
#include "ssv_smartlink.h"
|
|
#include "airkiss-lib/airkiss.h"
|
|
airkiss_context_t akcontex;
|
|
const airkiss_config_t akconf =
|
|
{
|
|
(airkiss_memset_fn)&memset,
|
|
(airkiss_memcpy_fn)&memcpy,
|
|
(airkiss_memcmp_fn)&memcmp,
|
|
(airkiss_printf_fn)&printf
|
|
};
|
|
static uint8_t gBuf[MAX_PAYLOAD]={0};
|
|
static uint32_t gBufLen=0;
|
|
static airkiss_result_t ssv_airkiss_result;
|
|
static char *ssv_wpa_conf_file = "%s/conf/wpa_supplicant.conf";
|
|
static char *ssv_enter_airkiss_mode = "cd %s/scripts/ && ./startsmartlink.sh";
|
|
static char *ssv_start_sta_mode = "cd %s/ && ./sta.sh";
|
|
static uint32_t gChan=SSV_MIN_CHANNEL;
|
|
static void _ssv_airkiss_finish(void)
|
|
{
|
|
int ret=0;
|
|
ret = airkiss_get_result(&akcontex, &ssv_airkiss_result);
|
|
if (ret == 0)
|
|
{
|
|
printf("airkiss_get_result() ok!\n");
|
|
printf("ssid = %s, pwd = %s, ssid_length = %d, pwd_length = %d, random = 0x%02x\n",
|
|
ssv_airkiss_result.ssid,
|
|
ssv_airkiss_result.pwd,
|
|
ssv_airkiss_result.ssid_length,
|
|
ssv_airkiss_result.pwd_length,
|
|
ssv_airkiss_result.random);
|
|
}
|
|
else
|
|
{
|
|
printf("airkiss_get_result() failed!\n");
|
|
}
|
|
}
|
|
static void _ssv_airkiss_setchannel_callback(int signum)
|
|
{
|
|
(void)signum;
|
|
ssv_smartlink_set_channel(gChan);
|
|
gChan++;
|
|
if (gChan > SSV_MAX_CHANNEL)
|
|
{
|
|
gChan = SSV_MIN_CHANNEL;
|
|
}
|
|
}
|
|
static int _ssv_airkiss_enable_setchannel_timer(void)
|
|
{
|
|
struct itimerval t;
|
|
t.it_interval.tv_usec = 200000;
|
|
t.it_interval.tv_sec = 0;
|
|
t.it_value.tv_usec = 200000;
|
|
t.it_value.tv_sec = 0;
|
|
if (setitimer(ITIMER_REAL, &t, NULL) < 0)
|
|
{
|
|
printf("%s\n", strerror(errno));
|
|
printf("setitimer error!\n");
|
|
return -1;
|
|
}
|
|
signal(SIGALRM, _ssv_airkiss_setchannel_callback);
|
|
return 0;
|
|
}
|
|
static int _ssv_airkiss_disable_setchannel_timer(void)
|
|
{
|
|
struct itimerval t;
|
|
getitimer(ITIMER_REAL, &t );
|
|
t.it_interval.tv_usec = 0;
|
|
t.it_interval.tv_sec = 0;
|
|
t.it_value.tv_usec = 0;
|
|
t.it_value.tv_sec = 0;
|
|
if (setitimer(ITIMER_REAL, &t, NULL) < 0)
|
|
{
|
|
printf("%s\n", strerror(errno));
|
|
printf("setitimer error!\n");
|
|
return -1;
|
|
}
|
|
return 0;
|
|
}
|
|
static void _ssv_sig_int(int signum)
|
|
{
|
|
(void)ssv_smartlink_stop();
|
|
return;
|
|
}
|
|
static int _ssv_airkiss_write_wpa_config_file(char *pFileName, char *pSSID, char *pPWD)
|
|
{
|
|
FILE *fptr=NULL;
|
|
if (!pFileName || !pSSID || !pPWD)
|
|
{
|
|
printf("Parameter error!\n");
|
|
return -1;
|
|
}
|
|
fptr = fopen(pFileName, "w");
|
|
if (fptr == NULL)
|
|
{
|
|
printf("Open %s failed: %s\n", pFileName, strerror(errno));
|
|
return -2;
|
|
}
|
|
fprintf(fptr, "ctrl_interface=/var/run/wpa_supplicant\n");
|
|
fprintf(fptr, "ap_scan=1\n");
|
|
fprintf(fptr, "\n");
|
|
fprintf(fptr, "network={\n");
|
|
fprintf(fptr, "\tssid=\"%s\"\n", pSSID);
|
|
fprintf(fptr, "\tpsk=\"%s\"\n", pPWD);
|
|
fprintf(fptr, "}\n");
|
|
fclose(fptr);
|
|
printf("Write %s success.\n", pFileName);
|
|
return 0;
|
|
}
|
|
int main(int argc, char *argv[])
|
|
{
|
|
int ret=-1;
|
|
const char *key="Wechatiothardwav";
|
|
char cmdBuf[160]={0};
|
|
#if 0
|
|
file_path_getcwd = (char *)malloc(80);
|
|
getcwd(file_path_getcwd, 80);
|
|
printf("==Current Path: %s==\n", file_path_getcwd);
|
|
sprintf(cmdBuf, ssv_enter_airkiss_mode, file_path_getcwd);
|
|
ret = system(cmdBuf);
|
|
if (ret != 0)
|
|
{
|
|
if (file_path_getcwd)
|
|
{
|
|
free(file_path_getcwd);
|
|
}
|
|
return ret;
|
|
}
|
|
#endif
|
|
ret = airkiss_init(&akcontex, &akconf);
|
|
if (ret < 0)
|
|
{
|
|
printf("airkiss init failed\n");
|
|
goto out;
|
|
}
|
|
printf("%s\n", airkiss_version());
|
|
#if AIRKISS_ENABLE_CRYPT
|
|
airkiss_set_key(&akcontex, key, strlen(key));
|
|
#endif
|
|
printf("%s\n", ssv_smartlink_version());
|
|
ret = ssv_smartlink_start();
|
|
if (ret < 0)
|
|
{
|
|
printf("ssv_smartlink_start error: %d\n", ret);
|
|
goto out;
|
|
}
|
|
ret = ssv_smartlink_set_promisc(1);
|
|
if (ret < 0)
|
|
{
|
|
printf("ssv_smartlink_set_promisc error: %d\n", ret);
|
|
goto out;
|
|
}
|
|
ret = _ssv_airkiss_enable_setchannel_timer();
|
|
if (ret < 0)
|
|
{
|
|
goto out;
|
|
}
|
|
signal(SIGINT, _ssv_sig_int);
|
|
while (1)
|
|
{
|
|
gBufLen = 0;
|
|
memset(gBuf, 0, sizeof(gBuf));
|
|
ret = ssv_smartlink_recv_packet(gBuf, &gBufLen);
|
|
if (ret < 0)
|
|
{
|
|
printf("ssv_smartlink_recv_packet error: %d\n", ret);
|
|
goto out;
|
|
}
|
|
ret = airkiss_recv(&akcontex, gBuf, gBufLen);
|
|
if (ret == AIRKISS_STATUS_CHANNEL_LOCKED)
|
|
{
|
|
ret = _ssv_airkiss_disable_setchannel_timer();
|
|
if (ret < 0)
|
|
{
|
|
goto out;
|
|
}
|
|
gChan = gChan - 1;
|
|
if (gChan < SSV_MIN_CHANNEL)
|
|
{
|
|
gChan = SSV_MIN_CHANNEL;
|
|
}
|
|
printf("Channel locked to %d!\n", gChan);
|
|
}
|
|
else if (ret == AIRKISS_STATUS_COMPLETE)
|
|
{
|
|
_ssv_airkiss_finish();
|
|
ret = ssv_smartlink_set_promisc(0);
|
|
if (ret < 0)
|
|
{
|
|
goto out;
|
|
}
|
|
break;
|
|
}
|
|
else
|
|
{
|
|
}
|
|
}
|
|
ret = 0;
|
|
out:
|
|
(void)ssv_smartlink_stop();
|
|
#if 0
|
|
if (ret == 0)
|
|
{
|
|
sprintf(cmdBuf, ssv_wpa_conf_file, file_path_getcwd);
|
|
if (0 == _ssv_airkiss_write_wpa_config_file(cmdBuf, ssv_airkiss_result.ssid, ssv_airkiss_result.pwd))
|
|
{
|
|
char buf[64];
|
|
printf("Config file: %s\n", cmdBuf);
|
|
printf("----------------------------------------\n");
|
|
sprintf(buf, "cat %s", cmdBuf);
|
|
system(buf);
|
|
printf("----------------------------------------\n");
|
|
sprintf(cmdBuf, ssv_start_sta_mode, file_path_getcwd);
|
|
system(cmdBuf);
|
|
}
|
|
}
|
|
if (file_path_getcwd)
|
|
{
|
|
free(file_path_getcwd);
|
|
}
|
|
#endif
|
|
return ret;
|
|
}
|