Skip to content
Snippets Groups Projects
petrack.cpp 145 KiB
Newer Older
d.kilic's avatar
d.kilic committed
    mViewMenu->addAction(mFontAct);
    mViewMenu->addSeparator();
    mViewMenu->addAction(mHideControlsAct);

    mDeleteMenu = new QMenu(tr("&Delete"), this);
    mDeleteMenu->addAction(mDelPastAct);
    mDeleteMenu->addAction(mDelFutureAct);
    mDeleteMenu->addAction(mDelAllRoiAct);
    mDeleteMenu->addAction(mDelPartRoiAct);

    mHelpMenu = new QMenu(tr("&Help"), this);
    mHelpMenu->addAction(mCommandAct);
    mHelpMenu->addAction(mKeyAct);
    mHelpMenu->addAction(mAboutAct);
    mHelpMenu->addAction(mOnlineHelpAct);

    menuBar()->addMenu(mFileMenu);
    menuBar()->addMenu(mViewMenu);
    menuBar()->addMenu(mDeleteMenu);
    menuBar()->addMenu(mHelpMenu);

    mCameraMenu->setEnabled(false);
}

/**
 * @brief Helper function to create status bar at the bottom of the window
 */
d.kilic's avatar
d.kilic committed
void Petrack::createStatusBar()
{
    QFont f("Courier", 12, QFont::Bold); // Times Helvetica, Normal
d.kilic's avatar
d.kilic committed
    statusBar()->setMaximumHeight(28);
    statusBar()->showMessage(tr("Ready"));
    statusBar()->addPermanentWidget(mStatusLabelStereo = new QLabel(" "));
    statusBar()->addPermanentWidget(mStatusLabelTime = new QLabel(" "));
    statusBar()->addPermanentWidget(mStatusLabelFPS = new QLabel(" "));
    statusBar()->addPermanentWidget(mStatusPosRealHeight = new QDoubleSpinBox());
    connect(mStatusPosRealHeight, SIGNAL(valueChanged(double)), this, SLOT(setStatusPosReal()));

    statusBar()->addPermanentWidget(mStatusLabelPosReal = new QLabel(" "));
    statusBar()->addPermanentWidget(mStatusLabelPos = new QLabel(" "));
    statusBar()->addPermanentWidget(mStatusLabelColor = new QLabel(" "));
    mStatusLabelStereo->setFont(f);
    mStatusLabelStereo->setMinimumWidth(200);
    mStatusLabelTime->setFont(f);
    mStatusLabelTime->setMinimumWidth(200);
    mStatusLabelFPS->setFont(f);
    mStatusLabelFPS->setMinimumWidth(80);
d.kilic's avatar
d.kilic committed
    mStatusLabelFPS->setAutoFillBackground(true);
    mStatusLabelFPS->setToolTip("Click to adapt play rate to fps rate");
    mStatusPosRealHeight->setRange(-999.9, 9999.9); // in cm
    mStatusPosRealHeight->setDecimals(1);
    mStatusPosRealHeight->setFont(f);
    mStatusLabelPosReal->setFont(f);
    mStatusLabelPosReal->setMinimumWidth(340);
    mStatusLabelPos->setFont(f);
    mStatusLabelPos->setMinimumWidth(100);
    mStatusLabelColor->setFont(f);
    mStatusLabelColor->setMinimumWidth(90);
    mStatusLabelColor->setAutoFillBackground(true);
}

void Petrack::resetUI()
{
d.kilic's avatar
d.kilic committed
    ///
    ///  Reset all UI elements to default settings
    ///  Noetig damit alle UI Elemente, welche in der neu geladenen Projekt-Datei z.B. noch nicht vorhanden sind, auf
    ///  sinnvolle Werte gesetzt werden. Anderenfalls kommt es evtl. beim nacheinander laden verschiedener Projekte zu
    ///  einem Programmabsturz
d.kilic's avatar
d.kilic committed
    ///
    return;
}

void Petrack::setStatusStereo(float x, float y, float z)
{
    if(mStatusLabelStereo)
d.kilic's avatar
d.kilic committed
    {
d.kilic's avatar
d.kilic committed
            mStatusLabelStereo->setText(QString("x= novalue  y= novalue  z= novalue  "));
d.kilic's avatar
d.kilic committed
        else
            mStatusLabelStereo->setText(
                QString("x=%1cm  y=%2cm  z=%3cm  ").arg(x, 6, 'f', 1).arg(y, 6, 'f', 1).arg(z, 6, 'f', 1));
d.kilic's avatar
d.kilic committed
    }
}

void Petrack::setStatusTime()
{
    if(mStatusLabelTime)
d.kilic's avatar
d.kilic committed
        mStatusLabelTime->setText(mAnimation->getTimeString());
d.kilic's avatar
d.kilic committed
}

