Changeset 98 in pacpussensors for trunk

Timestamp:

Oct 8, 2015, 10:29:42 PM (9 years ago)

Author:

ndiasnak

Message:

Added: timestamp and DbiteFile to LadybugComponent

Location:

trunk/Ladybug

Files:

• LadybugComponent.cpp (modified) (8 diffs)
• LadybugComponent.h (modified) (2 diffs)

trunk/Ladybug/LadybugComponent.cpp

@@ -32 +32 @@
 // Construct the factory
 static ComponentFactory<LadybugComponent> sFactory("LadybugComponent");
+static const size_t kMaxFilepathLength = 128;
 
 /* *Constructor*/
@@ -56 +57 @@
         lbTotalNumberOfImagesWritten = 0;
         lbNumOfFrames = 0;
+
+        if (lbSaveJPGImages)
+        {
+                try 
+                {
+                        QString dbtFileName_ = "Camera_1.dbt";
+                        mDbtImage1.open(dbtFileName_.toStdString(), WriteMode, FILE_DBT_UNKNOWN, kMaxFilepathLength);
+                } catch (DbiteException & e) {
+                        LOG_ERROR("error opening dbt file: " << e.what());
+                }
+
+                try 
+                {
+                        QString dbtFileName_ = "Camera_2.dbt";
+                        mDbtImage1.open(dbtFileName_.toStdString(), WriteMode, FILE_DBT_UNKNOWN, kMaxFilepathLength);
+                } catch (DbiteException & e) {
+                        LOG_ERROR("error opening dbt file: " << e.what());
+                }
+
+                try 
+                {
+                        QString dbtFileName_ = "Camera_3.dbt";
+                        mDbtImage1.open(dbtFileName_.toStdString(), WriteMode, FILE_DBT_UNKNOWN, kMaxFilepathLength);
+                } catch (DbiteException & e) {
+                        LOG_ERROR("error opening dbt file: " << e.what());
+                }
+
+                try 
+                {
+                        QString dbtFileName_ = "Camera_4.dbt";
+                        mDbtImage1.open(dbtFileName_.toStdString(), WriteMode, FILE_DBT_UNKNOWN, kMaxFilepathLength);
+                } catch (DbiteException & e) {
+                        LOG_ERROR("error opening dbt file: " << e.what());
+                }
+
+                try 
+                {
+                        QString dbtFileName_ = "Camera_5.dbt";
+                        mDbtImage1.open(dbtFileName_.toStdString(), WriteMode, FILE_DBT_UNKNOWN, kMaxFilepathLength);
+                } catch (DbiteException & e) {
+                        LOG_ERROR("error opening dbt file: " << e.what());
+                }
+
+                try 
+                {
+                        QString dbtFileName_ = "Camera_6.dbt";
+                        mDbtImage1.open(dbtFileName_.toStdString(), WriteMode, FILE_DBT_UNKNOWN, kMaxFilepathLength);
+                } catch (DbiteException & e) {
+                        LOG_ERROR("error opening dbt file: " << e.what());
+                }
+    }
+
+        if (lbSavePanoImage)
+        {
+                try 
+                {
+                        QString dbtFileName_ = "CameraPano.dbt";
+                        mDbtImage1.open(dbtFileName_.toStdString(), WriteMode, FILE_DBT_UNKNOWN, kMaxFilepathLength);
+                } catch (DbiteException & e) {
+                        LOG_ERROR("error opening dbt file: " << e.what());
+                }
+    }
+
         THREAD_ALIVE = true;
         start();
@@ -66 +130 @@
         printf (" \n*** Stopping Activity ***\n");
         LadybugError error;
+
+            // Close DBT files
+    if (lbSaveJPGImages) {
+                mDbtImage1.close();
+                mDbtImage2.close();
+                mDbtImage3.close();
+                mDbtImage4.close();
+                mDbtImage5.close();
+                mDbtImage6.close();
+    }
+
+        if (lbSavePanoImage) {
+                mDbtImagePano.close();
+        }
 
         lbIsRecording = false;
