Changeset 4076 for trunk/MagicSoft/Cosy/videodev/Camera.cc

Timestamp:

05/15/04 16:46:27 (20 years ago)

Author:

tbretz

Message:

*** empty log message ***

File:

• trunk/MagicSoft/Cosy/videodev/Camera.cc (modified) (11 diffs)

trunk/MagicSoft/Cosy/videodev/Camera.cc

@@ -17 +17 @@
 inline int Camera::Ioctl(int req, void *opt, const char *str)
 {
-    int rc = ioctl(fd, req, opt);
-
-    if (rc==-1)
-    {
-        cout << "Error! Ioctl " << req << ": ";
+    while (1)
+    {
+        const int rc = ioctl(fd, req, opt);
+        if (rc>=0)
+            return rc;
+
+        // errno== 4: Interrupted system call
+        // errno==16: Device or resource busy
+        if (errno==4 || errno==16)
+        {
+            cout << "Camera: ioctl returned rc=" << rc << " '";
+            cout << (str?str:strerror(errno)) << "' (errno = " << errno << ")" << endl;
+            usleep(10);
+            continue;
+        }
+
+        cout << "Error! Ioctl " << hex << req << ": errno=" << dec << errno << " - ";
         cout << (str?str:strerror(errno)) << " (rc=" << rc << ")" << endl;
-    }
-
-    return rc;
+        return rc;
+    }
+    return -1;
 }
 
 void Camera::Error(const char *str, int fatal)
 {
-    cout << endl
-        << (fatal?"Fatal ":"") << "Error! " << str << ": " << strerror(errno)
-        << endl;
+    cout << endl;
+    cout << (fatal?"Fatal ":"") << "Error! " << str << ": " << strerror(errno);
+    cout << endl;
 
     if (fatal)
@@ -39 +51 @@
 void Camera::SigInit()
 {
-    return;
-    struct sigaction act, old;
-
-    memset(&act, 0, sizeof(act));
-
-    act.sa_handler = SigAlarm;
-
-    sigemptyset(&act. sa_mask);
-    sigaction(SIGALRM, &act, &old);
-
-    // signal(SIGINT, ctrlc);
+    /*
+     struct sigaction act, old;
+
+     memset(&act, 0, sizeof(act));
+
+     act.sa_handler = SigAlarm;
+
+     sigemptyset(&act. sa_mask);
+     sigaction(SIGALRM, &act, &old);
+
+     // signal(SIGINT, ctrlc);
+     */
 }
 
@@ -74 +87 @@
 int Camera::StartGrab(unsigned int frame)
 {
+    // We could also get RGB555, RGB565 and RGB32. But we want
+    // RGB24 because we have a 8bit DAC which gives us 8bit per
+    // color ==> RGB24 which is in the following the most simple
+    // to process.
     static struct video_mmap gb =
     {
-        0,                     // frame
-        rows, cols,            // height, width
-        VIDEO_PALETTE_RGB24    // palette
+        0,                  // frame
+        rows, cols,         // height, width
+        VIDEO_PALETTE_RGB24 // palette
     };
 
@@ -95 +112 @@
 }
 
-Camera::Camera(PixClient &client) : fd(-1), iBufferSize(0), fClient(client), fMutex(), fCond(&fMutex)
-{
-    cout << "Starting thread..." << flush;
-    //pthread_cond_init(&fCond, NULL);
-    //pthread_mutex_init(&fMux, NULL);
-    //pthread_mutex_lock(&fMux);
-    fMutex.Lock();
-    pthread_create(&fThread, NULL, MapThread, this);
-    cout << "done." << endl;
-
-    cout << "/dev/video: opening..." << flush;
+Camera::Camera(PixClient &client, Int_t nch) : fd(-1), iBufferSize(0), fClient(client), fCond(), fMutex(fCond.GetMutex())
+{
+    cout << "Camera: " << this << " /dev/video: opening..." << flush;
 
     //
@@ -126 +135 @@
     // get input channel 0 information
     //
+
     struct video_channel ch;
-    ch.channel = 0;
+    ch.channel = nch;
     Ioctl(VIDIOCGCHAN, &ch);
 
@@ -160 +170 @@
     cout << "Buffer Size: " << (void*)iBufferSize << endl;
     cout << "grab: use: 768x576 24 bit TrueColor (LE: bgr) = " << (void*)(768*576*3) << "b" << endl;
+
+//    if (fMutex->UnLock()==13)
+//        cout << "Camera::Camera - tried to unlock mutex locked by other thread." << endl;
+
+    cout << "Starting thread..." << flush;
+    //pthread_cond_init(&fCond, NULL);
+    //pthread_mutex_init(&fMux, NULL);
+    //pthread_mutex_lock(&fMux);
+//    if (fMutex->Lock()==13)
+//        cout << "Camera::Camera - mutex is already locked by this thread" << endl;
+    pthread_create(&fThread, NULL, MapThread, this);
+    cout << "done." << endl;
+
 }
 
 Camera::~Camera()
 {
-    cout << "Stopping thread..." << flush;
     pthread_cancel(fThread);
-    //pthread_mutex_destroy(&fMux);
-    //pthread_cond_destroy(&fCond);
+
+    cout << "/dev/video: closing... " << flush;
+    if (fd != -1)
+    {
+        close(fd);
+        fd = -1;
+    }
     cout << "done." << endl;
-
-    cout << "/dev/video: closing... " << flush;
 
     // unmap device memory
     if ((int)pMapBuffer != -1)
         munmap(pMapBuffer, iBufferSize);
-
-    if (fd != -1)
-    {
-        close(fd);
-        fd = -1;
-    }
-
-    cout << " Done." << endl;
-}
-
+}
 
 void *Camera::MapThread(void *arg)
@@ -198 +214 @@
 }
 