void Petrack::setStatusFPS()
{
    if(mStatusLabelFPS)
d.kilic's avatar
d.kilic committed
    {
        mStatusLabelFPS->setText(QString("%1fps  ").arg(mShowFPS, 5, 'f', 1));

        QPalette pal = mStatusLabelFPS->palette(); // static moeglich?
d.kilic's avatar
d.kilic committed

        double diff    = mShowFPS - mAnimation->getFPS();
        int    opacity = mPlayerWidget->getPlayerSpeedLimited() ? 128 : 20;
d.kilic's avatar
d.kilic committed

        if(diff < -6) // very slow ==> red
            color.setRgb(200, 0, 0, opacity);
        else if(diff < -2) // better ==> yellow
            color.setRgb(200, 200, 0, opacity);
        else if(diff > -2) // nearly ok ==> green
            color.setRgb(0, 200, 0, opacity);
d.kilic's avatar
d.kilic committed

        pal.setColor(QPalette::Window, color);

        mStatusLabelFPS->setPalette(pal);
    }
}
void Petrack::setShowFPS(double fps)
{
    if((fps == 0.) || (mShowFPS == 0))
d.kilic's avatar
d.kilic committed
        mShowFPS = fps;
d.kilic's avatar
d.kilic committed
    else
        mShowFPS = mShowFPS * .9 + fps * .1; // glaetten durch Hinzunahme des alten Wertes
d.kilic's avatar
d.kilic committed
    setStatusFPS();
}

/**
 * @brief Updates the FPS shown to the User
 *
 * This method calculates the FPS by remembering how long
 * it has been since it was called last time. If skipped is
 * true, it doesn't directly update the FPS since 2
 * skipped frames have essentially a time delay of 0 between
 * them, which would make calculations wonky.
 *
 * @param skipped True, if this is a skipped frame; default false
 */
void Petrack::updateShowFPS(bool skipped)
{
    static QElapsedTimer lastTime;
    static int           skippedFrames = 0;
        skippedFrames++;
        return;
    }
d.kilic's avatar
d.kilic committed

    if(mPlayerWidget->getPaused())
d.kilic's avatar
d.kilic committed
    {
        setShowFPS(0.);
d.kilic's avatar
d.kilic committed
    }
    else
    {
        if(lastTime.isValid())
            if(lastTime.elapsed() > 0)
                int numFrames = skippedFrames > 0 ? skippedFrames + 1 : 1;
                setShowFPS(numFrames * 1000. / lastTime.elapsed());
                skippedFrames = 0;
d.kilic's avatar
d.kilic committed
    }
}

// ohne neue positionsangabe, sinnvoll, wenn berechnungsweise sich in getPosReal geaendert hat
// gebraucht in control.cpp
void Petrack::setStatusPosReal() // pos in cm
{
    if(mImageItem)
d.kilic's avatar
d.kilic committed
        setStatusPosReal(mImageItem->getPosReal(mMousePosOnImage, getStatusPosRealHeight()));
d.kilic's avatar
d.kilic committed
}
d.kilic's avatar
d.kilic committed
void Petrack::setStatusPosReal(const QPointF &pos) // pos in cm
{
    if(mStatusLabelPosReal)
d.kilic's avatar
d.kilic committed
    {
        QChar   deg(0xB0);
        QString labelText = QString(" cm from ground:%1cm,%2cm,%3")
                                .arg(pos.x(), 6, 'f', 1)
                                .arg(pos.y(), 6, 'f', 1)
                                .arg(
                                    getImageItem()->getAngleToGround(
                                        mMousePosOnImage.x(), mMousePosOnImage.y(), getStatusPosRealHeight()),
                                    5,
                                    'f',
                                    1);
d.kilic's avatar
d.kilic committed
        labelText.append(deg);
        mStatusLabelPosReal->setText(labelText);
    }
}
d.kilic's avatar
d.kilic committed
void Petrack::setStatusPos(const QPoint &pos) // pos in pixel
{
    mStatusLabelPos->setText(QString("%1x%2").arg(pos.x(), 4).arg(pos.y(), 4));
}
d.kilic's avatar
d.kilic committed
void Petrack::setStatusColor(const QRgb &col)
{
    QString s("#%1%2%3"); // static moeglich?
    s = s.arg(qRed(col), 2, 16, QChar('0')).arg(qGreen(col), 2, 16, QChar('0')).arg(qBlue(col), 2, 16, QChar('0'));
    if((qRed(col) + qGreen(col) + qBlue(col)) / 3 < 128)
d.kilic's avatar
d.kilic committed
        mStatusLabelColor->setText(QString("<font color=\"#ffffff\">&nbsp;%1</font>").arg(s));
d.kilic's avatar
d.kilic committed
    else
d.kilic's avatar
d.kilic committed
        mStatusLabelColor->setText(QString("<font color=\"#000000\">&nbsp;%1</font>").arg(s));
d.kilic's avatar
d.kilic committed

    QPalette pal = mStatusLabelColor->palette(); // static moeglich?
    QColor   color(qRed(col), qGreen(col), qBlue(col));
d.kilic's avatar
d.kilic committed

    pal.setColor(QPalette::Window, color);
    mStatusLabelColor->setPalette(pal);

    mControlWidget->getColorPlot()->setCursor(color);
    mControlWidget->getColorPlot()->replot();
}
d.kilic's avatar
d.kilic committed
void Petrack::setStatusColor()
{
    QPointF pos = getMousePosOnImage();
    if(pos.x() >= 0 && pos.x() < mImage->width() && pos.y() > 0 && pos.y() < mImage->height())
d.kilic's avatar
d.kilic committed
    {
        setStatusColor(mImage->pixel(pos.toPoint()));
d.kilic's avatar
d.kilic committed
    }
}

