Subversion Repositories seema-scanner

Rev

Rev 140 | Rev 142 | Go to most recent revision | Details | Compare with Previous | Last modification | View Log | RSS feed

Rev Author Line No. Line
1 jakw 1
#include "SMScanner.h"
2
#include "ui_SMScanner.h"
3
 
4 jakw 4
#include <QMetaObject>
36 jakw 5
#include <QFileDialog>
67 jakw 6
#include <QMessageBox>
141 jakw 7
#include <QProgressDialog>
4 jakw 8
 
44 jakw 9
#include <pcl/io/pcd_io.h>
10
#include <pcl/io/ascii_io.h>
11
#include <pcl/io/ply_io.h>
12
#include <pcl/io/png_io.h>
13
#include <pcl/io/vtk_io.h>
14
#include <vtkPolyDataWriter.h>
15
#include <pcl/conversions.h>
16
 
139 jakw 17
#include "cvtools.h"
18
 
27 jakw 19
SMScanner::SMScanner(QWidget *parent) :QMainWindow(parent), ui(new Ui::SMScanner),
67 jakw 20
                                        calibrationReviewMode(false), captureReviewMode(false), lastCaptureId(-1){
4 jakw 21
 
27 jakw 22
    // Register metatypes
23
    qRegisterMetaType<cv::Mat>("cv::Mat");
24
    qRegisterMetaType< std::vector<cv::Mat> >("std::vector<cv::Mat>");
30 jakw 25
    qRegisterMetaType< std::vector<float> >("std::vector<float>");
27 jakw 26
    qRegisterMetaType<SMCalibrationSet>("SMCalibrationSet");
27
    qRegisterMetaType<SMCalibrationParameters>("SMCalibrationParameters");
28
    qRegisterMetaTypeStreamOperators<SMCalibrationParameters>("SMCalibrationParameters");
29
    qRegisterMetaType< std::vector<SMCalibrationSet> >("std::vector<SMCalibrationSet>");
30
    qRegisterMetaType<SMFrameSequence>("SMFrameSequence");
42 jakw 31
    qRegisterMetaType< std::vector<SMFrameSequence> >("std::vector<SMFrameSequence>");
45 jakw 32
    qRegisterMetaType<pcl::PointCloud<pcl::PointXYZRGB>::Ptr>("pcl::PointCloud<pcl::PointXYZRGB>::Ptr");
42 jakw 33
    qRegisterMetaType<SMPointCloud>("SMPointCloud");
27 jakw 34
 
42 jakw 35
    // Setup ui (requires stream operators registered)
36
    ui->setupUi(this);
37
 
4 jakw 38
    // Restore geometry
39
    this->restoreGeometry(settings.value("geometry/mainwindow").toByteArray());
40
    this->restoreState(settings.value("state/mainwindow").toByteArray());
41
 
42
    // Set up threads
43
    captureWorker = new SMCaptureWorker;
44
    captureWorkerThread = new QThread(this);
45
    captureWorkerThread->setObjectName("captureWorkerThread");
46
    captureWorker->moveToThread(captureWorkerThread);
47
    captureWorkerThread->start();
48
 
49
    // Connections
23 jakw 50
    connect(captureWorker, SIGNAL(newFrame(unsigned int, cv::Mat)), this, SLOT(onReceiveFrame(unsigned int, cv::Mat)));
27 jakw 51
    connect(captureWorker, SIGNAL(newCalibrationSet(SMCalibrationSet)), this, SLOT(onReceiveCalibrationSet(SMCalibrationSet)));
52
    connect(captureWorker, SIGNAL(newFrameSequence(SMFrameSequence)), this, SLOT(onReceiveFrameSequence(SMFrameSequence)));
30 jakw 53
    connect(captureWorker, SIGNAL(rotatedTo(float)), this, SLOT(onReceiveRotatedTo(float)));
4 jakw 54
 
55
    // Start capturing
56
    QMetaObject::invokeMethod(captureWorker, "setup");
57
    QMetaObject::invokeMethod(captureWorker, "doWork");
58
 
1 jakw 59
}
60
 
23 jakw 61
void SMScanner::onReceiveFrame(unsigned int camId, cv::Mat frame){
4 jakw 62
 
23 jakw 63
    if(camId == 0){
25 jakw 64
        if(!calibrationReviewMode)
65
            ui->calibrationCamera0Widget->showImageCV(frame);
27 jakw 66
        if(!captureReviewMode)
67
            ui->captureCamera0Widget->showImageCV(frame);
23 jakw 68
    } else if(camId == 1){
25 jakw 69
        if(!calibrationReviewMode)
70
            ui->calibrationCamera1Widget->showImageCV(frame);
27 jakw 71
        if(!captureReviewMode)
72
            ui->captureCamera1Widget->showImageCV(frame);
23 jakw 73
    }
74
}
4 jakw 75
 
23 jakw 76
void SMScanner::on_actionPreferences_triggered(){
4 jakw 77
 
74 jakw 78
    connect(&preferenceDialog, SIGNAL(accepted()), this, SLOT(onPreferencesChanged()));
73 jakw 79
 
4 jakw 80
    preferenceDialog.show();
81
}
82
 
