#include <stdio.h>
#include <unistd.h>
#include <fcntl.h>
+#include <errno.h>
+#include <string.h>
#include <linux/input.h>
#define DELAY 10
// Constants for the signals sent.
#define JOG_BACK1 10001
#define JOG_FWD1 10002
+#define KEY_EVENT_OFFSET 20000
// middle value for shuttle, will be +/-MAX_SHUTTLE_RANGE
-#define JOG_STOP 10010
+#define JOG_STOP 10020
#define MAX_SHUTTLE_RANGE 7
-// TODO(fleury): this should probably be a user configuration parameter (at least the max speed).
-const double SPEEDS[MAX_SHUTTLE_RANGE + 1] = {0.0, 0.5, 1.0, 2.0, 4.0, 8.0, 16.0, 32.0};
-
-
void ShuttleThread::init(QObject *parent, QString device)
{
m_parent = parent;
stop_me = false;
m_isWorking = false;
shuttlevalue = 0xffff;
- shuttlechange = false;
+ shuttlecounter = 0;
jogvalue = 0xffff;
}
void ShuttleThread::run()
{
- kDebug() << "------- STARTING SHUTTLE: " << m_device;
-
- const int fd = KDE_open((char *) m_device.toUtf8().data(), O_RDONLY);
- if (fd < 0) {
- fprintf(stderr, "Can't open Jog Shuttle FILE DESCRIPTOR\n");
- return;;
- }
- EV ev;
-
- if (ioctl(fd, EVIOCGRAB, 1) < 0) {
- fprintf(stderr, "Can't get exclusive access on Jog Shuttle FILE DESCRIPTOR\n");
- return;;
- }
-
- int num_warnings = 0;
- while (!stop_me) {
- if (read(fd, &ev, sizeof(ev)) < 0) {
- if (num_warnings % 100 == 0)
- fprintf(stderr, "Failed to read event from Jog Shuttle FILE DESCRIPTOR (repeated %d times)\n", num_warnings + 1);
- num_warnings++;
- }
- handle_event(ev);
- }
- close(fd);
-
+ kDebug() << "------- STARTING SHUTTLE: " << m_device;
+ /* open file descriptor */
+ const int fd = KDE_open((char *) m_device.toUtf8().data(), O_RDONLY);
+ if (fd < 0) {
+ perror("Can't open Jog Shuttle FILE DESCRIPTOR");
+ return;
+ }
+
+ EV ev;
+
+ if (ioctl(fd, EVIOCGRAB, 1) < 0) {
+ fprintf(stderr, "Can't get exclusive access on Jog Shuttle FILE DESCRIPTOR\n");
+ close(fd);
+ return;
+ }
+
+ fd_set readset;
+ struct timeval timeout;
+
+ int num_warnings, readResult = 0;
+ int result, iof = -1;
+
+ /* get fd settings */
+ if ((iof = fcntl(fd, F_GETFL, 0)) != -1) {
+ /* set fd non blocking */
+ fcntl(fd, F_SETFL, iof | O_NONBLOCK);
+ } else {
+ fprintf(stderr, "Can't set Jog Shuttle FILE DESCRIPTOR to O_NONBLOCK and stop thread\n");
+ return;
+ }
+
+ /* enter thread loop */
+ while (!stop_me) {
+ /* reset the read set */
+ FD_ZERO(&readset);
+ FD_SET(fd, &readset);
+
+ /* reinit the timeout structure */
+ timeout.tv_sec = 0;
+ timeout.tv_usec = 400000; /* 400 ms */
+
+ /* do select in blocked mode and wake up after timeout for eval stop_me */
+ result = select(fd+1, &readset, NULL, NULL, &timeout);
+
+ /* see if there was an error or timeout else process event */
+ if (result < 0 && errno == EINTR) {
+ /* EINTR event catched. This is not a problem - continue processing */
+ kDebug() << strerror(errno) << "\n";
+ /* continue processing */
+ continue;
+ } else if (result < 0) {
+ /* stop thread */
+ stop_me = true;
+ kDebug() << strerror(errno) << "\n";
+ } else if (result == 0) {
+ /* do nothing. reserved for future purposes */
+ } else {
+ /* we have input */
+ if (FD_ISSET(fd, &readset)) {
+ /* read input */
+ readResult = read(fd, &ev, sizeof(ev));
+ if (readResult < 0) {
+ if (num_warnings % 10000 == 0) {
+ /* if device is not available anymore - dead or disconnected */
+ fprintf(stderr, "Failed to read event from Jog Shuttle FILE DESCRIPTOR (repeated %d times)\n", num_warnings + 1);
+ }
+ /* exit if device is not available or the error occurs to long */
+ if (errno == ENODEV) {
+ perror("Failed to read from Jog Shuttle FILE DESCRIPTOR. Stop thread");
+ /* stop thread */
+ stop_me = true;
+ } else if (num_warnings > 1000000) {
+ perror("Failed to read from Jog Shuttle FILE DESCRIPTOR. Limit reached. Stop thread");
+ /* stop thread */
+ stop_me = true;
+ }
+ num_warnings++;
+ } else if (readResult == sizeof(ev)) {
+ /* process event */
+ handle_event(ev);
+ } else {
+ fprintf(stderr, "Read nr of bytes != sizeof(ev)\n");
+ }
+ }
+ }
+ }
+
+// kDebug() << "Close thread" << "\n";
+ /* close the handle and return thread */
+ close(fd);
}
void ShuttleThread::handle_event(EV ev)
if (code > 16)
return;
- kDebug() << "Button PRESSED: " << code;
- QApplication::postEvent(m_parent, new QEvent((QEvent::Type)(20000 + code)));
+ //kDebug() << "Button PRESSED: " << code;
+ QApplication::postEvent(m_parent, new QEvent((QEvent::Type)(KEY_EVENT_OFFSET + code)));
}
//gettimeofday( &last_shuttle, 0 );
//need_synthetic_shuttle = value != 0;
- if (value == shuttlevalue)
+ if (value == shuttlevalue) {
+ shuttlecounter = 1;
return;
+ }
if (value > MAX_SHUTTLE_RANGE || value < -MAX_SHUTTLE_RANGE) {
fprintf(stderr, "Jog Shuttle returned value of %d (should be between -%d ad +%d)", value, MAX_SHUTTLE_RANGE, MAX_SHUTTLE_RANGE);
return;
}
shuttlevalue = value;
- shuttlechange = true;
- QApplication::postEvent(m_parent, new QEvent((QEvent::Type)(JOG_STOP + value)));
+ shuttlecounter = 1;
+ QApplication::postEvent(m_parent, new QEvent((QEvent::Type) (JOG_STOP + value)));
}
void ShuttleThread::jog(unsigned int value)
QApplication::postEvent(m_parent, new QEvent((QEvent::Type) JOG_BACK1));
else if ((forward && !wrap) || (rewind && wrap))
QApplication::postEvent(m_parent, new QEvent((QEvent::Type) JOG_FWD1));
- else if (!forward && !rewind && !shuttlechange)
+ else if (!forward && !rewind && shuttlecounter > 2) {
// An event without changing the jog value is sent after each shuttle change.
// As the shuttle rest position does not get a shuttle event, only a non-position-changing jog event.
// Hence we stop on this when we see 2 non-position-changing jog events in a row.
+ shuttlecounter = 0;
QApplication::postEvent(m_parent, new QEvent((QEvent::Type) JOG_STOP));
+ }
}
jogvalue = value;
- shuttlechange = false;
+ if (shuttlecounter > 0) shuttlecounter++;
}
JogShuttle::~JogShuttle()
{
- if (m_shuttleProcess.isRunning()) m_shuttleProcess.exit();
+ stopDevice();
}
void JogShuttle::initDevice(QString device)
void JogShuttle::stopDevice()
{
- if (m_shuttleProcess.isRunning())
+ if (m_shuttleProcess.isRunning()) {
+ /* tell thread to stop */
m_shuttleProcess.stop_me = true;
+ m_shuttleProcess.exit();
+ /* give the thread some time (ms) to shutdown */
+ m_shuttleProcess.wait(600);
+
+ /* if still running - do it in the hardcore way */
+ if (m_shuttleProcess.isRunning()) {
+ m_shuttleProcess.terminate();
+ kDebug() << "/// terminate jogshuttle process\n";
+ }
+ }
}
void JogShuttle::customEvent(QEvent* e)
{
int code = e->type();
- // Handle the job events
- if (code == JOG_BACK1) {
- emit rewind1();
+ // Handle simple job events
+ switch (code) {
+ case JOG_BACK1:
+ emit jogBack();
return;
- }
- if (code == JOG_FWD1) {
- emit forward1();
- return;
- }
-
- //handle the shuttle events
- if (code == JOG_STOP) {
- // TODO(fleury): to make sure stop() has an effect, as it doesn't when in rewind mode, we set it to forward with
- // a value that will for sure not move to the next frame.
- if (m_shuttleProcess.shuttlevalue < 0)
- emit forward(0.01);
- emit stop();
+ case JOG_FWD1:
+ emit jogForward();
return;
}
- int shuttle = code - JOG_STOP;
- if (shuttle >= -MAX_SHUTTLE_RANGE && shuttle <= MAX_SHUTTLE_RANGE) {
- if (shuttle < 0)
- emit rewind(-SPEEDS[abs(shuttle)]);
- else
- emit forward(SPEEDS[abs(shuttle)]);
+ int shuttle_pos = code - JOG_STOP;
+ if (shuttle_pos >= -MAX_SHUTTLE_RANGE && shuttle_pos <= MAX_SHUTTLE_RANGE) {
+ emit shuttlePos(shuttle_pos);
return;
}
// we've got a key event.
- emit button(e->type() - 20000);
+ //fprintf(stderr, "Firing button event for #%d\n", e->type() - KEY_EVENT_OFFSET); // DBG
+ emit button(e->type() - KEY_EVENT_OFFSET);
}