emgauwa/controller-legacy
2
0
Fork 0
Code Issues Pull requests Projects Releases Packages Wiki Activity

add: gpio drivers

Browse source
This commit is contained in:
Tobias Reisinger 2020-04-16 21:19:56 +02:00
parent ba70677393
commit 3cd6668f9c
8 changed files with 131 additions and 76 deletions

91
main.c
View file

@ -12,6 +12,7 @@
#include <models/controller.h>
#include <database.h>
#include <config.h>
#include <constants.h>
#include <handlers.h>
#include <drivers.h>
#include <enums.h>
@ -21,17 +22,18 @@
#include <wiring_debug.h>
static MDB_env *mdb_env;
static int fd_discovery;
static int fd_command;
static controller_t *this_controller;
static struct pollfd poll_fds[POLL_FDS_COUNT];
static void
terminate(int signum)
{
LOG_INFO("terminating controller (%d)", signum);
close(fd_discovery);
close(fd_command);
for(int i = 0; i < POLL_FDS_COUNT; ++i)
{
close(poll_fds[i].fd);
}
mdb_env_close(mdb_env);
@ -40,34 +42,6 @@ terminate(int signum)
exit(signum);
}
static void
handle_poll(struct pollfd *fds, int fd_count)
{
/* An event on one of the fds has occurred. */
for(int i = 0; i < fd_count; i++) {
if(fds[i].revents & POLLIN)
{
/* data may be read on device number i. */
LOG_DEBUG("fd %i may read data", fds[i].fd);
switch(i)
{
case POLL_FGS_DISCOVERY:
handler_discovery(fd_discovery, this_controller);
break;
case POLL_FGS_COMMAND:
handler_command(fd_command, this_controller);
controller_save(this_controller, mdb_env);
break;
}
}
if(fds[i].revents & POLLHUP)
{
/* A hangup has occurred on device number i. */
LOG_DEBUG("fd %i got closed", fds[i].fd);
}
}
}
/**
* @brief The main function
*
@ -97,8 +71,8 @@ main(int argc, char** argv)
this_controller = controller_load(mdb_env);
fd_discovery = helper_open_discovery_socket(this_controller->discovery_port);
fd_command = helper_bind_tcp_server("0.0.0.0", this_controller->command_port, 128);
int fd_discovery = helper_open_discovery_socket(this_controller->discovery_port);
int fd_command = helper_bind_tcp_server("0.0.0.0", this_controller->command_port, 128);
this_controller->command_port = helper_get_port(fd_command);
@ -113,61 +87,30 @@ main(int argc, char** argv)
/******************** SETUP SOCKETS ********************/
struct pollfd fds[2];
int timeout_msecs = ACCEPT_TIMEOUT_MSECONDS;
int ret;
int fd_count = 0;
/* Open STREAMS device. */
fds[POLL_FGS_DISCOVERY].fd = fd_discovery;
fds[POLL_FGS_DISCOVERY].events = POLLIN;
LOG_DEBUG("setup fd_discovery as %i on index %i", fd_discovery, fd_count);
fd_count++;
fds[POLL_FGS_COMMAND].fd = fd_command;
fds[POLL_FGS_COMMAND].events = POLLIN;
LOG_DEBUG("setup fd_command as %i on index %i", fd_command, fd_count);
fd_count++;
poll_fds[POLL_FDS_DISCOVERY].fd = fd_discovery;
poll_fds[POLL_FDS_DISCOVERY].events = POLLIN;
LOG_DEBUG("setup fd_discovery as %i on index %i", fd_discovery, POLL_FDS_DISCOVERY);
poll_fds[POLL_FDS_COMMAND].fd = fd_command;
poll_fds[POLL_FDS_COMMAND].events = POLLIN;
LOG_DEBUG("setup fd_command as %i on index %i", fd_command, POLL_FDS_COMMAND);
/******************** START MAIN LOOP ********************/
for(;;)
{
ret = poll(fds, fd_count, timeout_msecs);
ret = poll(poll_fds, POLL_FDS_COUNT, timeout_msecs);
if(ret == 0)
{
LOG_DEBUG("===== IDLE LOOP START =====");
for(uint_fast8_t i = 0; i < this_controller->relay_count; ++i)
{
relay_t *relay = this_controller->relays[i];
if(relay_is_active(relay, time(NULL)))
{
LOG_DEBUG("relay %d is active", i);
if(relay->number >= 2)
{
driver_gpio_set(relay, HIGH);
}
else
{
driver_piface_set(relay, HIGH);
}
}
else
{
if(relay->number >= 2)
{
driver_gpio_set(relay, LOW);
}
else
{
driver_piface_set(relay, LOW);
}
}
}
handler_loop(this_controller);
}
if(ret > 0)
{
handle_poll(fds, fd_count);
handler_poll(poll_fds, this_controller, mdb_env);
}
}