73 jakw 83
void SMScanner::onPreferencesChanged(){
84
 
137 jakw 85
    // Stop capturing thread
86
    connect(captureWorker, SIGNAL(finished()), captureWorker, SLOT(deleteLater()));
87
    connect(captureWorker, SIGNAL(finished()), captureWorkerThread, SLOT(quit()));
88
    QMetaObject::invokeMethod(captureWorker, "stopWork");
89
    captureWorkerThread->quit();
90
    captureWorkerThread->wait();
73 jakw 91
 
137 jakw 92
    // Restart capture worker
93
    captureWorker = new SMCaptureWorker;
94
    captureWorkerThread = new QThread(this);
95
    captureWorkerThread->setObjectName("captureWorkerThread");
96
    captureWorker->moveToThread(captureWorkerThread);
97
    captureWorkerThread->start();
73 jakw 98
 
137 jakw 99
    connect(captureWorker, SIGNAL(newFrame(unsigned int, cv::Mat)), this, SLOT(onReceiveFrame(unsigned int, cv::Mat)));
100
    connect(captureWorker, SIGNAL(newCalibrationSet(SMCalibrationSet)), this, SLOT(onReceiveCalibrationSet(SMCalibrationSet)));
101
    connect(captureWorker, SIGNAL(newFrameSequence(SMFrameSequence)), this, SLOT(onReceiveFrameSequence(SMFrameSequence)));
102
    connect(captureWorker, SIGNAL(rotatedTo(float)), this, SLOT(onReceiveRotatedTo(float)));
74 jakw 103
 
137 jakw 104
    QMetaObject::invokeMethod(captureWorker, "setup");
105
    QMetaObject::invokeMethod(captureWorker, "doWork");
74 jakw 106
 
137 jakw 107
//    QMessageBox::warning(this, "Information", "You must quit and restart the program for new settings to take effect!", QMessageBox::Ok);
74 jakw 108
 
73 jakw 109
}
110
 
4 jakw 111
void SMScanner::closeEvent(QCloseEvent *event){
112
 
23 jakw 113
    // Stop capturing thread
114
    connect(captureWorker, SIGNAL(finished()), captureWorker, SLOT(deleteLater()));
115
    connect(captureWorker, SIGNAL(finished()), captureWorkerThread, SLOT(quit()));
116
    QMetaObject::invokeMethod(captureWorker, "stopWork");
117
    captureWorkerThread->quit();
118
    captureWorkerThread->wait();
119
 
4 jakw 120
    // Save window geometry
121
    settings.setValue("geometry/mainwindow", this->saveGeometry());
122
    settings.setValue("state/mainwindow", this->saveState());
123
 
124
    event->accept();
125
 
126
}
127
 
2 jakw 128
SMScanner::~SMScanner(){
1 jakw 129
    delete ui;
130
}
4 jakw 131
 
23 jakw 132
void SMScanner::on_singleCalibrationButton_clicked(){
133
 
25 jakw 134
    // If in review mode, go back to aquisition mode
135
    if(calibrationReviewMode){
26 jakw 136
        ui->calibrationListWidget->clearSelection();
25 jakw 137
        ui->singleCalibrationButton->setText("Single Aquisition");
138
        ui->batchCalibrationButton->setText("Batch Aquisition");
139
        calibrationReviewMode = false;
140
        return;
141
    }
142
 
27 jakw 143
    QMetaObject::invokeMethod(captureWorker, "acquireCalibrationSet", Q_ARG(float, -1.0));
23 jakw 144
 
145
}
146
 
30 jakw 147
 
148
void SMScanner::on_batchCalibrationButton_clicked(){
149
 
150
    // If in review mode, go back to aquisition mode
151
    if(calibrationReviewMode){
152
        ui->calibrationListWidget->clearSelection();
153
        ui->singleCalibrationButton->setText("Single Aquisition");
154
        ui->batchCalibrationButton->setText("Batch Aquisition");
155
        calibrationReviewMode = false;
156
        return;
157
    }
158
 
159
    // Construct vector of angles
160
    int angleStart = ui->calibrationBatchStartSpinBox->value();
161
    int angleEnd = ui->calibrationBatchEndSpinBox->value();
162
    int angleStep = ui->calibrationBatchStepSpinBox->value();
163
 
164
    if(angleStart > angleEnd)
165
        angleEnd += 360;
166
 
167
    std::vector<float> angles;
168
    for(int i=angleStart; i<=angleEnd; i+=angleStep)
169
        angles.push_back(i % 360);
170
 
171
    QMetaObject::invokeMethod(captureWorker, "acquireCalibrationSets", Q_ARG(std::vector<float>, angles));
172
 
173
    std::cout << "Aquiring sets at ";
75 jakw 174
    for(unsigned int i=0; i<angles.size(); i++)
30 jakw 175
        std::cout << angles[i] << " ";
176
    std::cout << " degrees" <<std::endl;
177
}
178
 
179
 
