76 lines
1.4 KiB
C++
76 lines
1.4 KiB
C++
|
#include "PinMonitor.h"
|
||
|
|
#include "DevUtil.h"
|
||
|
|
#include <unistd.h>
|
||
|
|
#include <fcntl.h>
|
||
|
|
#include <poll.h>
|
||
|
|
#include <thread>
|
||
|
|
#include <iostream>
|
||
|
|
#include "StopWatch.h"
|
||
|
|
|
||
|
|
PinMonitor::PinMonitor(unsigned int pinNum, std::function<void(int)> call_back)
|
||
|
|
: pin(pinNum)
|
||
|
|
{
|
||
|
|
pin.setDirection(Gpio::in);
|
||
|
|
pin.setEdge(Gpio::falling);
|
||
|
|
this->call_back = call_back;
|
||
|
|
thread_monitor = std::thread(&PinMonitor::monitor, this);
|
||
|
|
// printf("PinMonitor threadid = %d \n",thread_monitor.get_id());
|
||
|
|
}
|
||
|
|
|
||
|
|
PinMonitor::~PinMonitor()
|
||
|
|
{
|
||
|
|
bMonitor = false;
|
||
|
|
if (thread_monitor.joinable())
|
||
|
|
thread_monitor.join();
|
||
|
|
}
|
||
|
|
|
||
|
|
void PinMonitor::monitor()
|
||
|
|
{
|
||
|
|
pollfd pfd;
|
||
|
|
int ret = 0;
|
||
|
|
pfd.fd = -1;
|
||
|
|
char buf[8];
|
||
|
|
int num;
|
||
|
|
StopWatch sw;
|
||
|
|
|
||
|
|
pfd.fd = open(pin.getValuePath().c_str(), O_RDONLY);
|
||
|
|
if (pfd.fd < 0)
|
||
|
|
ret = -1;
|
||
|
|
|
||
|
|
pfd.events = POLLPRI;
|
||
|
|
num = read(pfd.fd, buf, 8); // This is to clear the avaible read
|
||
|
|
|
||
|
|
while (bMonitor)
|
||
|
|
{
|
||
|
|
ret = poll(&pfd, 1, 1000);
|
||
|
|
if (ret > 0)
|
||
|
|
{
|
||
|
|
if (pfd.revents & POLLPRI)
|
||
|
|
{
|
||
|
|
lseek(pfd.fd, 0, SEEK_SET);
|
||
|
|
num = read(pfd.fd, buf, 8);
|
||
|
|
|
||
|
|
buf[num - 1] = '\0';
|
||
|
|
ret = atoi(buf);
|
||
|
|
|
||
|
|
if (call_back)
|
||
|
|
call_back(pin.getPort());
|
||
|
|
|
||
|
|
sw.reset();
|
||
|
|
while (sw.elapsed_ms() < 30)
|
||
|
|
{
|
||
|
|
ret = poll(&pfd, 1, 1);
|
||
|
|
if (ret > 0)
|
||
|
|
{
|
||
|
|
num = read(pfd.fd, buf, 8);
|
||
|
|
buf[num - 1] = '\0';
|
||
|
|
ret = atoi(buf);
|
||
|
|
// printf("pMonitor nread = %d ret val = %d \n",num,ret);
|
||
|
|
}
|
||
|
|
}
|
||
|
|
}
|
||
|
|
}
|
||
|
|
}
|
||
|
|
|
||
|
|
close(pfd.fd);
|
||
|
|
}
|