double Petrack::getStatusPosRealHeight()
{
    if(mStatusPosRealHeight)
d.kilic's avatar
d.kilic committed
        return mStatusPosRealHeight->value();
d.kilic's avatar
d.kilic committed
    else
d.kilic's avatar
d.kilic committed
        return 0.;
d.kilic's avatar
d.kilic committed
}

/**
 * @brief Reads (and applies) settings form platform-independent persistent storage
 *
 * The saved size and position of the application window get reconstructed. As well as
 * the options about antialiasing and the usage of OpenGL.
 * mSeqFileName and mProFileName get set, so the "Open Project" and "Open Sequence"
 * dialogues start at correct folder. The old project/sequence is NOT actually loaded.
 */
d.kilic's avatar
d.kilic committed
void Petrack::readSettings()
{
    QSettings settings("Forschungszentrum Juelich GmbH", "PeTrack by Maik Boltes, Daniel Salden");
    QPoint    pos  = settings.value("pos", QPoint(200, 200)).toPoint();
    QSize     size = settings.value("size", QSize(400, 400)).toSize();
d.kilic's avatar
d.kilic committed
    mAntialiasAct->setChecked(settings.value("antialias", false).toBool());
    mOpenGLAct->setChecked(settings.value("opengl", false).toBool());
    mSeqFileName = settings.value("seqFileName", QDir::currentPath()).toString();
    setProFileName(settings.value("proFilePath", QDir::currentPath()).toString());
    // nicht ganz sauber, da so immer schon zu anfang in calib file list etwas drin steht und somit auto ausgefuehrt
    // werden kann wird aber beim ersten openCalib... ueberschrieben
d.kilic's avatar
d.kilic committed
    mAutoCalib.addCalibFile(settings.value("calibFile", QDir::currentPath()).toString());
    resize(size);
    move(pos);
    antialias();
    opengl();
    mSplitter->restoreState(settings.value("controlSplitterSizes").toByteArray());
d.kilic's avatar
d.kilic committed
}

/**
 * @brief Writes persistent setting.
 * @see Petrack::readSettings
 */
d.kilic's avatar
d.kilic committed
void Petrack::writeSettings()
{
    QSettings settings("Forschungszentrum Juelich GmbH", "PeTrack by Maik Boltes, Daniel Salden");
    settings.setValue("pos", pos());
    settings.setValue("size", size());
    settings.setValue("antialias", mAntialiasAct->isChecked());
    settings.setValue("opengl", mOpenGLAct->isChecked());
    settings.setValue("seqFileName", mSeqFileName);
    settings.setValue("proFilePath", QFileInfo(mProFileName).path()); // nur path, damit bei saveCurrentProject
    if(!mAutoCalib.isEmptyCalibFiles())                               //! mCalibFiles.isEmpty()
d.kilic's avatar
d.kilic committed
        settings.setValue("calibFile", mAutoCalib.getCalibFile(0));
    settings.setValue("controlSplitterSizes", mSplitter->saveState());
d.kilic's avatar
d.kilic committed
}

bool Petrack::maybeSave()
{
    int ret = PWarning(
        this,
        tr("PeTrack"),
        tr("Do you want to save "
           "the current project?\n"
           "Be sure to save trajectories, background "
           "and 3D calibration point separately!"),
        PMessageBox::StandardButton::Yes | PMessageBox::StandardButton::No | PMessageBox::StandardButton::Cancel,
        PMessageBox::StandardButton::Yes);

    if(ret == PMessageBox::StandardButton::Yes)
d.kilic's avatar
d.kilic committed
    {
        if(saveSameProject())
d.kilic's avatar
d.kilic committed
            return true;
d.kilic's avatar
d.kilic committed
        else
d.kilic's avatar
d.kilic committed
            return false;
d.kilic's avatar
d.kilic committed
    }
    else if(ret == PMessageBox::StandardButton::Cancel)
d.kilic's avatar
d.kilic committed
        return false;
d.kilic's avatar
d.kilic committed
    else
d.kilic's avatar
d.kilic committed
        return true;
d.kilic's avatar
d.kilic committed
}

void Petrack::closeEvent(QCloseEvent *event)
{
    if(maybeSave())
d.kilic's avatar
d.kilic committed
    {
        writeSettings();
        mAutosave.deleteAutosave();
d.kilic's avatar
d.kilic committed
        event->accept();
    }
    else
d.kilic's avatar
d.kilic committed
        event->ignore();
d.kilic's avatar
d.kilic committed
}

/**
 * @brief Sets the mMousePosOnImage member variable and displayed pixel/real coordinates
 *
 * Gets called from ImageItem::hoverMoveEvent() and enables an easy access
 * to the mouse position.
 * @param pos Position of mouse cursor in image pixel coordinates
 */
d.kilic's avatar
d.kilic committed
void Petrack::setMousePosOnImage(QPointF pos)
{
d.kilic's avatar
d.kilic committed
    {
        mMousePosOnImage = pos;
        setStatusPosReal(mImageItem->getPosReal(pos, getStatusPosRealHeight()));

        // pixel coordinate
        QPoint pos1((int) (pos.x()) + 1, (int) (pos.y()) + 1);
        setStatusPos(pos1);
d.kilic's avatar
d.kilic committed
        // pixel color
        setStatusColor();
d.kilic's avatar
d.kilic committed
    }
}