23 jakw 180
void SMScanner::on_calibrationRotationDial_sliderReleased(){
27 jakw 181
 
23 jakw 182
    float angle = ui->calibrationRotationDial->value();
183
    std::cout << "Rotation stage target: " << angle << std::endl;
184
    QMetaObject::invokeMethod(captureWorker, "rotateTo", Q_ARG(float, angle));
27 jakw 185
 
186
    ui->captureRotationDial->setValue(ui->calibrationRotationDial->value());
23 jakw 187
}
24 jakw 188
 
27 jakw 189
void SMScanner::onReceiveCalibrationSet(SMCalibrationSet calibrationSet){
123 jakw 190
 
191
    int id = ui->calibrationListWidget->count();
192
    calibrationSet.id = id;
193
 
23 jakw 194
    calibrationData.push_back(calibrationSet);
25 jakw 195
 
196
    // Add identifier to list
123 jakw 197
    QListWidgetItem* item = new QListWidgetItem(QString("Calibration Set %1 -- %2 deg").arg(id).arg(calibrationSet.rotationAngle), ui->calibrationListWidget);
25 jakw 198
    item->setFlags(item->flags() | Qt::ItemIsUserCheckable);
199
    item->setCheckState(Qt::Checked);
200
    ui->calibrationListWidget->addItem(item);
201
 
202
    // Set enabled checkmark
203
    if(calibrationData.size() >= 2)
204
        ui->calibrateButton->setEnabled(true);
23 jakw 205
}
25 jakw 206
 
27 jakw 207
void SMScanner::on_calibrateButton_clicked(){
25 jakw 208
 
29 jakw 209
    // disable ui elements
210
    ui->calibrateButton->setEnabled(false);
211
    ui->calibrationFrame->setEnabled(false);
27 jakw 212
 
213
    // set checked flags
75 jakw 214
    for(unsigned int i=0; i<calibrationData.size(); i++){
27 jakw 215
        calibrationData[i].checked = (ui->calibrationListWidget->item(i)->checkState() == Qt::Checked);
216
    }
217
 
218
//    SMCalibrationWorker calibrationWorker;
219
//    calibrationWorker.performCalibration(calibrationData);
220
 
221
    // Set up calibration thread
78 jakw 222
    calibrationWorker = new SMCalibrationWorker;
27 jakw 223
    calibrationWorkerThread = new QThread(this);
224
    calibrationWorkerThread->setObjectName("calibrationWorkerThread");
123 jakw 225
    calibrationWorker->moveToThread(calibrationWorkerThread);
27 jakw 226
    calibrationWorkerThread->start();
227
 
228
    // Connections
28 jakw 229
    connect(calibrationWorker, SIGNAL(newSetProcessed(int)), this, SLOT(onCalibrationSetProcessed(int)));
29 jakw 230
    connect(calibrationWorker, SIGNAL(newFrameResult(int,int,bool,cv::Mat)), this, SLOT(onCalibrationFrameResult(int,int,bool,cv::Mat)));
27 jakw 231
    connect(calibrationWorker, SIGNAL(done()), this, SLOT(onCalibrationDone()));
32 jakw 232
    connect(calibrationWorker, SIGNAL(done()), ui->pointCloudWidget, SLOT(updateCalibrationParameters()));
27 jakw 233
    connect(calibrationWorker, SIGNAL(done()), calibrationWorkerThread, SLOT(quit()));
234
    connect(calibrationWorker, SIGNAL(done()), calibrationWorker, SLOT(deleteLater()));
235
 
32 jakw 236
    // Start calibration
27 jakw 237
    QMetaObject::invokeMethod(calibrationWorker, "performCalibration", Q_ARG(std::vector<SMCalibrationSet>, calibrationData));
238
 
239
}
240
 
30 jakw 241
 
242
 
27 jakw 243
void SMScanner::onCalibrationSetProcessed(int idx){
244
 
137 jakw 245
    if(calibrationData[idx].frame0Result.empty() && calibrationData[idx].frame1Result.empty())
246
        ui->calibrationListWidget->item(idx)->setCheckState(Qt::Unchecked);
247
 
27 jakw 248
    ui->calibrationListWidget->setCurrentRow(idx);
249
}
250
 
251
void SMScanner::onCalibrationDone(){
252
 
253
    std::cout << "Calibration done!" << std::endl;
29 jakw 254
    ui->calibrateButton->setEnabled(true);
255
    ui->calibrationFrame->setEnabled(true);
27 jakw 256
 
257
}
258
 
