mirror of
https://github.com/caiwx86/small-packages.git
synced 2026-11-14 04:07:56 +08:00
422 lines
14 KiB
C
Executable File
422 lines
14 KiB
C
Executable File
#include <sys/socket.h>
|
|
#include <sys/select.h>
|
|
#include <sys/types.h>
|
|
#include <net/if.h>
|
|
#include <sys/socket.h>
|
|
#include <netinet/in.h>
|
|
#include <arpa/inet.h>
|
|
#include <endian.h>
|
|
|
|
#include "libmnl/ifutils.h"
|
|
#include "libmnl/dhcp/dhcp.h"
|
|
#include "util.h"
|
|
#include "QMIThread.h"
|
|
|
|
static int fibo_system(const char *shell_cmd)
|
|
{
|
|
int ret = 0;
|
|
dbg_time("%s", shell_cmd);
|
|
ret = system(shell_cmd);
|
|
if (ret) {
|
|
// dbg_time("Fail to system(\"%s\") = %d, errno: %d (%s)", shell_cmd,
|
|
// ret, errno, strerror(errno));
|
|
}
|
|
return ret;
|
|
}
|
|
|
|
int fibo_raw_ip_mode_check(const char *ifname)
|
|
{
|
|
int fd;
|
|
char raw_ip[128];
|
|
char mode[2] = "X";
|
|
int mode_change = 0;
|
|
|
|
snprintf(raw_ip, sizeof(raw_ip), "/sys/class/net/%s/qmi/raw_ip", ifname);
|
|
if (access(raw_ip, F_OK))
|
|
return 0;
|
|
|
|
fd = open(raw_ip, O_RDWR | O_NONBLOCK | O_NOCTTY);
|
|
if (fd < 0)
|
|
{
|
|
dbg_time("%s %d fail to open(%s), errno:%d (%s)", __FILE__, __LINE__, raw_ip, errno, strerror(errno));
|
|
return 0;
|
|
}
|
|
|
|
read(fd, mode, 2);
|
|
if (mode[0] == '0' || mode[0] == 'N')
|
|
{
|
|
if_link_down(ifname);
|
|
dbg_time("echo Y > /sys/class/net/%s/qmi/raw_ip", ifname);
|
|
mode[0] = 'Y';
|
|
write(fd, mode, 2);
|
|
mode_change = 1;
|
|
if_link_up(ifname);
|
|
}
|
|
|
|
close(fd);
|
|
return mode_change;
|
|
}
|
|
|
|
static void fibo_set_driver_link_state(PROFILE_T *profile, int link_state)
|
|
{
|
|
char link_file[128];
|
|
int fd;
|
|
int new_state = 0;
|
|
dbg_time("enter %s ", __func__);
|
|
|
|
snprintf(link_file, sizeof(link_file), "/sys/class/net/%s/link_state", profile->usbnet_adapter);
|
|
fd = open(link_file, O_RDWR | O_NONBLOCK | O_NOCTTY);
|
|
if (fd == -1)
|
|
{
|
|
if (errno != ENOENT)
|
|
dbg_time("Fail to access %s, errno: %d (%s)", link_file, errno, strerror(errno));
|
|
return;
|
|
}
|
|
|
|
if (profile->qmap_mode <= 1)
|
|
new_state = !!link_state;
|
|
else
|
|
{
|
|
//0x80 means link off this pdp
|
|
new_state = (link_state ? 0x00 : 0x80) + profile->pdp;
|
|
}
|
|
|
|
snprintf(link_file, sizeof(link_file), "%d\n", new_state);
|
|
write(fd, link_file, sizeof(link_file));
|
|
|
|
if (link_state == 0 && profile->qmap_mode > 1)
|
|
{
|
|
size_t rc;
|
|
|
|
lseek(fd, 0, SEEK_SET);
|
|
rc = read(fd, link_file, sizeof(link_file));
|
|
if (rc > 1 && (!strcasecmp(link_file, "0\n") || !strcasecmp(link_file, "0x0\n")))
|
|
{
|
|
// if_link_down(profile->usbnet_adapter);
|
|
}
|
|
}
|
|
|
|
close(fd);
|
|
}
|
|
|
|
void udhcpc_start(PROFILE_T *profile)
|
|
{
|
|
//2021-02-01 willa.liu@fibocom.com changed begin for support mantis 0069837
|
|
char *ifname = profile->usbnet_adapter;
|
|
char shell_cmd[512];
|
|
|
|
fibo_set_driver_link_state(profile, 1);
|
|
fibo_raw_ip_mode_check(ifname);
|
|
|
|
if (profile->qmapnet_adapter)
|
|
{
|
|
ifname = profile->qmapnet_adapter;
|
|
}
|
|
if (profile->rawIP && profile->ipv4.Address && profile->ipv4.Mtu)
|
|
{
|
|
if_set_mtu(ifname, (profile->ipv4.Mtu));
|
|
}
|
|
|
|
if (strcmp(ifname, profile->usbnet_adapter))
|
|
{
|
|
//if_link_up(profile->usbnet_adapter);
|
|
snprintf(shell_cmd, sizeof(shell_cmd) - 1, "ifconfig %s up", profile->usbnet_adapter);
|
|
fibo_system(shell_cmd);
|
|
}
|
|
//2021-02-01 willa.liu@fibocom.com changed begin for support mantis 0069837
|
|
if_link_up(ifname);
|
|
|
|
#if 1 //for bridge mode, only one public IP, so do udhcpc manually
|
|
if (fibo_bridge_mode_detect(profile))
|
|
{
|
|
return;
|
|
}
|
|
#endif
|
|
// if use DHCP(should make with ${DHCP} src files)
|
|
// do_dhcp(ifname);
|
|
// return 0;
|
|
/* IPv4 Addr Info */
|
|
if (profile->ipv4.Address)
|
|
{
|
|
dbg_time("IPv4 MTU: %d", profile->ipv4.Mtu);
|
|
dbg_time("IPv4 Address: %s", ipaddr_to_string_v4(ntohl(profile->ipv4.Address)));
|
|
dbg_time("IPv4 Netmask: %d", mask_to_prefix_v4(ntohl(profile->ipv4.SubnetMask)));
|
|
dbg_time("IPv4 Gateway: %s", ipaddr_to_string_v4(ntohl(profile->ipv4.Gateway)));
|
|
dbg_time("IPv4 DNS1: %s", ipaddr_to_string_v4(ntohl(profile->ipv4.DnsPrimary)));
|
|
dbg_time("IPv4 DNS2: %s", ipaddr_to_string_v4(ntohl(profile->ipv4.DnsSecondary)));
|
|
if_set_network_v4(ifname, ntohl(profile->ipv4.Address),
|
|
mask_to_prefix_v4(profile->ipv4.SubnetMask),
|
|
ntohl(profile->ipv4.Gateway),
|
|
ntohl(profile->ipv4.DnsPrimary),
|
|
ntohl(profile->ipv4.DnsSecondary));
|
|
}
|
|
else
|
|
{
|
|
dbg_time("The IPv4 Address in profile is NULL");
|
|
}
|
|
|
|
if (profile->ipv6.Address && (profile->ipv6.PrefixLengthIPAddr != 0))
|
|
{
|
|
//module do not support DHCPv6, only support 'Router Solicit'
|
|
//and it seem if enable /proc/sys/net/ipv6/conf/all/forwarding, Kernel do not send RS
|
|
const char *forward_file = "/proc/sys/net/ipv6/conf/all/forwarding";
|
|
int forward_fd = open(forward_file, O_RDONLY);
|
|
if (forward_fd > 0)
|
|
{
|
|
char forward_state[2];
|
|
read(forward_fd, forward_state, 2);
|
|
if (forward_state[0] == '1')
|
|
{
|
|
dbg_time("%s enabled, kernel maybe donot send 'Router Solicit'", forward_file);
|
|
}
|
|
close(forward_fd);
|
|
}
|
|
|
|
dbg_time("IPv6 MTU: %d", profile->ipv6.Mtu);
|
|
dbg_time("IPv6 Address: %s", ipaddr_to_string_v6(profile->ipv6.Address));
|
|
dbg_time("IPv6 PrefixLengthIPAddr: %d", profile->ipv6.PrefixLengthIPAddr);
|
|
dbg_time("IPv6 Gateway: %s", ipaddr_to_string_v6(profile->ipv6.Gateway));
|
|
dbg_time("IPv6 DNS1: %s", ipaddr_to_string_v6(profile->ipv6.DnsPrimary));
|
|
dbg_time("IPv6 DNS2: %s", ipaddr_to_string_v6(profile->ipv6.DnsSecondary));
|
|
if_set_network_v6(ifname, profile->ipv6.Address, profile->ipv6.PrefixLengthIPAddr,
|
|
profile->ipv6.Gateway, profile->ipv6.DnsPrimary, profile->ipv6.DnsSecondary);
|
|
}
|
|
else
|
|
{
|
|
dbg_time("The IPv6 Address in profile is NULL");
|
|
}
|
|
}
|
|
|
|
void udhcpc_stop(PROFILE_T *profile)
|
|
{
|
|
char *ifname = profile->usbnet_adapter;
|
|
dbg_time("enter %s ", __func__);
|
|
|
|
fibo_set_driver_link_state(profile, 0);
|
|
|
|
if (profile->qmapnet_adapter)
|
|
{
|
|
ifname = profile->qmapnet_adapter;
|
|
}
|
|
|
|
if_flush_v4_addr(ifname);
|
|
if_flush_v6_addr(ifname);
|
|
if_link_down(ifname);
|
|
}
|
|
|
|
static void fibo_set_mtu(const char *ifname, int ifru_mtu) {
|
|
int inet_sock;
|
|
struct ifreq ifr;
|
|
|
|
inet_sock = socket(AF_INET, SOCK_DGRAM, 0);
|
|
|
|
if (inet_sock > 0) {
|
|
strcpy(ifr.ifr_name, ifname);
|
|
|
|
if (!ioctl(inet_sock, SIOCGIFMTU, &ifr)) {
|
|
if (ifr.ifr_ifru.ifru_mtu != ifru_mtu) {
|
|
dbg_time("change mtu %d -> %d", ifr.ifr_ifru.ifru_mtu , ifru_mtu);
|
|
ifr.ifr_ifru.ifru_mtu = ifru_mtu;
|
|
ioctl(inet_sock, SIOCSIFMTU, &ifr);
|
|
}
|
|
}
|
|
|
|
close(inet_sock);
|
|
}
|
|
}
|
|
|
|
static void* udhcpc_thread_function(void* arg) {
|
|
FILE * udhcpc_fp;
|
|
char *udhcpc_cmd = (char *)arg;
|
|
|
|
if (udhcpc_cmd == NULL)
|
|
return NULL;
|
|
|
|
dbg_time("%s", udhcpc_cmd);
|
|
udhcpc_fp = popen(udhcpc_cmd, "r");
|
|
free(udhcpc_cmd);
|
|
if (udhcpc_fp) {
|
|
char buf[0xff];
|
|
|
|
buf[sizeof(buf)-1] = '\0';
|
|
while((fgets(buf, sizeof(buf)-1, udhcpc_fp)) != NULL) {
|
|
if ((strlen(buf) > 1) && (buf[strlen(buf) - 1] == '\n'))
|
|
buf[strlen(buf) - 1] = '\0';
|
|
dbg_time("%s", buf);
|
|
}
|
|
|
|
pclose(udhcpc_fp);
|
|
}
|
|
|
|
return NULL;
|
|
}
|
|
|
|
void udhcpc_start_pcie(PROFILE_T *profile) {
|
|
char *ifname = profile->usbnet_adapter;
|
|
char sub_intf_name[100] = {0};
|
|
int intf_id = 0;
|
|
char shell_cmd[512];
|
|
dbg_time("enter %s ", __func__);
|
|
|
|
if (profile->qmapnet_adapter) {
|
|
ifname = profile->qmapnet_adapter;
|
|
}
|
|
|
|
if (profile->muxid > 0x81)
|
|
{
|
|
intf_id = profile->muxid - 0x81;
|
|
snprintf(sub_intf_name, sizeof(sub_intf_name) - 1, "%s.%d", ifname, intf_id);
|
|
}
|
|
|
|
if (profile->rawIP && profile->ipv4.Address && profile->ipv4.Mtu) {
|
|
fibo_set_mtu(ifname, (profile->ipv4.Mtu));
|
|
}
|
|
|
|
fibo_system("echo 1 > /sys/module/fibo_mhi/parameters/macaddr_check");
|
|
|
|
if (strcmp(ifname, profile->usbnet_adapter)) {
|
|
snprintf(shell_cmd, sizeof(shell_cmd) - 1, "ifconfig %s up", profile->usbnet_adapter);
|
|
fibo_system(shell_cmd);
|
|
}
|
|
|
|
// For IPv6, down & up will send protocol packets, and that's needed.
|
|
if (profile->ipv6_flag && profile->muxid <= 0x81) {
|
|
snprintf(shell_cmd, sizeof(shell_cmd) - 1, "ifconfig %s down", ifname);
|
|
fibo_system(shell_cmd);
|
|
}
|
|
|
|
snprintf(shell_cmd, sizeof(shell_cmd) - 1, "ifconfig %s up", ifname);
|
|
fibo_system(shell_cmd);
|
|
|
|
//for bridge mode, only one public IP, so do udhcpc manually
|
|
if (fibo_bridge_mode_detect(profile)) {
|
|
return;
|
|
}
|
|
|
|
/* Do DHCP using busybox tools */
|
|
{
|
|
char udhcpc_cmd[128];
|
|
pthread_attr_t udhcpc_thread_attr;
|
|
pthread_t udhcpc_thread_id;
|
|
|
|
pthread_attr_init(&udhcpc_thread_attr);
|
|
pthread_attr_setdetachstate(&udhcpc_thread_attr, PTHREAD_CREATE_DETACHED);
|
|
|
|
if (profile->ipv4.Address)
|
|
{
|
|
char v4add_str[32] = {0};
|
|
char v4gw_str[32] = {0};
|
|
char v4_netmask_str[32] = {0};
|
|
uint32_t Address = ntohl(profile->ipv4.Address);
|
|
uint32_t Gateway = ntohl(profile->ipv4.Gateway);
|
|
uint32_t SubnetMask = ntohl(profile->ipv4.SubnetMask);
|
|
inet_ntop(AF_INET, &Address, v4add_str, sizeof(v4add_str));
|
|
inet_ntop(AF_INET, &Gateway, v4gw_str, sizeof(v4gw_str));
|
|
inet_ntop(AF_INET, &SubnetMask, v4_netmask_str, sizeof(v4_netmask_str));
|
|
|
|
if (profile->muxid == 0x81)
|
|
{
|
|
snprintf(shell_cmd, sizeof(shell_cmd) - 1, "ifconfig %s %s netmask %s", ifname, v4add_str, v4_netmask_str);
|
|
fibo_system(shell_cmd);
|
|
|
|
snprintf(shell_cmd, sizeof(shell_cmd) - 1, "route add default gw %s dev %s", v4gw_str, ifname);
|
|
fibo_system(shell_cmd);
|
|
}
|
|
else if (profile->muxid > 0x81)
|
|
{
|
|
snprintf(shell_cmd, sizeof(shell_cmd) - 1, "ip link add link %s name %s type vlan id %d", ifname, sub_intf_name, intf_id);
|
|
fibo_system(shell_cmd);
|
|
|
|
snprintf(shell_cmd, sizeof(shell_cmd) - 1, "ip link set %s up", ifname);
|
|
fibo_system(shell_cmd);
|
|
|
|
snprintf(shell_cmd, sizeof(shell_cmd) - 1, "ip link set %s up", sub_intf_name);
|
|
fibo_system(shell_cmd);
|
|
|
|
snprintf(shell_cmd, sizeof(shell_cmd) - 1, "ifconfig %s %s netmask %s", sub_intf_name, v4add_str, v4_netmask_str);
|
|
fibo_system(shell_cmd);
|
|
}
|
|
}
|
|
|
|
if (profile->ipv6.PrefixLengthIPAddr)
|
|
{
|
|
//module do not support DHCPv6, only support 'Router Solicit'
|
|
//and it seem if enable /proc/sys/net/ipv6/conf/all/forwarding, Kernel do not send RS
|
|
const char *forward_file = "/proc/sys/net/ipv6/conf/all/forwarding";
|
|
int forward_fd = open(forward_file, O_RDONLY);
|
|
if (forward_fd > 0) {
|
|
char forward_state[2];
|
|
read(forward_fd, forward_state, 2);
|
|
if (forward_state[0] == '1') {
|
|
dbg_time("%s enabled, kernel maybe donot send 'Router Solicit'", forward_file);
|
|
}
|
|
close(forward_fd);
|
|
}
|
|
|
|
{
|
|
char v6add_str[100] = {0};
|
|
char v6gw_str[100] = {0};
|
|
inet_ntop(AF_INET6, profile->ipv6.Address, v6add_str, sizeof(v6add_str));
|
|
inet_ntop(AF_INET6, profile->ipv6.Gateway, v6gw_str, sizeof(v6gw_str));
|
|
|
|
if (profile->muxid == 0x81)
|
|
{
|
|
snprintf(shell_cmd, sizeof(shell_cmd) - 1, "ifconfig %s add %s/%d", ifname, v6add_str, profile->ipv6.PrefixLengthIPAddr);
|
|
fibo_system(shell_cmd);
|
|
|
|
snprintf(shell_cmd, sizeof(shell_cmd) - 1, "route -A inet6 add ::/0 gw %s dev %s", v6gw_str, ifname);
|
|
fibo_system(shell_cmd);
|
|
}
|
|
else if (profile->muxid > 0x81)
|
|
{
|
|
snprintf(shell_cmd, sizeof(shell_cmd) - 1, "ip link add link %s name %s type vlan id %d", ifname, sub_intf_name, intf_id);
|
|
fibo_system(shell_cmd);
|
|
|
|
snprintf(shell_cmd, sizeof(shell_cmd) - 1, "ip link set %s up", ifname);
|
|
fibo_system(shell_cmd);
|
|
|
|
snprintf(shell_cmd, sizeof(shell_cmd) - 1, "ip link set %s up", sub_intf_name);
|
|
fibo_system(shell_cmd);
|
|
|
|
snprintf(shell_cmd, sizeof(shell_cmd) - 1, "ifconfig %s add %s/%d", sub_intf_name, v6add_str, profile->ipv6.PrefixLengthIPAddr);
|
|
fibo_system(shell_cmd);
|
|
/* start 2021-01-21 add by haopengfei to fix mantis 69056 */
|
|
snprintf(shell_cmd, sizeof(shell_cmd) - 1, "route -A inet6 add ::/0 gw %s dev %s", v6gw_str, sub_intf_name);
|
|
fibo_system(shell_cmd);
|
|
/* end 2021-01-21 add by haopengfei to fix mantis 69056 */
|
|
}
|
|
}
|
|
|
|
}
|
|
}
|
|
}
|
|
|
|
void udhcpc_stop_pcie(PROFILE_T *profile) {
|
|
char *ifname = profile->usbnet_adapter;
|
|
char shell_cmd[128];
|
|
char reset_ip[128];
|
|
dbg_time("enter %s ", __func__);
|
|
|
|
if (profile->qmapnet_adapter) {
|
|
ifname = profile->qmapnet_adapter;
|
|
}
|
|
|
|
if (profile->muxid == 0x81)
|
|
{
|
|
snprintf(shell_cmd, sizeof(shell_cmd) - 1, "ifconfig %s down", ifname);
|
|
fibo_system(shell_cmd);
|
|
snprintf(reset_ip, sizeof(reset_ip) - 1, "ifconfig %s 0.0.0.0", ifname);
|
|
fibo_system(reset_ip);
|
|
}
|
|
else if (profile->muxid > 0x81)
|
|
{
|
|
char sub_intf_name[100];
|
|
int intf_id = profile->muxid - 0x81;
|
|
snprintf(sub_intf_name, sizeof(sub_intf_name) - 1, "%s.%d", ifname, intf_id);
|
|
|
|
snprintf(shell_cmd, sizeof(shell_cmd) - 1, "ip link del link dev %s", sub_intf_name);
|
|
fibo_system(shell_cmd);
|
|
}
|
|
}
|
|
|