233 lines
6.6 KiB
C
233 lines
6.6 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 "qqlink-lib-mipsel/include/TXWifisync.h"
|
|
static uint8_t gBuf[MAX_PAYLOAD]={0};
|
|
static uint32_t gBufLen=0;
|
|
static char _sz_ssid[QLMAX_SSID_LEN];
|
|
static char _sz_password[QLMAX_PSWD_LEN];
|
|
static char *ssv_wpa_conf_file = "%s/conf/wpa_supplicant.conf";
|
|
static char *ssv_enter_qqlink_mode = "cd %s/scripts/ && ./startsmartlink.sh";
|
|
static char *ssv_start_sta_mode = "cd %s/ && ./sta.sh";
|
|
static uint32_t gChan=SSV_MIN_CHANNEL;
|
|
void on_wifi_sync_notify(tx_wifi_sync_param *pwifi_sync_param, void *puserdata)
|
|
{
|
|
printf("received said: %s\n", pwifi_sync_param->sz_ssid);
|
|
printf("received password: %s\n", pwifi_sync_param->sz_password);
|
|
strcpy(_sz_ssid, pwifi_sync_param->sz_ssid);
|
|
strcpy(_sz_password, pwifi_sync_param->sz_password);
|
|
}
|
|
static void _ssv_qqlink_setchannel_callback(int signum)
|
|
{
|
|
(void)signum;
|
|
ssv_smartlink_set_channel(gChan);
|
|
wifi_sync_notify_hop(gChan);
|
|
gChan++;
|
|
if (gChan > SSV_MAX_CHANNEL)
|
|
{
|
|
gChan = SSV_MIN_CHANNEL;
|
|
}
|
|
}
|
|
static int _ssv_qqlink_enable_setchannel_timer(void)
|
|
{
|
|
struct itimerval t;
|
|
t.it_interval.tv_usec = 100000;
|
|
t.it_interval.tv_sec = 0;
|
|
t.it_value.tv_usec = 100000;
|
|
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_qqlink_setchannel_callback);
|
|
return 0;
|
|
}
|
|
static int _ssv_qqlink_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_qqlink_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;
|
|
int channel=0;
|
|
static int locked=0;
|
|
char *file_path_getcwd=NULL;
|
|
const char *key="Wechatiothardwav";
|
|
char cmdBuf[160]={0};
|
|
memset(_sz_ssid, 0, QLMAX_SSID_LEN);
|
|
memset(_sz_password, 0, QLMAX_PSWD_LEN);
|
|
file_path_getcwd = (char *)malloc(80);
|
|
getcwd(file_path_getcwd, 80);
|
|
printf("==Current Path: %s==\n", file_path_getcwd);
|
|
sprintf(cmdBuf, ssv_enter_qqlink_mode, file_path_getcwd);
|
|
ret = system(cmdBuf);
|
|
if (ret != 0)
|
|
{
|
|
if (file_path_getcwd)
|
|
{
|
|
free(file_path_getcwd);
|
|
}
|
|
return ret;
|
|
}
|
|
ret = init_wifi_sync(on_wifi_sync_notify, "SZSSV01234567890", "SSV1234567890");
|
|
if (ret != QLERROR_INIT_SUCCESS)
|
|
{
|
|
printf("qqlink init failed\n");
|
|
goto out;
|
|
}
|
|
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_qqlink_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 = fill_80211_frame(gBuf, gBufLen, 0, &channel);
|
|
if (ret == QLERROR_SUCCESS)
|
|
{
|
|
ret = ssv_smartlink_set_promisc(0);
|
|
if (ret < 0)
|
|
{
|
|
goto out;
|
|
}
|
|
break;
|
|
}
|
|
else if (ret == QLERROR_LOCK)
|
|
{
|
|
if (!locked)
|
|
{
|
|
locked = 1;
|
|
ret = _ssv_qqlink_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 == QLERROR_HOP)
|
|
{
|
|
}
|
|
else
|
|
{
|
|
}
|
|
}
|
|
ret = 0;
|
|
out:
|
|
(void)ssv_smartlink_stop();
|
|
if (ret == 0)
|
|
{
|
|
sprintf(cmdBuf, ssv_wpa_conf_file, file_path_getcwd);
|
|
if (0 == _ssv_qqlink_write_wpa_config_file(cmdBuf, _sz_ssid, _sz_password))
|
|
{
|
|
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);
|
|
}
|
|
return ret;
|
|
}
|