259
void SMScanner::on_calibrationListWidget_itemSelectionChanged(){
260
 
261
    // if selection is just cleared
262
    if(ui->calibrationListWidget->selectedItems().empty())
263
        return;
264
 
265
    int currentRow = ui->calibrationListWidget->currentRow();
266
 
25 jakw 267
    calibrationReviewMode = true;
268
    ui->singleCalibrationButton->setText("Live View");
269
    ui->batchCalibrationButton->setText("Live View");
270
 
271
    if(!calibrationData[currentRow].frame0Result.empty())
272
        ui->calibrationCamera0Widget->showImageCV(calibrationData[currentRow].frame0Result);
273
    else
274
        ui->calibrationCamera0Widget->showImageCV(calibrationData[currentRow].frame0);
275
 
276
    if(!calibrationData[currentRow].frame1Result.empty())
277
        ui->calibrationCamera1Widget->showImageCV(calibrationData[currentRow].frame1Result);
278
    else
279
        ui->calibrationCamera1Widget->showImageCV(calibrationData[currentRow].frame1);
27 jakw 280
 
281
//     std::cout << "on_calibrationListWidget_itemSelectionChanged" << std::endl;
25 jakw 282
}
283
 
29 jakw 284
void SMScanner::onCalibrationFrameResult(int idx, int camID, bool success, cv::Mat result){
25 jakw 285
 
137 jakw 286
    if(success){
29 jakw 287
        if(camID == 0)
288
            calibrationData[idx].frame0Result = result;
289
        else if(camID == 1)
290
            calibrationData[idx].frame1Result = result;
291
    }
27 jakw 292
 
293
}
294
 
295
void SMScanner::on_singleCaptureButton_clicked(){
296
 
297
    // If in review mode, go back to aquisition mode
298
    if(captureReviewMode){
299
        ui->captureTreeWidget->clearSelection();
300
        ui->singleCaptureButton->setText("Single Aquisition");
301
        ui->batchCaptureButton->setText("Batch Aquisition");
302
        captureReviewMode = false;
303
        return;
25 jakw 304
    }
305
 
27 jakw 306
    QMetaObject::invokeMethod(captureWorker, "acquireFrameSequence", Q_ARG(float, -1.0));
25 jakw 307
 
308
}
26 jakw 309
 
27 jakw 310
 
30 jakw 311
void SMScanner::on_batchCaptureButton_clicked(){
312
 
313
    // If in review mode, go back to aquisition mode
314
    if(captureReviewMode){
315
        ui->captureTreeWidget->clearSelection();
316
        ui->singleCaptureButton->setText("Single Aquisition");
317
        ui->batchCaptureButton->setText("Batch Aquisition");
318
        captureReviewMode = false;
319
        return;
320
    }
321
 
322
    // Construct vector of angles
323
    int angleStart = ui->captureBatchStartSpinBox->value();
324
    int angleEnd = ui->captureBatchEndSpinBox->value();
325
    int angleStep = ui->captureBatchStepSpinBox->value();
326
 
327
    if(angleStart > angleEnd)
328
        angleEnd += 360;
329
 
330
    std::vector<float> angles;
331
    for(int i=angleStart; i<=angleEnd; i+=angleStep)
332
        angles.push_back(i % 360);
333
 
334
    std::cout << "Aquiring sequences at ";
75 jakw 335
    for(unsigned int i=0; i<angles.size(); i++)
30 jakw 336
        std::cout << angles[i] << " ";
337
    std::cout << " degrees" <<std::endl;
338
 
339
    QMetaObject::invokeMethod(captureWorker, "acquireFrameSequences", Q_ARG(std::vector<float>, angles));
340
}
341
 
27 jakw 342
void SMScanner::on_captureRotationDial_sliderReleased(){
343
 
344
    float angle = ui->captureRotationDial->value();
345
    std::cout << "Rotation stage target: " << angle << std::endl;
346
    QMetaObject::invokeMethod(captureWorker, "rotateTo", Q_ARG(float, angle));
347
 
348
    ui->calibrationRotationDial->setValue(ui->captureRotationDial->value());
26 jakw 349
}
27 jakw 350
 
351
void SMScanner::onReceiveFrameSequence(SMFrameSequence frameSequence){
352
 
67 jakw 353
    int id = lastCaptureId + 1;
354
    lastCaptureId += 1;
355
 
45 jakw 356
    frameSequence.id = id;
357
 
27 jakw 358
    captureData.push_back(frameSequence);
359
 
360
    // Add identifier to list
361
    QTreeWidgetItem* item = new QTreeWidgetItem(ui->captureTreeWidget);
45 jakw 362
    item->setText(0, QString("Frame Sequence %1 -- %2 deg").arg(id).arg(frameSequence.rotationAngle));
139 jakw 363
    //item->setFlags(item->flags() | Qt::ItemIsUserCheckable);
67 jakw 364
    item->setData(0, Qt::UserRole, QPoint(captureData.size()-1, -1));
139 jakw 365
    //item->setCheckState(0, Qt::Checked);
27 jakw 366
    //ui->captureTreeWidget->addItem(item);
367
 
103 jakw 368
    for(unsigned int i=0; i<frameSequence.frames0.size(); i++){
27 jakw 369
        QTreeWidgetItem* subItem = new QTreeWidgetItem(item);
370
        subItem->setText(0, QString("frames %1").arg(i));
45 jakw 371
        subItem->setData(0, Qt::UserRole, QPoint(id, i));
27 jakw 372
    }
41 jakw 373
 
374
    ui->reconstructButton->setEnabled(true);
27 jakw 375
}
376
 
