mirror of
https://github.com/Martin-P/OpenV2G.git
synced 2024-11-18 12:53:58 +00:00
This commit is contained in:
sebastiankb
parent
6ed75085e0
commit
8719ec6740
3 changed files with 0 additions and 384 deletions
|
|
@ -1,140 +0,0 @@
|
|||
/*
|
||||
* Copyright (C) 2010 INSYS Microelectronics GmbH
|
||||
*
|
||||
* This program is free software: you can redistribute it and/or modify
|
||||
* it under the terms of the GNU Lesser 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 Lesser General Public License for more details.
|
||||
*
|
||||
* You should have received a copy of the GNU Lesser General Public License
|
||||
* along with this program. If not, see <http://www.gnu.org/licenses/>.
|
||||
*/
|
||||
|
||||
/*******************************************************************
|
||||
*
|
||||
* @author mlauterbach
|
||||
* @version 0.0.1
|
||||
*
|
||||
********************************************************************/
|
||||
#include <stdio.h>
|
||||
#include <stdlib.h>
|
||||
#include <string.h>
|
||||
#include <sys/types.h>
|
||||
#include <sys/stat.h>
|
||||
#include <fcntl.h>
|
||||
#include <unistd.h>
|
||||
|
||||
#define EVSE 1
|
||||
#define PEV 2
|
||||
|
||||
static char *help_string =
|
||||
"%s: Valid parameters are:\n"
|
||||
" -v - print the program version and exit\n"
|
||||
" -d - daemonize this process\n"
|
||||
" -m<x> - mode of application with x=1 EVSE or x=2 PEV\n"
|
||||
" -h - help\n";
|
||||
|
||||
extern void run_evse(unsigned int port);
|
||||
extern void run_pev(unsigned int port);
|
||||
|
||||
|
||||
static void arg_error(char *name)
|
||||
{
|
||||
fprintf(stderr, help_string, name);
|
||||
exit(1);
|
||||
}
|
||||
|
||||
|
||||
int main_network_1(int argc, char *argv[])
|
||||
{
|
||||
int fd0, fd1, fd2;
|
||||
int i, pid;
|
||||
int daemonize = 0;
|
||||
int mode = -1;
|
||||
unsigned int port = 7259; /* TODO port is fix, should be configurable */
|
||||
|
||||
/* check arguments */
|
||||
if(argc == 1)
|
||||
arg_error("too few parameters");
|
||||
for (i = 1; i < argc; i++) {
|
||||
if ((argv[i][0] != '-') || (strlen(argv[i]) > 3)) {
|
||||
fprintf(stderr, "Invalid argument: '%s'\n", argv[i]);
|
||||
arg_error(argv[0]);
|
||||
}
|
||||
switch (argv[i][1]) {
|
||||
|
||||
case 'd':
|
||||
daemonize = 1;
|
||||
break;
|
||||
|
||||
case 'm':
|
||||
mode = atoi(&argv[i][2]);
|
||||
if(mode != EVSE && mode != PEV) {
|
||||
fprintf(stderr, "Invalid option: '%s'\n", argv[i]);
|
||||
arg_error(argv[0]);
|
||||
}
|
||||
break;
|
||||
|
||||
case 'h' :
|
||||
fprintf(stdout, help_string, argv[0]);
|
||||
exit(0);
|
||||
|
||||
case 'v':
|
||||
printf("%s Example 1: 0.0.1\n", argv[0]);
|
||||
exit(0);
|
||||
|
||||
default:
|
||||
fprintf(stderr, "Invalid option: '%s'\n", argv[i]);
|
||||
arg_error(argv[0]);
|
||||
}
|
||||
}
|
||||
|
||||
if (daemonize) {
|
||||
if ((pid = fork()) > 0) {
|
||||
exit(0);
|
||||
} else if (pid < 0) {
|
||||
printf("Error forking first fork\n");
|
||||
exit(1);
|
||||
} else {
|
||||
/* setsid() is necessary if we really want to demonize */
|
||||
if(setsid() == -1)
|
||||
printf("Error setsid()\n");
|
||||
/* Second fork to really deamonize me. */
|
||||
if ((pid = fork()) > 0) {
|
||||
exit(0);
|
||||
} else if (pid < 0) {
|
||||
printf("Error forking second fork\n");
|
||||
exit(1);
|
||||
}
|
||||
}
|
||||
/* change working directory to root so we won't prevent file systems
|
||||
* from being unmounted.
|
||||
*/
|
||||
if(chdir("/") < 0) {
|
||||
;
|
||||
}
|
||||
/* Attach file descriptors 0, 1, and 2 to /dev/null */
|
||||
fd0 = open("/dev/null", O_RDWR);
|
||||
fd1 = dup(0);
|
||||
fd2 = dup(0);
|
||||
}else {
|
||||
printf("+++Start EVSE/PEV Example+++\n\n");
|
||||
}
|
||||
|
||||
if (mode == EVSE) {
|
||||
printf("+++Start EVSE on port: %i+++\n\n", port);
|
||||
run_evse(port);
|
||||
|
||||
}else if (mode == PEV) {
|
||||
printf("+++Start PEV to port: %i+++\n\n", port);
|
||||
run_pev(port);
|
||||
}
|
||||
|
||||
printf("+++Terminate EV2SE Example+++\n\n");
|
||||
return 0;
|
||||
}
|
||||
|
|
@ -1,214 +0,0 @@
|
|||
/*
|
||||
* Copyright (C) 2010 INSYS Microelectronics GmbH
|
||||
*
|
||||
* This program is free software: you can redistribute it and/or modify
|
||||
* it under the terms of the GNU Lesser 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 Lesser General Public License for more details.
|
||||
*
|
||||
* You should have received a copy of the GNU Lesser General Public License
|
||||
* along with this program. If not, see <http://www.gnu.org/licenses/>.
|
||||
*/
|
||||
|
||||
/*******************************************************************
|
||||
*
|
||||
* @author mlauterbach
|
||||
* @version 0.0.1
|
||||
*
|
||||
********************************************************************/
|
||||
#include <netdb.h>
|
||||
#include <errno.h>
|
||||
#include <string.h>
|
||||
#include <stdio.h>
|
||||
#include <sys/select.h>
|
||||
#include <sys/socket.h>
|
||||
#include <sys/types.h>
|
||||
#include <time.h>
|
||||
#include <termios.h>
|
||||
#include <unistd.h>
|
||||
#include <netinet/in.h>
|
||||
#include <netinet/tcp.h>
|
||||
|
||||
fd_set master_fd; /* master fd list */
|
||||
fd_set read_fds; /* tmp fd list for select() */
|
||||
int fdmax; /* maximum file descriptor number */
|
||||
int listen_fd; /* file descriptor for TCP-Server */
|
||||
int pev_fd; /* file descriptor to PEV */
|
||||
|
||||
|
||||
static void close_server(void)
|
||||
{
|
||||
if(listen_fd == -1)
|
||||
return;
|
||||
tcflush(listen_fd, TCIOFLUSH);
|
||||
FD_CLR(listen_fd, &master_fd);
|
||||
close(listen_fd);
|
||||
listen_fd = -1;
|
||||
|
||||
return;
|
||||
}
|
||||
|
||||
|
||||
static void init_server(void)
|
||||
{
|
||||
listen_fd = -1;
|
||||
pev_fd = -1;
|
||||
FD_ZERO(&master_fd);
|
||||
FD_ZERO(&read_fds);
|
||||
|
||||
return;
|
||||
}
|
||||
|
||||
|
||||
static void cleanup_server(void)
|
||||
{
|
||||
close_server();
|
||||
if(pev_fd != -1) {
|
||||
close(pev_fd);
|
||||
pev_fd = -1;
|
||||
}
|
||||
return;
|
||||
}
|
||||
|
||||
|
||||
static int start_server(unsigned int port)
|
||||
{
|
||||
|
||||
int yes = 1;
|
||||
struct addrinfo hints;
|
||||
struct addrinfo *ai;
|
||||
char str_port[10];
|
||||
|
||||
memset(&hints, 0, sizeof hints);
|
||||
hints.ai_family = AF_INET;
|
||||
hints.ai_socktype = SOCK_STREAM;
|
||||
hints.ai_flags = AI_PASSIVE;
|
||||
|
||||
sprintf(str_port, "%d", port);
|
||||
if ((getaddrinfo(NULL, str_port, &hints, &ai)) != 0) {
|
||||
printf("ERROR: Could not get address info for the TCP listener: %s\n", strerror(errno));
|
||||
return -1;
|
||||
}
|
||||
|
||||
listen_fd = socket(ai->ai_family, ai->ai_socktype, ai->ai_protocol); /* create the socket */
|
||||
if (listen_fd < 0) {
|
||||
printf("ERROR: Creation of TCP listen socket failed: %s\n", strerror(errno));
|
||||
listen_fd = -1;
|
||||
return 1;
|
||||
}
|
||||
|
||||
setsockopt(listen_fd, SOL_SOCKET, SO_REUSEADDR, &yes, sizeof(int)); /* just some options */
|
||||
if (bind(listen_fd, ai->ai_addr, ai->ai_addrlen) < 0) { /* now we bind it to the port */
|
||||
printf("ERROR: Binding TCP listen socket failed: %s\n", strerror(errno));
|
||||
close(listen_fd);
|
||||
listen_fd = -1;
|
||||
return -1;
|
||||
|
||||
}
|
||||
freeaddrinfo(ai);
|
||||
|
||||
if (listen(listen_fd, 10) == -1) { /* and put the socket in listen-mode */
|
||||
printf("ERROR: Listening on TCP listen socket failed: %s\n", strerror(errno));
|
||||
close(listen_fd);
|
||||
listen_fd = -1;
|
||||
return -1;
|
||||
}
|
||||
|
||||
FD_SET(listen_fd, &master_fd);
|
||||
if(listen_fd > fdmax)
|
||||
fdmax = listen_fd;
|
||||
|
||||
printf("DEBUG: TCP-Server fd:%i\n", listen_fd);
|
||||
return listen_fd;
|
||||
}
|
||||
|
||||
|
||||
static int accept_connection(void)
|
||||
{
|
||||
|
||||
struct sockaddr_in remoteaddr;
|
||||
socklen_t addrlen = sizeof remoteaddr;
|
||||
|
||||
pev_fd = accept(listen_fd, (struct sockaddr *) &remoteaddr, &addrlen);
|
||||
if (pev_fd == -1) {
|
||||
printf("ERROR: Could not accept on TCP listen socket: %s\n", strerror(errno));
|
||||
return -1;
|
||||
}
|
||||
|
||||
FD_SET(pev_fd, &master_fd);
|
||||
if (pev_fd > fdmax) {
|
||||
fdmax = pev_fd;
|
||||
}
|
||||
|
||||
printf("PEV arrived .................... ;-)\n");
|
||||
close_server();
|
||||
return pev_fd;
|
||||
}
|
||||
|
||||
|
||||
static int handle_tcp_data(void)
|
||||
{
|
||||
ssize_t read_bytes;
|
||||
uint8_t buffer[512];
|
||||
|
||||
read_bytes = read(pev_fd, buffer, sizeof(buffer)); /* get data from PEV */
|
||||
if(read_bytes < 1) {
|
||||
if(errno != EAGAIN) {
|
||||
if(errno == EBADF)
|
||||
printf("ERROR: Reading from TCP failed: connection is gone\n");
|
||||
else
|
||||
printf("ERROR: Reading from TCP failed: %d: %s\n", errno, strerror(errno));
|
||||
printf("INFO: PEV gone\n");
|
||||
close(pev_fd);
|
||||
return -1;
|
||||
}
|
||||
}
|
||||
printf("INFO: number of bytes from PEV: %i\n", read_bytes);
|
||||
|
||||
/* TODO give data to DoIP/EXI Parser and send response to PEV, if a complete EXI msg. was received */
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
|
||||
void run_evse(unsigned int port)
|
||||
{
|
||||
int sel;
|
||||
struct timeval tv;
|
||||
|
||||
init_server();
|
||||
|
||||
listen_fd = start_server(port);
|
||||
if (listen_fd == -1) {
|
||||
printf("ERROR: open_server failed\n");
|
||||
return;
|
||||
}
|
||||
|
||||
for (;;) {
|
||||
|
||||
tv.tv_sec = 0;
|
||||
tv.tv_usec = 100000;
|
||||
FD_ZERO(&read_fds);
|
||||
read_fds = master_fd;
|
||||
|
||||
sel = select(fdmax + 1, &read_fds, NULL, NULL, &tv);
|
||||
if(sel > 0) {
|
||||
if (FD_ISSET(listen_fd, &read_fds))
|
||||
accept_connection();
|
||||
if (FD_ISSET(pev_fd, &read_fds))
|
||||
if(handle_tcp_data() == -1) { /* PEV gone */
|
||||
break;
|
||||
}
|
||||
}else if (sel == -1) {
|
||||
break;
|
||||
}
|
||||
}
|
||||
|
||||
cleanup_server();
|
||||
return;
|
||||
}
|
||||
|
|
@ -1,30 +0,0 @@
|
|||
/*
|
||||
* Copyright (C) 2010 INSYS Microelectronics GmbH
|
||||
*
|
||||
* This program is free software: you can redistribute it and/or modify
|
||||
* it under the terms of the GNU Lesser 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 Lesser General Public License for more details.
|
||||
*
|
||||
* You should have received a copy of the GNU Lesser General Public License
|
||||
* along with this program. If not, see <http://www.gnu.org/licenses/>.
|
||||
*/
|
||||
|
||||
/*******************************************************************
|
||||
*
|
||||
* @author mlauterbach
|
||||
* @version 0.0.1
|
||||
*
|
||||
********************************************************************/
|
||||
|
||||
void run_pev(unsigned int port)
|
||||
{
|
||||
|
||||
// TODO
|
||||
return;
|
||||
}
|
||||
Loading…
Reference in a new issue