void Petrack::keyPressEvent(QKeyEvent *event)
{
    switch(event->key())
    {
        case Qt::Key_Left:
            mPlayerWidget->frameBackward();
            break;
        case Qt::Key_Right:
            mPlayerWidget->frameForward();
            break;
        case Qt::Key_Down:
            mViewWidget->zoomOut(1);
            break;
        case Qt::Key_Up:
            mViewWidget->zoomIn(1);
            break;
        case Qt::Key_Space:
            // space wird von buttons, wenn focus drauf ist als Aktivierung vorher abgegriffen und nicht durchgereicht
            mPlayerWidget->togglePlayPause();
            break;
        case Qt::Key_D:
            break;
        default:;
d.kilic's avatar
d.kilic committed
    }
}

void Petrack::mousePressEvent(QMouseEvent *event)
{
    // mouse click in fps status label ?
    if(event->pos().x() >= mStatusLabelFPS->pos().x() &&
       event->pos().x() <= mStatusLabelFPS->pos().x() + mStatusLabelFPS->width())
d.kilic's avatar
d.kilic committed
    {
        mPlayerWidget->togglePlayerSpeedLimited();
d.kilic's avatar
d.kilic committed
        setStatusFPS();
    }
}

const QString &Petrack::getLastTrackerExport() const
{
    return mLastTrackerExport;
}

void Petrack::setLastTrackerExport(const QString &newLastTrackerExport)
{
    mLastTrackerExport = newLastTrackerExport;
}

/// update control widget, if image size changed (especially because of changing border)
void Petrack::updateControlImage(cv::Mat &img)
d.kilic's avatar
d.kilic committed
{
    // auch moeglich hoehe und breite von bild stat border veraenderungen zu checken
    static int lastBorderSize = -1;

    if(isLoading())
d.kilic's avatar
d.kilic committed
        lastBorderSize = -1;
d.kilic's avatar
d.kilic committed

    int diffBorderSize = 0;
    int iW             = img.cols;
    int iH             = img.rows;
d.kilic's avatar
d.kilic committed

    // wird auch nochmal in ImageWidget gemacht, aber ist hier frueher noetig
    double cX = mControlWidget->getCalibCx(); // merken, da min/max value verandernkann wenn aus dem rahmen
    double cY = mControlWidget->getCalibCy();
d.kilic's avatar
d.kilic committed

    mControlWidget->setCalibCxMin(0 /*iW/2.-50.*/);
d.kilic's avatar
d.kilic committed
    mControlWidget->setCalibCxMax(iW /*iW/2.+50.*/);
    mControlWidget->setCalibCyMin(0 /*iH/2.-50.*/);
d.kilic's avatar
d.kilic committed
    mControlWidget->setCalibCyMax(iH /*iH/2.+50.*/);

    if(mControlWidget->isFixCenterChecked())
d.kilic's avatar
d.kilic committed
    {
        mControlWidget->setCalibCx((iW - 1) / 2.);
        mControlWidget->setCalibCy((iH - 1) / 2.);
d.kilic's avatar
d.kilic committed
    }
    else
    {
        if(lastBorderSize != -1)
            diffBorderSize = getImageBorderSize() - lastBorderSize;
d.kilic's avatar
d.kilic committed
        lastBorderSize = getImageBorderSize();

        mControlWidget->setCalibCx(cX + diffBorderSize);
        mControlWidget->setCalibCy(cY + diffBorderSize);
d.kilic's avatar
d.kilic committed
    }
}