377
void SMScanner::on_captureTreeWidget_itemSelectionChanged(){
378
 
379
    // if selection is just cleared
380
    if(ui->captureTreeWidget->selectedItems().empty())
381
        return;
382
 
383
    QTreeWidgetItem *item = ui->captureTreeWidget->currentItem();
384
 
385
    captureReviewMode = true;
386
 
387
    ui->singleCaptureButton->setText("Live View");
388
    ui->batchCaptureButton->setText("Live View");
389
 
390
    QPoint idx = item->data(0, Qt::UserRole).toPoint();
391
 
392
    if(idx.y() != -1){
103 jakw 393
        ui->captureCamera0Widget->showImageCV(captureData[idx.x()].frames0[idx.y()]);
394
        ui->captureCamera1Widget->showImageCV(captureData[idx.x()].frames1[idx.y()]);
27 jakw 395
    }
396
 
397
//     std::cout << "on_captureTreeWidget_itemSelectionChanged" << std::endl;
398
}
30 jakw 399
 
400
 
401
void SMScanner::onReceiveRotatedTo(float angle){
402
 
403
    // update ui with new position
404
    ui->calibrationRotationDial->setValue(angle);
405
    ui->captureRotationDial->setValue(angle);
406
 
407
}
36 jakw 408
 
409
void SMScanner::on_actionExport_Sets_triggered(){
410
 
112 jakw 411
    cv::Mat frameBGR;
36 jakw 412
    QString dirName = QFileDialog::getExistingDirectory(this, "Export calibration sets", QString());
75 jakw 413
    for(unsigned int i=0; i<calibrationData.size(); i++){
36 jakw 414
        QString fileName = QString("%1/frame0_%2.png").arg(dirName).arg(i);
136 jakw 415
 
416
        // Convert to BGR
417
        if(calibrationData[i].frame0.channels() == 1)
418
            cv::cvtColor(calibrationData[i].frame0, frameBGR, CV_BayerBG2BGR);
419
        else
420
            cv::cvtColor(calibrationData[i].frame1, frameBGR, CV_RGB2BGR);
421
 
36 jakw 422
        cv::imwrite(fileName.toStdString(), frameBGR);
423
        fileName = QString("%1/frame1_%2.png").arg(dirName).arg(i);
136 jakw 424
 
425
        // Convert to BGR
426
        if(calibrationData[i].frame1.channels() == 1)
427
            cv::cvtColor(calibrationData[i].frame1, frameBGR, CV_BayerBG2BGR);
428
        else
429
            cv::cvtColor(calibrationData[i].frame1, frameBGR, CV_RGB2BGR);
430
 
36 jakw 431
        cv::imwrite(fileName.toStdString(), frameBGR);
137 jakw 432
 
433
        // Necessary to prevent pileup of video frame signals
112 jakw 434
        QCoreApplication::processEvents();
36 jakw 435
    }
436
 
437
}
438
 
439
void SMScanner::on_actionExport_Sequences_triggered(){
440
 
141 jakw 441
    QProgressDialog progressDialog("Exporting Sequences.", "Cancel", 0, 100);
442
    progressDialog.setMinimumDuration(1000);
443
 
444
    progressDialog.setMinimum(1);
445
    progressDialog.setMaximum(captureData.size());
446
 
112 jakw 447
    cv::Mat frameBGR;
36 jakw 448
    QString dirName = QFileDialog::getExistingDirectory(this, "Export frame sequences", QString());
103 jakw 449
    for(unsigned int i=0; i<captureData.size(); i++){
141 jakw 450
 
451
        progressDialog.setValue(i);
452
 
103 jakw 453
        QString seqDirName = QString("%1/sequence_%2").arg(dirName).arg(i);
454
        if(!QDir().mkdir(seqDirName))
455
            std::cerr << "Could not create directory " << seqDirName.toStdString() << std::endl;
456
        for(unsigned int j=0; j<captureData[i].frames0.size(); j++){
457
            QString fileName = QString("%1/frames0_%2.png").arg(seqDirName).arg(j);
113 jakw 458
            // Convert Bayer to rgb (png needs BGR order)
459
            cv::cvtColor(captureData[i].frames0[j], frameBGR, CV_BayerBG2BGR);
103 jakw 460
            cv::imwrite(fileName.toStdString(), frameBGR);
137 jakw 461
 
462
            // Necessary to prevent pileup of video frame signals
112 jakw 463
            QCoreApplication::processEvents();
103 jakw 464
        }
465
        for(unsigned int j=0; j<captureData[i].frames1.size(); j++){
466
            QString fileName = QString("%1/frames1_%2.png").arg(seqDirName).arg(j);
113 jakw 467
            // Convert Bayer to rgb (png needs BGR order)
468
            cv::cvtColor(captureData[i].frames1[j], frameBGR, CV_BayerBG2BGR);
103 jakw 469
            cv::imwrite(fileName.toStdString(), frameBGR);
137 jakw 470
 
471
            // Necessary to prevent pileup of video frame signals
112 jakw 472
            QCoreApplication::processEvents();
103 jakw 473
        }
474
    }
36 jakw 475
}
41 jakw 476
 
