frodovdr/octonet
1
0
Fork 0
mirror of https://github.com/DigitalDevices/octonet.git synced 2023-10-10 13:36:52 +02:00
Code Issues Releases Wiki Activity

add code to resolve gateway if client not local

Browse Source
This commit is contained in:
Ralph Metzler 2016-10-24 15:17:35 +02:00
parent 03a15dd9ee
commit 3d45ccf6fc
4 changed files with 95 additions and 1 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

89
octoserve/ntools.c
View File

@ -151,3 +151,92 @@ time_t mtime(time_t *t)
return ts.tv_sec;
}
struct nlreq {
struct nlmsghdr n;
struct rtmsg r;
char buf[1024];
};
int nlrequest(int fd, struct nlmsghdr *n, unsigned char *gw)
{
char buf[1024];
int rtl, len = 0, c;
struct nlmsghdr *nlp;
struct sockaddr_nl snl;
struct iovec iov = { (void *) n, n->nlmsg_len };
struct msghdr msg = { (void *) &snl, sizeof(snl),
&iov, 1, NULL, 0, 0 };
char *p = (char *) buf;
memset(&snl, 0, sizeof(snl));
snl.nl_family = AF_NETLINK;
sendmsg(fd, &msg, 0);
while (1) {
iov.iov_base = p;
iov.iov_len = sizeof(buf) - len;
c = recvmsg(fd, &msg, 0);
if (c < 0)
return -1;
if (c == 0)
break;
nlp = (struct nlmsghdr *)p;
if (nlp->nlmsg_type == NLMSG_DONE)
break;
if (nlp->nlmsg_type == NLMSG_ERROR)
break;
p += c;
len += c;
break;
}
for (nlp = (struct nlmsghdr *) buf; NLMSG_OK(nlp, len); nlp = NLMSG_NEXT(nlp, len)) {
struct rtmsg *rtp = (struct rtmsg *) NLMSG_DATA(nlp);
struct rtattr *rtap = (struct rtattr *) RTM_RTA(rtp);
for (rtl = RTM_PAYLOAD(nlp); RTA_OK(rtap, rtl); rtap = RTA_NEXT(rtap, rtl)) {
switch (rtap->rta_type) {
case RTA_GATEWAY:
memcpy(gw, RTA_DATA(rtap), 24);
break;
default:
break;
}
}
}
}
int get_route(unsigned char *ip)
{
struct sockaddr_nl snl;
struct nlreq req;
struct nlmsghdr *n = &req.n;
struct rtattr *rta;
int fd = socket(AF_NETLINK, SOCK_RAW, NETLINK_ROUTE);
memset(&snl, 0, sizeof(snl));
snl.nl_family = AF_NETLINK;
snl.nl_pid = getpid();
bind(fd, (struct sockaddr *) &snl, sizeof(snl));
memset(&req, 0, sizeof(req));
req.n.nlmsg_len = NLMSG_LENGTH(sizeof(struct rtmsg));
req.n.nlmsg_type = RTM_GETROUTE;
req.n.nlmsg_flags = NLM_F_REQUEST;
req.r.rtm_family = AF_INET;
//req.r.rtm_flags |= RTM_F_LOOKUP_TABLE;
req.r.rtm_table = 0;
req.r.rtm_dst_len = 32;
rta = (struct rtattr*)(((char*)n) + NLMSG_ALIGN(n->nlmsg_len));
rta->rta_type = RTA_DST;
rta->rta_len = RTA_LENGTH(4);
memcpy(RTA_DATA(rta), ip, 4);
n->nlmsg_len = NLMSG_ALIGN(n->nlmsg_len) + RTA_LENGTH(4);
nlrequest(fd, n, ip);
printf("IP/GW = %u.%u.%u.%u\n", ip[0], ip[1], ip[2], ip[3]);
close(fd);
}

3
octoserve/octoserve.c
View File

@ -126,6 +126,9 @@ static int get_mac(char *ifname, struct sockaddr *sadr, uint8_t *mac)
struct arpreq arpreq;
int s;
if (sadr->sa_family == AF_INET)
get_route(&((struct sockaddr_in *) sadr)->sin_addr);
s = socket(AF_INET, SOCK_DGRAM, 0);
if (s < 0)
return -1;

2
octoserve/octoserve.h
View File

@ -59,6 +59,7 @@
#include <linux/sockios.h>
#include <linux/filter.h>
#include <time.h>
#include <linux/rtnetlink.h>
#include <libdvben50221/en50221_stdcam.h>
@ -537,5 +538,6 @@ int sendlen(int sock, char *buf, int len);
int sendstring(int sock, char *fmt, ...);
time_t mtime(time_t *t);
int get_route(unsigned char *ip);
#endif

2
octoserve/version.h
View File

@ -19,5 +19,5 @@
#ifndef _OCTOSERVE_VERSION_
#define _OCTOSERVE_VERSION_
#define OCTOSERVE_VERSION "1.0.72"
#define OCTOSERVE_VERSION "1.0.74"
#endif