void Petrack::importTracker(QString dest) // default = ""
d.kilic's avatar
d.kilic committed
{
    static QString lastFile;

    if(lastFile == "")
d.kilic's avatar
d.kilic committed
        lastFile = mTrcFileName;
d.kilic's avatar
d.kilic committed

    // if no destination file or folder is given
    if(dest.isEmpty())
d.kilic's avatar
d.kilic committed
    {
        dest = QFileDialog::getOpenFileName(
            this,
            tr("Select file for importing tracking pathes"),
            lastFile,
            tr("PeTrack tracker (*.trc *.txt);;All files (*.*)"));
d.kilic's avatar
d.kilic committed
    }

    if(!dest.isEmpty())
d.kilic's avatar
d.kilic committed
    {
        if(dest.right(4) == ".trc")
d.kilic's avatar
d.kilic committed
        {
            QFile file(dest);
d.kilic's avatar
d.kilic committed

            if(!file.open(QIODevice::ReadOnly | QIODevice::Text))
d.kilic's avatar
d.kilic committed
            {
                // errorstring ist je nach Betriebssystem in einer anderen Sprache!!!!
                PCritical(this, tr("PeTrack"), tr("Cannot open %1:\n%2").arg(dest).arg(file.errorString()));
d.kilic's avatar
d.kilic committed
                return;
            }

            setTrackChanged(true); // flag changes of track parameters
d.kilic's avatar
d.kilic committed
            mTracker->reset();

            QTextStream in(&file);
            TrackPerson tp;
            QString     comment;
d.kilic's avatar
d.kilic committed

            bool    ok; // shows if int stands in first line - that was in the first version of trc file
d.kilic's avatar
d.kilic committed
            QString firstLine = in.readLine();
            sz                = firstLine.toInt(&ok);
            if(!ok)
d.kilic's avatar
d.kilic committed
            {
                if(firstLine.contains("version 4", Qt::CaseInsensitive))
                else if(firstLine.contains("version 3", Qt::CaseInsensitive))
d.kilic's avatar
d.kilic committed
                {
                    trcVersion = 3;
                else if(firstLine.contains("version 2", Qt::CaseInsensitive))
d.kilic's avatar
d.kilic committed
                {
                    trcVersion = 2;
d.kilic's avatar
d.kilic committed
                {
                    SPDLOG_ERROR("wrong header while reading TRC file.");
                    QMessageBox::critical(
                        this,
                        tr("PeTrack"),
                        tr("Could not import tracker:\nNot supported trc version in file: %1.").arg(dest));
d.kilic's avatar
d.kilic committed
                }
                in >> sz;
            }
            else
d.kilic's avatar
d.kilic committed
                trcVersion = 1;
d.kilic's avatar
d.kilic committed

            if((sz > 0) && (mPersonStorage.nbPersons() != 0))
                SPDLOG_WARN("overlapping trajectories will be joined not until tracking adds new TrackPoints.");
            for(i = 0; i < sz; ++i)
d.kilic's avatar
d.kilic committed
            {
                if(trcVersion == 2)
d.kilic's avatar
d.kilic committed
                {
                    in >> tp;
                }
                else if(trcVersion >= 3)
d.kilic's avatar
d.kilic committed
                {
                    in >> tp;
                }
                mPersonStorage.addPerson(tp);
                tp.clear(); // loeschen, sonst immer weitere pfade angehangen werden
d.kilic's avatar
d.kilic committed
            }

            mControlWidget->setTrackNumberAll(QString("%1").arg(mPersonStorage.nbPersons()));
            mControlWidget->setTrackShowOnlyNr(static_cast<int>(MAX(mPersonStorage.nbPersons(), 1)));
            mControlWidget->setTrackNumberVisible(
                QString("%1").arg(mPersonStorage.visible(mAnimation->getCurrentFrameNum())));
            mControlWidget->replotColorplot();
d.kilic's avatar
d.kilic committed
            file.close();
            SPDLOG_INFO("import {} ({} person(s), file version {})", dest, sz, trcVersion);
            mTrcFileName =
                dest; // fuer Project-File, dann koennte track path direkt mitgeladen werden, wenn er noch da ist
        }
        else if(dest.right(4) == ".txt") // 3D Koordinaten als Tracking-Daten importieren Zeilenformat: Personennr,
                                         // Framenr, x, y, z
d.kilic's avatar
d.kilic committed
        {
            PWarning(
                this,
                tr("PeTrack"),
                tr("Are you sure you want to import 3D data from TXT-File? You have to make sure that the coordinate "
                   "system now is exactly at the same position and orientation than at export time!"));
d.kilic's avatar
d.kilic committed

            QFile file(dest);
            // size of person list
            int sz = 0;

            if(!file.open(QIODevice::ReadOnly | QIODevice::Text))
d.kilic's avatar
d.kilic committed
            {
                // errorstring ist je nach Betriebssystem in einer anderen Sprache!!!!
                PCritical(this, tr("PeTrack"), tr("Cannot open %1:\n%2").arg(dest).arg(file.errorString()));
d.kilic's avatar
d.kilic committed
                return;
            }

            setTrackChanged(true); // flag changes of track parameters
d.kilic's avatar
d.kilic committed
            mTracker->reset();

            QTextStream in(&file);
            TrackPerson tp;
            TrackPoint  tPoint;
d.kilic's avatar
d.kilic committed

            QString line;
            QString headerline;
            bool    exec_once_flag        = false;
            double  conversionFactorTo_cm = 1.0;
            int     personNr = -1, frameNr = -1, current_personNr = 1;
            float   x, y, z;
d.kilic's avatar
d.kilic committed

d.kilic's avatar
d.kilic committed
            {
                // Falls Datei am Ende letzte Person abspeichern und Lese-Schleife beenden
                if(in.atEnd())
d.kilic's avatar
d.kilic committed
                {
                    tp.setLastFrame(frameNr);
                    mPersonStorage.addPerson(tp);
d.kilic's avatar
d.kilic committed
                    ++sz;
                    tp.clear();
                    break;
                }

                line = in.readLine();

                // Kommentare ueberlesen
                if(line.startsWith("#", Qt::CaseInsensitive))
d.kilic's avatar
d.kilic committed
                {
                    headerline = line;
                    continue;
                }

                if((!exec_once_flag) && (!headerline.contains("cm")))
d.kilic's avatar
d.kilic committed
                {
                    conversionFactorTo_cm = 100.0;
                    exec_once_flag        = true;
                    PWarning(
                        this,
                        tr("PeTrack"),
                        tr("PeTrack will interpret position data as unit [m]. No header with [cm] found."));
d.kilic's avatar
d.kilic committed
                }

                QTextStream stream(&line);

                // Zeile als Stream einlesen Format: [id frame x y z]
                stream >> personNr >> frameNr >> x >> y >> z;
d.kilic's avatar
d.kilic committed

                // convert data to cm
                x = x * conversionFactorTo_cm;
                y = y * conversionFactorTo_cm;
                z = z * conversionFactorTo_cm;

                // 3-dimensionale Berechnung/Anzeige des Punktes
                if(mControlWidget->getCalibCoordDimension() == 0)
d.kilic's avatar
d.kilic committed
                {
                    p2d = mExtrCalibration.getImagePoint(cv::Point3f(x, y, z));
d.kilic's avatar
d.kilic committed
                }
                // 2-dimensionale Berechnung/Anzeige des Punktes
                else
                {
                    QPointF pos = mImageItem->getPosImage(QPointF(x, y), z);
                    p2d.x       = pos.x();
                    p2d.y       = pos.y();
d.kilic's avatar
d.kilic committed
                }

                tPoint = TrackPoint(Vec2F(p2d.x, p2d.y), 100);
                tPoint.setSp(
                    x,
                    y,
                    -mControlWidget->getCalibExtrTrans3() -
                        z); // fuer den Abstand zur Kamera in z-Richtung wie bei einer Stereokamera
d.kilic's avatar
d.kilic committed

                // Neue ID ? ==> letzte Person beendet ==> abspeichern
                if(personNr > current_personNr)
d.kilic's avatar
d.kilic committed
                {
                    mPersonStorage.addPerson(tp);
d.kilic's avatar
d.kilic committed
                    ++sz;
                    current_personNr++;
                    tp.clear();
                }

                // TrackPerson leer ? ==> Neue TrackPerson erstellen
                if(tp.isEmpty())
d.kilic's avatar
d.kilic committed
                {
                    tp = TrackPerson(personNr, frameNr, tPoint);
                    tp.setFirstFrame(frameNr);
                    tp.setHeight(z);
                }
                // TrackPoint an TrackPerson anhaengen
                else
                {
                    tp.setLastFrame(frameNr);
                    tp.append(tPoint);
                }
            }

            mControlWidget->setTrackNumberAll(QString("%1").arg(mPersonStorage.nbPersons()));
            mControlWidget->setTrackShowOnlyNr(static_cast<int>(MAX(mPersonStorage.nbPersons(), 1)));
            mControlWidget->setTrackNumberVisible(
                QString("%1").arg(mPersonStorage.visible(mAnimation->getCurrentFrameNum())));
            mControlWidget->replotColorplot();
d.kilic's avatar
d.kilic committed
            file.close();
            SPDLOG_INFO("import {} ({} person(s))", dest, sz);
            mTrcFileName =
                dest; // fuer Project-File, dann koennte track path direkt mitgeladen werden, wenn er noch da ist
d.kilic's avatar
d.kilic committed
        }
        else
        {
            PCritical(this, tr("PeTrack"), tr("Cannot load %1 maybe because of wrong file extension.").arg(dest));
d.kilic's avatar
d.kilic committed
        }
        lastFile = dest;
    }
}

void Petrack::testTracker()
{
    static int idx = 0; // index in Fehlerliste, die als letztes angesprungen wurde
d.kilic's avatar
d.kilic committed
    QList<int> pers, frame;

    mPersonStorage.checkPlausibility(
        mControlWidget->isTestEqualChecked(),
        mControlWidget->isTestVelocityChecked(),
        mControlWidget->isTestInsideChecked(),
        mControlWidget->isTestLengthChecked());
    if(pers.length() <= idx)
    if(pers.length() > idx)
d.kilic's avatar
d.kilic committed
    {
        mControlWidget->setTrackShowOnly(Qt::Checked);
        mControlWidget->setTrackShowOnlyNr(pers[idx]);
        mPlayerWidget->skipToFrame(frame[idx]);
d.kilic's avatar
d.kilic committed
        ++idx;
    }
}

int Petrack::calculateRealTracker()
{
    bool autoCorrectOnlyExport = (mReco.getRecoMethod() == reco::RecognitionMethod::MultiColor) && // multicolor
                                 mMultiColorMarkerWidget->autoCorrect->isChecked() &&
                                 mMultiColorMarkerWidget->autoCorrectOnlyExport->isChecked();
    int anz = mTrackerReal->calculate(
        mTracker,
        mImageItem,
        mControlWidget->getColorPlot(),
        mMissingFrames,
        getImageBorderSize(),
        mControlWidget->getAnaMissingFrames(),
        mStereoWidget->stereoUseForExport->isChecked(),
        mControlWidget->getTrackAlternateHeight(),
        mControlWidget->getCameraAltitude(),
        mStereoWidget->stereoUseCalibrationCenter->isChecked(),
        mControlWidget->isExportElimTpChecked(),
        mControlWidget->isExportElimTrjChecked(),
        mControlWidget->isExportSmoothChecked(),
        mControlWidget->isExportViewDirChecked(),
        mControlWidget->isExportAngleOfViewChecked(),
        mControlWidget->isExportMarkerIDChecked(),
        autoCorrectOnlyExport);
d.kilic's avatar
d.kilic committed

    mTrackerReal->calcMinMax();
    return anz;
}

void Petrack::exportTracker(QString dest) // default = ""
d.kilic's avatar
d.kilic committed
{
d.kilic's avatar
d.kilic committed
    {
        // if no destination file or folder is given
        if(dest.isEmpty())
d.kilic's avatar
d.kilic committed
        {
            QFileDialog fileDialog(
                this,
                tr("Select file for exporting tracking pathes"),
                tr("Tracker (*.*);;Petrack tracker (*.trc);;Text (*.txt);;Text for gnuplot(*.dat);;XML Travisto "
                   "(*.trav);;All supported types (*.txt *.trc *.dat *.trav *.);;All files (*.*)"));
d.kilic's avatar
d.kilic committed
            fileDialog.setAcceptMode(QFileDialog::AcceptSave);
            fileDialog.setFileMode(QFileDialog::AnyFile);
            fileDialog.setDefaultSuffix("");

            if(fileDialog.exec())
            {
d.kilic's avatar
d.kilic committed
                dest = fileDialog.selectedFiles().at(0);
            }
d.kilic's avatar
d.kilic committed

        if(!dest.isEmpty())
d.kilic's avatar
d.kilic committed
        {
            QList<int> pers, frame;
            bool autoCorrectOnlyExport = (mReco.getRecoMethod() == reco::RecognitionMethod::MultiColor) && // multicolor
                                         mMultiColorMarkerWidget->autoCorrect->isChecked() &&
                                         mMultiColorMarkerWidget->autoCorrectOnlyExport->isChecked();
d.kilic's avatar
d.kilic committed

            if(dest.right(4) == ".trc")
d.kilic's avatar
d.kilic committed
            {
#ifdef TIME_MEASUREMENT
                double time1 = 0.0, tstart;
                tstart       = clock();
d.kilic's avatar
d.kilic committed
#endif
                QTemporaryFile file;

                if(!file.open() /*!file.open(QIODevice::WriteOnly | QIODevice::Text)*/)
d.kilic's avatar
d.kilic committed
                {
                    PCritical(this, tr("PeTrack"), tr("Cannot open %1:\n%2.").arg(dest).arg(file.errorString()));
d.kilic's avatar
d.kilic committed
                    return;
                }
d.kilic's avatar
d.kilic committed
                QProgressDialog progress(
                    "Export TRC-File", nullptr, 0, static_cast<int>(mPersonStorage.nbPersons() + 1), this->window());
d.kilic's avatar
d.kilic committed
                progress.setWindowTitle("Export .trc-File");
                progress.setWindowModality(Qt::WindowModal);
                progress.setVisible(true);
                progress.setValue(0);
                progress.setLabelText(QString("Export tracking data ..."));

                qApp->processEvents();

                trcVersion = 4;
d.kilic's avatar
d.kilic committed

                SPDLOG_INFO(
                    "export tracking data to {} ({} person(s), file version {})",
                    dest,
                    mPersonStorage.nbPersons(),
                    trcVersion);
d.kilic's avatar
d.kilic committed
                QTextStream out(&file);

                out << "version " << trcVersion << Qt::endl;
                out << mPersonStorage.nbPersons() << Qt::endl;
                const auto &persons = mPersonStorage.getPersons();
                for(size_t i = 0; i < persons.size(); ++i)
d.kilic's avatar
d.kilic committed
                {
                    qApp->processEvents();
                    progress.setLabelText(
                        QString("Export person %1 of %2 ...").arg(i + 1).arg(mPersonStorage.nbPersons()));
d.kilic's avatar
d.kilic committed
                    progress.setValue(static_cast<int>(i + 1));
                    out << persons[i] << Qt::endl;
d.kilic's avatar
d.kilic committed
                }
                file.flush();
                file.close();
#ifdef TIME_MEASUREMENT
                time1 += clock() - tstart;
                time1 = time1 / CLOCKS_PER_SEC;
d.kilic's avatar
d.kilic committed
                cout << "  time(writing) = " << time1 << " sec." << endl;

d.kilic's avatar
d.kilic committed
                tstart = clock();
#endif
                progress.setLabelText(QString("Save file ..."));
                qApp->processEvents();

                if(QFile::exists(dest))
d.kilic's avatar
d.kilic committed
                    QFile::remove(dest);
d.kilic's avatar
d.kilic committed

                if(!file.copy(dest))
                    PCritical(
                        this,
                        tr("PeTrack"),
                        tr("Could not export tracking data.\n"
                           "Please try again!"));
d.kilic's avatar
d.kilic committed
                else
d.kilic's avatar
d.kilic committed
                    statusBar()->showMessage(tr("Saved tracking data to %1.").arg(dest), 5000);
d.kilic's avatar
d.kilic committed

d.kilic's avatar
d.kilic committed
                progress.setValue(static_cast<int>(mPersonStorage.nbPersons() + 1));
d.kilic's avatar
d.kilic committed

                SPDLOG_INFO("finished.");
                mAutosave.resetTrackPersonCounter();
d.kilic's avatar
d.kilic committed

#ifdef TIME_MEASUREMENT
                time1 += clock() - tstart;
                time1 = time1 / CLOCKS_PER_SEC;
d.kilic's avatar
d.kilic committed
                cout << "  time(copying) = " << time1 << " sec." << endl;

//                time1 = 0.0;
//                tstart = clock();
#endif
d.kilic's avatar
d.kilic committed
#ifdef TIME_MEASUREMENT
//                time1 += clock() - tstart;
//                time1 = time1/CLOCKS_PER_SEC;
//                cout << "  time(checkPlausibility) = " << time1 << " sec." << endl;
#endif
                mTrcFileName =
                    dest; // fuer Project-File, dann koennte track path direkt mitgeladen werden, wenn er noch da ist
d.kilic's avatar
d.kilic committed
            }
            else if(dest.right(4) == ".txt")
d.kilic's avatar
d.kilic committed
            {
                QTemporaryFile file;

                if(!file.open())
d.kilic's avatar
d.kilic committed
                {
                    PCritical(this, tr("PeTrack"), tr("Cannot open %1:\n%2.").arg(dest).arg(file.errorString()));
d.kilic's avatar
d.kilic committed
                    return;
                }

                SPDLOG_INFO("export tracking data to {} ({} person(s))...", dest, mPersonStorage.nbPersons());
d.kilic's avatar
d.kilic committed

#ifdef TIME_MEASUREMENT
                double time1 = 0.0, tstart;
                tstart       = clock();
d.kilic's avatar
d.kilic committed
#endif
                // recalcHeight true, wenn personenhoehe ueber trackpoints neu berechnet werden soll (z.b. um waehrend
                // play mehrfachberuecksichtigung von punkten auszuschliessen, aenderungen in altitude neu in berechnung
                // einfliessen zu lassen)
                if(mControlWidget->isTrackRecalcHeightChecked())
d.kilic's avatar
d.kilic committed
                {
                    if(mControlWidget->getCalibCoordDimension() == 0) // 3D
                        ; // Nothing to be done because z already the right height
                        mPersonStorage.recalcHeight(mControlWidget->getCameraAltitude());
d.kilic's avatar
d.kilic committed
                }
#ifdef TIME_MEASUREMENT
                time1 += clock() - tstart;
                time1 = time1 / CLOCKS_PER_SEC;
d.kilic's avatar
d.kilic committed
                cout << "  time(recalcHeight) = " << time1 << " sec." << endl;

d.kilic's avatar
d.kilic committed
                tstart = clock();
                mTrackerReal->calculate(
                    mTracker,
                    mImageItem,
                    mControlWidget->getColorPlot(),
                    mMissingFrames,
                    getImageBorderSize(),
                    mControlWidget->isTrackMissingFramesChecked(),
                    mStereoWidget->stereoUseForExport->isChecked(),
                    mControlWidget->getTrackAlternateHeight(),
                    mControlWidget->getCameraAltitude(),
                    mStereoWidget->stereoUseCalibrationCenter->isChecked(),
                    mControlWidget->isExportElimTpChecked(),
                    mControlWidget->isExportElimTrjChecked(),
                    mControlWidget->isExportSmoothChecked(),
                    mControlWidget->isExportViewDirChecked(),
                    mControlWidget->isExportAngleOfViewChecked(),
                    mControlWidget->isExportMarkerIDChecked(),
                    autoCorrectOnlyExport);
d.kilic's avatar
d.kilic committed
#ifdef TIME_MEASUREMENT
                time1 += clock() - tstart;
                time1 = time1 / CLOCKS_PER_SEC;
d.kilic's avatar
d.kilic committed
                cout << "  time(calculate) = " << time1 << " sec." << endl;

d.kilic's avatar
d.kilic committed
                tstart = clock();
#endif

                QTextStream out(&file);

                out << "# PeTrack project: " << QFileInfo(getProFileName()).fileName() << Qt::endl;
                out << "# raw trajectory file: " << QFileInfo(getTrackFileName()).fileName() << Qt::endl;
                out << "# framerate: " << mAnimation->getFPS() << " fps" << Qt::endl;
d.kilic's avatar
d.kilic committed

                if(mControlWidget->isExportCommentChecked())
d.kilic's avatar
d.kilic committed
                {
                    out << "# personal information:" << Qt::endl;
                    out << "# ID| Comment" << Qt::endl;
d.kilic's avatar
d.kilic committed

                    // std out
                    SPDLOG_INFO("Printing comment table...");
                    SPDLOG_INFO("ID  | Comment");
                    SPDLOG_INFO("----|----------------");
d.kilic's avatar
d.kilic committed

                    for(int i = 0; i < static_cast<int>(mPersonStorage.nbPersons()); ++i)
d.kilic's avatar
d.kilic committed
                    {
                        auto commentSplit = mPersonStorage.at(i).comment().split("\n", Qt::KeepEmptyParts);
                        out << "#" << qSetFieldWidth(3) << (i + 1) << qSetFieldWidth(0) << "|" << commentSplit.at(0)
                            << Qt::endl;
                        SPDLOG_INFO("{:04d}|{}", (i + 1), commentSplit.at(0));
                        commentSplit.pop_front();
                        for(const QString &line : commentSplit)
                        {
                            out << "#" << qSetFieldWidth(3) << " " << qSetFieldWidth(0) << "|" << line << Qt::endl;
                            SPDLOG_INFO("    |{}", line);
d.kilic's avatar
d.kilic committed
                    }
                }
                mTrackerReal->exportTxt(
                    out,
                    mControlWidget->getTrackAlternateHeight(),
                    mStereoWidget->stereoUseForExport->isChecked(),
                    mControlWidget->isExportViewDirChecked(),
                    mControlWidget->isExportAngleOfViewChecked(),
                    mControlWidget->isExportUseMeterChecked(),
                    mControlWidget->isExportMarkerIDChecked());
                // out << *mTrackerReal;
d.kilic's avatar
d.kilic committed
                file.flush();
                file.close();

                if(QFile::exists(dest))
d.kilic's avatar
d.kilic committed
                    QFile::remove(dest);
d.kilic's avatar
d.kilic committed

                if(!file.copy(dest))