ret = recv(fd, buffer, sizeof(buffer), 0);
if(!ret)
return 1;
+ if(ret < 0)
+ return ret;
+
char* saveptr;
char* tok = strtok_r(buffer, "\n\r", &saveptr);
do {
+ if(!tok)
+ continue;
+
ret = handle_command(tok, fd, cmd_q, client_lst);
if(ret < 0)
return ret;
ret = read(door_fd, buffer, sizeof(buffer));
if(!ret)
return 2;
+ if(ret < 0)
+ return ret;
+
char* saveptr;
char* tok = strtok_r(buffer, "\n\r", &saveptr);
do {
- if(!cmd_q || !(*cmd_q))
- break;
+ if(!tok)
+ continue;
+
+ log_printf(NOTICE, "door-firmware: %s", tok);
- send_response((*cmd_q)->fd, tok);
+ int cmd_fd = -1;
+ if(cmd_q && (*cmd_q)) {
+ cmd_fd = (*cmd_q)->fd;
+ send_response(cmd_fd, tok);
+ }
if(!strncmp(tok, "Status:", 7)) {
client_t* client;
for(client = client_lst; client; client = client->next)
- if(client->status_listener && client->fd != (*cmd_q)->fd)
+ if(client->status_listener && client->fd != cmd_fd)
send_response(client->fd, tok);
}
return ret;
}
+ tmio.c_lflag &= ~ECHO;
+
ret = tcsetattr(fd, TCSANOW, &tmio);
if(ret) {
log_printf(ERROR, "Error on tcsetattr(): %s", strerror(errno));
return ret;
}
+ ret = tcflush(fd, TCIFLUSH);
+ if(ret) {
+ log_printf(ERROR, "Error on tcflush(): %s", strerror(errno));
+ return ret;
+ }
+
+ fd_set fds;
+ struct timeval tv;
+ FD_ZERO(&fds);
+ FD_SET(fd, &fds);
+ tv.tv_sec = 0;
+ tv.tv_usec = 50000;
+ for(;;) {
+ ret = select(fd+1, &fds, NULL, NULL, &tv);
+ if(ret > 0) {
+ char buffer[100];
+ ret = read(fd, buffer, sizeof(buffer));
+ }
+ else
+ break;
+ }
+
return 0;
}