+void Camera::ExitLoop()
+{
+    //    cout << "ExitLoop..." << endl;
+    fStop = 1;
+    while (IsRunning())
+        usleep(1);
+    //    cout << "Loop exited." << endl;
+}
+
+//
+// flag if the execution is running or not
+//
+int Camera::IsRunning() const
+{
+    const Int_t rc = fMutex->TryLock();
+    if (rc==0)
+        return false;
+
+    if (rc==13)
+        return false;
+
+    fMutex->UnLock();
+    return true;
+}
+
 void Camera::LoopStep(const unsigned long n)
 {
@@ -217 +258 @@
 {
 #define IsOdd(i) (2*(i/2)!=i)
+    cout << "Camera::Thread started..." << endl;
     while (1)
     {
-        //pthread_cond_wait(&fCond, &fMux);
+        //cout << "Wait..." << flush;
         fCond.Wait();
+        //cout << "done." << endl;
+        if (fd==-1)
+            break;
 
         MStopwatch t;
@@ -259 +304 @@
         t.Stop();
         t.Print(i);
-
-        fRunning = 0;
-    }
+    }
+
+    fMutex->UnLock();
+
+    cout << "Camera::Thread.. stopped." << endl;
 }
 
@@ -272 +319 @@
     }
 
-    //
-    // Stop running loop
-    //
-    fStop = 1;
-
-    //
-    // Wait until loop is stopped (pthread_cond_wait is executing)
-    // set new number of frames to process
-    //
-    fMutex.Lock();
-    //pthread_mutex_lock(&fMux);
-    fNum     = nof;
-    fStop    = 0;
-    fRunning = 1;
-    fMutex.UnLock();
-    //pthread_mutex_unlock(&fMux);
+    cout << "Loop..." << endl;
+    ExitLoop();
+
+    fNum  = nof;
+    fStop = 0;
 
     //
@@ -293 +329 @@
     //
     fCond.Broadcast();
-    //pthread_cond_signal(&fCond);
 }