@@ -144 +222 @@
         CreateImageBuffers();
 
+        // Timestamp
+    road_time_t timestamp = 0;
+    road_timerange_t tr = 0;
+
         while (THREAD_ALIVE)
         {
+
                 lbCurrentTime = GetTickCount(); // road_time_t timestamp = road_time(); // ui64 ; unit microsec ; Orig 01/01/1970 00:00
                 lbFrameCount++;
@@ -158 +241 @@
 
                 error = ladybugGrabImage( lbContext, &image );
-                // t = road_time(); // timestamp 
+                timestamp = road_time(); // timestamp 
                 HandleError(error);
 
@@ -245 +328 @@
         HandleError(error);
 
+
+        // Use it to trigger the camera with the gps signal
         /*// Initialize Trigger
         error = ladybugGetTriggerModeInfo( lbContext, &triggerModeInfo );
@@ -356 +441 @@
                 HandleError(error);
 
+        if (uiCamera == 0)
+                {
+                        try {
+                                mDbtImage1.writeRecord(time, tr, (char *) processedImage.pData, kMaxFilepathLength);
+                        } catch (DbiteException & e) {
+                                LOG_ERROR("error writing data: " << e.what());
+                        }
+                } else if (uiCamera == 1) {
+                        try {
+                                mDbtImage2.writeRecord(time, tr, (char *) processedImage.pData, kMaxFilepathLength);
+                        } catch (DbiteException & e) {
+                                LOG_ERROR("error writing data: " << e.what());
+                        }
+                }else if (uiCamera == 2) {
+                        try {
+                                mDbtImage3.writeRecord(time, tr, (char *) processedImage.pData, kMaxFilepathLength);
+                        } catch (DbiteException & e) {
+                                LOG_ERROR("error writing data: " << e.what());
+                        }
+                }else if (uiCamera == 3) {
+                        try {
+                                mDbtImage4.writeRecord(time, tr, (char *) processedImage.pData, kMaxFilepathLength);
+                        } catch (DbiteException & e) {
+                                LOG_ERROR("error writing data: " << e.what());
+                        }
+                }else if (uiCamera == 4) {
+                        try {
+                                mDbtImage5.writeRecord(time, tr, (char *) processedImage.pData, kMaxFilepathLength);
+                        } catch (DbiteException & e) {
+                                LOG_ERROR("error writing data: " << e.what());
+                        }
+                }else if (uiCamera == 5) {
+                        try {
+                                mDbtImage6.writeRecord(time, tr, (char *) processedImage.pData, kMaxFilepathLength);
+                        } catch (DbiteException & e) {
+                                LOG_ERROR("error writing data: " << e.what());
+                        }
+                }
+
                 //printf("Saved camera %u image to %s.\n", uiCamera, pszOutputFilePath);
 
@@ -401 +525 @@
         error = ladybugSaveImage(lbContext, &processedImage, pszOutputFilePath, LADYBUG_FILEFORMAT_JPG); 
         HandleError(error);
+
+        try {
+                mDbtImagePano.writeRecord(time, tr, (char *) processedImage.pData, kMaxFilepathLength);
+        } catch (DbiteException & e) {
+                LOG_ERROR("error writing data: " << e.what());
+        }
 
 }

trunk/Ladybug/LadybugComponent.h

@@ -4 +4 @@
 //#include "Pacpus/kernel/pacpus.h"
 #include "Pacpus/kernel/ComponentBase.h"
-//#include "Pacpus/kernel/DbiteFile.h"
+#include "Pacpus/kernel/DbiteFile.h"
 //#include "../NMEA0183/include/nmea0183.h"
 
@@ -121 +121 @@
                                 int lbNumOfFrames;
 
+                                DbiteFile mDbtImage1;
+                                DbiteFile mDbtImage2;
+                                DbiteFile mDbtImage3;
+                                DbiteFile mDbtImage4;
+                                DbiteFile mDbtImage5;
+                                DbiteFile mDbtImage6;
+                                DbiteFile mDbtImagePano;
+
         };
 }