Subversion Repositories seema-scanner

Rev

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