115 jakw 477
void SMScanner::on_actionExport_White_Frames_triggered(){
478
 
479
    cv::Mat frameBGR;
480
    QString dirName = QFileDialog::getExistingDirectory(this, "Export frame sequences", QString());
481
    for(unsigned int i=0; i<captureData.size(); i++){
482
        QString seqDirName = QString("%1/sequence_%2").arg(dirName).arg(i);
483
        if(!QDir().mkdir(seqDirName))
484
            std::cerr << "Could not create directory " << seqDirName.toStdString() << std::endl;
485
 
486
        QString fileName = QString("%1/frames0_0.png").arg(seqDirName);
487
        // Convert Bayer to rgb (png needs BGR order)
488
        cv::cvtColor(captureData[i].frames0[0], frameBGR, CV_BayerBG2BGR);
489
        cv::imwrite(fileName.toStdString(), frameBGR);
128 jakw 490
        // Necessary to prevent memory pileup
115 jakw 491
        QCoreApplication::processEvents();
492
 
493
        fileName = QString("%1/frames1_0.png").arg(seqDirName);
494
        // Convert Bayer to rgb (png needs BGR order)
495
        cv::cvtColor(captureData[i].frames1[0], frameBGR, CV_BayerBG2BGR);
496
        cv::imwrite(fileName.toStdString(), frameBGR);
128 jakw 497
        // Necessary to prevent memory pileup
115 jakw 498
        QCoreApplication::processEvents();
499
 
500
    }
501
 
502
}
503
 
41 jakw 504
void SMScanner::on_reconstructButton_clicked(){
505
 
506
    // Set up reconstruction thread
507
    reconstructionWorker = new SMReconstructionWorker;
508
    reconstructionWorkerThread = new QThread(this);
509
    reconstructionWorkerThread->setObjectName("reconstructionWorkerThread");
510
    reconstructionWorker->moveToThread(reconstructionWorkerThread);
511
    reconstructionWorkerThread->start();
512
 
513
    // Connections
42 jakw 514
    connect(reconstructionWorker, SIGNAL(newPointCloud(SMPointCloud)), this, SLOT(onNewPointCloud(SMPointCloud)));
41 jakw 515
    connect(reconstructionWorker, SIGNAL(done()), reconstructionWorkerThread, SLOT(quit()));
516
    connect(reconstructionWorker, SIGNAL(done()), reconstructionWorker, SLOT(deleteLater()));
517
 
518
    // Start reconstructing
42 jakw 519
    QMetaObject::invokeMethod(reconstructionWorker, "setup");
41 jakw 520
 
75 jakw 521
    for(unsigned int i=0; i<captureData.size(); i++){
139 jakw 522
        if(!captureData[i].reconstructed){ // & (ui->captureTreeWidget->topLevelItem(i)->checkState(0) == Qt::Checked))
523
            captureData[i].reconstructed = true;
45 jakw 524
            QMetaObject::invokeMethod(reconstructionWorker, "reconstructPointCloud", Q_ARG(SMFrameSequence, captureData[i]));
139 jakw 525
        }
45 jakw 526
    }
527
 
41 jakw 528
}
529
 
42 jakw 530
void SMScanner::onNewPointCloud(SMPointCloud smCloud){
41 jakw 531
 
45 jakw 532
    int id = smCloud.id;
533
 
139 jakw 534
//    for(int i=0; i<captureData.size(); i++){
535
//        if(captureData[i].id == id)
536
//            captureData[i].reconstructed = true;
537
//    }
82 jakw 538
 
41 jakw 539
    pointCloudData.push_back(smCloud);
540
 
42 jakw 541
    // Add identifier to list
43 jakw 542
    QListWidgetItem* item = new QListWidgetItem(QString("Point Cloud %1 -- %2 deg").arg(id).arg(smCloud.rotationAngle), ui->pointCloudsListWidget);
42 jakw 543
    item->setFlags(item->flags() | Qt::ItemIsUserCheckable);
44 jakw 544
    item->setData(Qt::UserRole, QVariant(id));
42 jakw 545
    item->setCheckState(Qt::Checked);
44 jakw 546
 
42 jakw 547
    ui->pointCloudsListWidget->addItem(item);
548
 
71 jakw 549
//    ui->pointCloudWidget->addPointCloud(smCloud, id);
41 jakw 550
}
42 jakw 551
 
552
 
44 jakw 553
 
