Timeout if something is wrong.
This commit is contained in:
parent
9cf2936d6f
commit
1d9bbd6d10
@ -44,6 +44,7 @@
|
|||||||
#include <sys/ioctl.h>
|
#include <sys/ioctl.h>
|
||||||
#include <sys/types.h>
|
#include <sys/types.h>
|
||||||
#include <errno.h>
|
#include <errno.h>
|
||||||
|
#include <poll.h>
|
||||||
#include <pthread.h>
|
#include <pthread.h>
|
||||||
#define MODEM_C
|
#define MODEM_C
|
||||||
#include <phoned.h>
|
#include <phoned.h>
|
||||||
@ -88,6 +89,7 @@ char *sendwr(str, bufferback, howmuch)
|
|||||||
char *bufferback;
|
char *bufferback;
|
||||||
size_t howmuch;
|
size_t howmuch;
|
||||||
{
|
{
|
||||||
|
struct pollfd fds[1];
|
||||||
if(pthread_mutex_trylock(&modemmx) != 0 && pthread_mutex_trylock(&miomx) != 0) {
|
if(pthread_mutex_trylock(&modemmx) != 0 && pthread_mutex_trylock(&miomx) != 0) {
|
||||||
pthread_mutex_lock(&mpipemx);
|
pthread_mutex_lock(&mpipemx);
|
||||||
write(modempipes[1], "G", 1);
|
write(modempipes[1], "G", 1);
|
||||||
@ -95,8 +97,23 @@ char *sendwr(str, bufferback, howmuch)
|
|||||||
pthread_mutex_lock(&modemmx);
|
pthread_mutex_lock(&modemmx);
|
||||||
write(modemfd, str, strlen(str) + 1);
|
write(modemfd, str, strlen(str) + 1);
|
||||||
write(modemfd, "\r\n", 3);
|
write(modemfd, "\r\n", 3);
|
||||||
read(modemfd, bufferback, howmuch);
|
fds[0].fd = modemfd;
|
||||||
|
fds[0].events = POLLRDNORM;
|
||||||
|
switch(poll(fds, 1, 3000)) {
|
||||||
|
case 0:
|
||||||
|
pthread_cond_signal(&mpcond);
|
||||||
|
pthread_mutex_unlock(&modemmx);
|
||||||
|
snprintf(bufferback, howmuch, "*MODEM TIMEOUT*");
|
||||||
|
return bufferback;
|
||||||
|
case -1:
|
||||||
|
lprintf(error, "poll in sendwr: %s\n", strerror(errno));
|
||||||
|
pthread_cond_signal(&mpcond);
|
||||||
|
pthread_mutex_unlock(&modemmx);
|
||||||
|
return bufferback;
|
||||||
|
default:
|
||||||
fgets(bufferback, howmuch, modem);
|
fgets(bufferback, howmuch, modem);
|
||||||
|
break;
|
||||||
|
}
|
||||||
pthread_cond_signal(&mpcond);
|
pthread_cond_signal(&mpcond);
|
||||||
pthread_mutex_unlock(&modemmx);
|
pthread_mutex_unlock(&modemmx);
|
||||||
} else {
|
} else {
|
||||||
|
Loading…
Reference in New Issue
Block a user