554
void SMScanner::on_actionExport_Point_Clouds_triggered(){
555
 
556
    QString directory = QFileDialog::getExistingDirectory(this, "Export Point Clouds", QString());
557
 
558
//    //  Non native file dialog
559
//    QFileDialog saveDirectoryDialog(this, "Export Point Clouds", QString(), "*.pcd;;*.ply;;*.vtk;;*.png;;*.txt");
560
//    saveDirectoryDialog.setDefaultSuffix("ply");
561
//    saveDirectoryDialog.setFileMode(QFileDialog::Directory);
562
//    saveDirectoryDialog.exec();
563
//    QString directory = saveDirectoryDialog.directory().path();
564
//    QString type = saveDirectoryDialog.selectedNameFilter();
565
 
566
    // save point clouds in ply format
75 jakw 567
    for(unsigned int i=0; i<pointCloudData.size(); i++){
44 jakw 568
        QString fileName = QString("%1/pointcloud_%2.ply").arg(directory).arg(i);
128 jakw 569
        pcl::PointCloud<pcl::PointXYZRGBNormal>::Ptr pointCloudPCL(pointCloudData[i].pointCloud);
44 jakw 570
        //pcl::io::savePLYFileBinary(fileName.toStdString(), *pointCloudPCL);
571
        pcl::PLYWriter w;
572
        // Write to ply in binary without camera
128 jakw 573
        w.write<pcl::PointXYZRGBNormal> (fileName.toStdString(), *pointCloudPCL, true, false);
44 jakw 574
    }
575
 
576
    // save meshlab aln project file
577
    std::ofstream s(QString("%1/alignment.aln").arg(directory).toLocal8Bit());
578
    s << pointCloudData.size() << std::endl;
75 jakw 579
    for(unsigned int i=0; i<pointCloudData.size(); i++){
44 jakw 580
        QString fileName = QString("pointcloud_%1.ply").arg(i);
581
        s << fileName.toStdString() << std::endl << "#" << std::endl;
582
        cv::Mat Tr = cv::Mat::eye(4, 4, CV_32F);
583
        cv::Mat(pointCloudData[i].R.t()).copyTo(Tr.colRange(0, 3).rowRange(0, 3));
584
        cv::Mat(-pointCloudData[i].R.t()*pointCloudData[i].T).copyTo(Tr.col(3).rowRange(0, 3));
585
        for(int j=0; j<Tr.rows; j++){
586
            for(int k=0; k<Tr.cols; k++){
587
                s << Tr.at<float>(j,k) << " ";
588
            }
589
            s << std::endl;
590
        }
591
    }
592
    s << "0" << std::flush;
593
    s.close();
594
}
595
 
596
void SMScanner::on_pointCloudsListWidget_itemChanged(QListWidgetItem *item){
597
 
598
    int id = item->data(Qt::UserRole).toInt();
599
 
600
    if(item->checkState() == Qt::Checked)
601
        ui->pointCloudWidget->addPointCloud(pointCloudData[id], id);
602
    else
603
        ui->pointCloudWidget->removePointCloud(id);
604
 
605
}
606
 
607
void SMScanner::on_actionExport_Parameters_triggered(){
608
 
42 jakw 609
    QString fileName = QFileDialog::getSaveFileName(this, "Export calibration parameters", QString(), "*.xml");
610
    QFileInfo info(fileName);
611
    QString type = info.suffix();
612
    if(type == ""){
613
        fileName.append(".xml");
614
    }
615
 
616
    SMCalibrationParameters calibration = settings.value("calibration/parameters").value<SMCalibrationParameters>();
617
    calibration.exportToXML(fileName);
618
}
67 jakw 619
 
620
void SMScanner::on_actionClear_Sequences_triggered(){
621
 
622
    int res = QMessageBox::question(this, "Clear Captured Sequences", "Clear all captured data?", QMessageBox::Ok, QMessageBox::Cancel);
623
 
624
    if(res == QMessageBox::Ok){
625
        captureData.clear();
626
        ui->captureTreeWidget->clear();
627
    }
628
}
115 jakw 629
 
630
 
135 jakw 631
 
632
void SMScanner::on_actionImport_Parameters_triggered(){
633
 
634
    QString fileName = QFileDialog::getOpenFileName(this, "Import calibration parameters", QString(), "*.xml");
635
    QFileInfo info(fileName);
636
    QString type = info.suffix();
136 jakw 637
    if(type != "xml"){
135 jakw 638
        std::cerr << "Error: calibration parameters must be in .xml file." << std::endl;
639
        return;
640
    }
641
 
642
    SMCalibrationParameters cal;
643
    cal.importFromXML(fileName);
644
 
645
    settings.setValue("calibration/parameters",  QVariant::fromValue(cal));
646
    ui->pointCloudWidget->updateCalibrationParameters();
139 jakw 647
 
648
    std::cout << "Imported calibration parameters " << fileName.toStdString() << std::endl;
135 jakw 649
}
650
 
651
void SMScanner::on_actionImport_Sets_triggered(){
652
 
653
    QString dirName = QFileDialog::getExistingDirectory(this, "Import calibration sets", QString());
654
 
655
    QDir dir(dirName);
656
    QStringList fileNames0 = dir.entryList(QStringList("frame0_*.png"));
657
    QStringList fileNames1 = dir.entryList(QStringList("frame1_*.png"));
658
 
659
    if(fileNames0.empty() || fileNames1.empty() || fileNames0.count() != fileNames1.count()){
660
        std::cerr << "Error: could not load calibration sets. Directory must contain .png files for both cameras." << std::endl;
661
        return;
662
    }
663
 
664
    calibrationData.clear();
665
    ui->calibrationListWidget->clear();
666
 
667
    int nSets = fileNames0.size();
668
 
669
    for(unsigned int i=0; i<nSets; i++){
670
 
671
        SMCalibrationSet calibrationSet;
672
 
140 jakw 673
        QString fileName0 = QString("%1/frame0_%2.png").arg(dirName).arg(i);
139 jakw 674
        cv::Mat frame0BGR = cv::imread(fileName0.toStdString());
675
        cvtools::cvtColorBGRToBayerBG(frame0BGR, calibrationSet.frame0);
135 jakw 676
 
140 jakw 677
        QString fileName1 = QString("%1/frame1_%2.png").arg(dirName).arg(i);
139 jakw 678
        cv::Mat frame1BGR = cv::imread(fileName1.toStdString());
679
        cvtools::cvtColorBGRToBayerBG(frame1BGR, calibrationSet.frame1);
680
 
681
 
135 jakw 682
        int id = ui->calibrationListWidget->count();
683
        calibrationSet.id = id;
684
 
685
        calibrationData.push_back(calibrationSet);
686
 
687
        // Add identifier to list
688
        QListWidgetItem* item = new QListWidgetItem(QString("Calibration Set %1 -- %2 deg").arg(id).arg(calibrationSet.rotationAngle), ui->calibrationListWidget);
689
        item->setFlags(item->flags() | Qt::ItemIsUserCheckable);
140 jakw 690
        item->setCheckState(Qt::Unchecked);
135 jakw 691
        ui->calibrationListWidget->addItem(item);
692
 
693
        QCoreApplication::processEvents();
694
    }
695
 
696
    // Set enabled checkmark
697
    if(calibrationData.size() >= 2)
698
        ui->calibrateButton->setEnabled(true);
699
}
139 jakw 700
 
701
void SMScanner::on_actionImport_Sequences_triggered(){
702
 
703
    // NOTE: we do not know which algorithm was used!!!
704
    QString dirName = QFileDialog::getExistingDirectory(this, "Import captured sequences", QString());
705
 
706
    QDir dir(dirName);
707
    QStringList sequenceDirNames = dir.entryList(QStringList("sequence_*"));
708
 
709
    if(sequenceDirNames.empty()){
710
        std::cerr << "Error: could not find sequences." << std::endl;
711
        return;
712
    }
713
 
714
    captureData.clear();
715
    ui->captureTreeWidget->clear();
716
 
717
    for(int s=0; s<sequenceDirNames.count(); s++){
718
 
719
        QDir sequenceDir(QString("%1/%2").arg(dirName).arg(sequenceDirNames.at(s)));
720
 
721
        QStringList fileNames0 = sequenceDir.entryList(QStringList("frames0_*.png"));
722
        QStringList fileNames1 = sequenceDir.entryList(QStringList("frames1_*.png"));
723
 
724
        if(fileNames0.empty() || fileNames1.empty() || fileNames0.count() != fileNames1.count()){
725
            std::cerr << "Error: could not load sequence. Directory must contain .png files for both cameras." << std::endl;
726
            return;
727
        }
728
 
729
        int nFrames = fileNames0.size();
730
 
731
        SMFrameSequence sequence;
732
 
733
        for(int f=0; f<nFrames; f++){
734
 
735
            cv::Mat frame0BGR, frame0BayerBG, frame1BGR, frame1BayerBG;
736
 
737
            QString fileName0 = QString("%1/%2/frames0_%3.png").arg(dirName).arg(sequenceDirNames.at(s)).arg(f);
738
            frame0BGR = cv::imread(fileName0.toStdString());
739
            cvtools::cvtColorBGRToBayerBG(frame0BGR, frame0BayerBG);
740
 
741
            QString fileName1 = QString("%1/%2/frames1_%3.png").arg(dirName).arg(sequenceDirNames.at(s)).arg(f);
742
            frame1BGR = cv::imread(fileName1.toStdString());
743
            cvtools::cvtColorBGRToBayerBG(frame1BGR, frame1BayerBG);
744
 
745
            sequence.frames0.push_back(frame0BayerBG);
746
            sequence.frames1.push_back(frame1BayerBG);
747
 
748
            QCoreApplication::processEvents();
749
        }
750
        sequence.codec = settings.value("algorithm").toString();
751
        sequence.rotationAngle = 0;
752
        sequence.reconstructed = false;
753
 
754
        onReceiveFrameSequence(sequence);
755
    }
756
 
757
}
758
 
759
void SMScanner::on_actionClear_Point_Clouds_triggered(){
760
 
761
    int res = QMessageBox::question(this, "Clear Reconstructed Point Clouds", "Clear all reconstructed point clouds?", QMessageBox::Ok, QMessageBox::Cancel);
762
 
763
    if(res == QMessageBox::Ok){
764
 
765
        pointCloudData.clear();
766
        ui->pointCloudsListWidget->clear();
767
        ui->pointCloudWidget->removeAllPointClouds();
768
 
769
        for(int i=0; i<captureData.size(); i++)
770
            captureData[i].reconstructed = false;
771
    }
772
}