156 lines
5.9 KiB
C++
156 lines
5.9 KiB
C++
#pragma once
|
|||
|
|
// 鈺愨晲鈺愨晲鈺愨晲鈺愨晲鈺愨晲鈺愨晲鈺愨晲鈺愨晲鈺愨晲鈺愨晲鈺愨晲鈺愨晲鈺愨晲鈺愨晲鈺愨晲鈺愨晲鈺愨晲鈺愨晲鈺愨晲鈺愨晲鈺愨晲鈺愨晲鈺愨晲鈺愨晲鈺愨晲鈺愨晲鈺愨晲鈺愨晲鈺愨晲鈺愨晲鈺愨晲鈺愨晲鈺愨晲鈺愨晲鈺愨晲鈺愨晲鈺愨晲鈺愨晲
|
||
|
|
// MeasurePanel.h 鈹€ 閲囬泦 / 鍏ㄦ祦绋嬫祴閲?/ 鏁版嵁绠$悊 / 瀵煎嚭 (v4)
|
||
|
|
// 鈺愨晲鈺愨晲鈺愨晲鈺愨晲鈺愨晲鈺愨晲鈺愨晲鈺愨晲鈺愨晲鈺愨晲鈺愨晲鈺愨晲鈺愨晲鈺愨晲鈺愨晲鈺愨晲鈺愨晲鈺愨晲鈺愨晲鈺愨晲鈺愨晲鈺愨晲鈺愨晲鈺愨晲鈺愨晲鈺愨晲鈺愨晲鈺愨晲鈺愨晲鈺愨晲鈺愨晲鈺愨晲鈺愨晲鈺愨晲鈺愨晲鈺愨晲鈺愨晲鈺愨晲
|
||
|
|
#include <QObject>
|
||
|
|
#include <QImage>
|
||
|
|
#include <QRect>
|
||
|
|
#include <QRectF>
|
||
|
|
#include <QMap>
|
||
|
|
#include <QVector>
|
||
|
|
#include <QPoint>
|
||
|
|
#include <QPointF>
|
||
|
|
#include "VisionGuideMatcher.h"
|
||
|
|
#include "StereoPoseFusion.h"
|
||
|
|
|
||
|
|
namespace Ui { class MainWindowClass; }
|
||
|
|
class CameraPanel;
|
||
|
|
class LightPanel;
|
||
|
|
class YoloPanel;
|
||
|
|
class VisionGuidePanel;
|
||
|
|
class CoordTransformPanel;
|
||
|
|
class QLabel;
|
||
|
|
class QPushButton;
|
||
|
|
class QThread;
|
||
|
|
|
||
|
|
struct MeasurementCaptureSnapshot {
|
||
|
|
bool valid = false;
|
||
|
|
quint64 runId = 0;
|
||
|
|
qint64 captureBeginMs = 0, captureEndMs = 0;
|
||
|
|
QImage leftImage, rightImage;
|
||
|
|
VisionPoseResult leftPose, rightPose, finalPose;
|
||
|
|
StereoPoseFusion::FusionResult fusion;
|
||
|
|
CameraSide finalSide = CAM_LEFT;
|
||
|
|
QRect leftRoi, rightRoi;
|
||
|
|
VisionGuideMatcher::Params parameters;
|
||
|
|
QString leftCal, rightCal, leftModel, rightModel, stereoPoseFile;
|
||
|
|
};
|
||
|
|
|
||
|
|
class MeasurePanel : public QObject
|
||
|
|
{
|
||
|
|
Q_OBJECT
|
||
|
|
public:
|
||
|
|
MeasurePanel(Ui::MainWindowClass& u,
|
||
|
|
CameraPanel* cam, LightPanel* light, YoloPanel* yolo,
|
||
|
|
VisionGuidePanel* VisionGuide, CoordTransformPanel* coord,
|
||
|
|
VisionGuideMatcher* halM, StereoPoseFusion* fusion, QObject* parent = nullptr);
|
||
|
|
~MeasurePanel();
|
||
|
|
|
||
|
|
VisionPoseResult lastPose() const { return m_lastPose; }
|
||
|
|
StereoPoseFusion::FusionResult lastFusion() const { return m_lastFusion; }
|
||
|
|
void updateActionButtons();
|
||
|
|
bool isBusy() const { return m_measureBusy; }
|
||
|
|
MeasurementCaptureSnapshot lastMeasurementSnapshot() const { return m_captureSnapshot; }
|
||
|
|
double currentGraspOffsetMm() const;
|
||
|
|
VisionGuideMatcher::Params currentVisionParameters();
|
||
|
|
bool beginExternalMeasurement(const MeasurementCaptureSnapshot& snapshot);
|
||
|
|
void acceptExternalMeasurement(const MeasurementCaptureSnapshot& snapshot);
|
||
|
|
void endExternalMeasurement();
|
||
|
|
|
||
|
|
public slots:
|
||
|
|
void onCapture();
|
||
|
|
void onStartMeasure();
|
||
|
|
void showExternalResultImage(const QString& name, const QImage& img);
|
||
|
|
|
||
|
|
signals:
|
||
|
|
void measurementCaptureStarted();
|
||
|
|
void logMessage(const QString& msg);
|
||
|
|
void measureCompleted(bool success);
|
||
|
|
|
||
|
|
protected:
|
||
|
|
bool eventFilter(QObject* obj, QEvent* event) override;
|
||
|
|
|
||
|
|
private slots:
|
||
|
|
void onFastMeasure(); // 保留内部实现以兼容旧流程,界面按钮已移除
|
||
|
|
void onLoadLeftCal();
|
||
|
|
void onLoadRightCal();
|
||
|
|
void onLoadStereoCal();
|
||
|
|
void onLoadShapeModelLeft();
|
||
|
|
void onLoadShapeModelRight();
|
||
|
|
void onResultViewChanged(int);
|
||
|
|
void onBrowseExportDir();
|
||
|
|
void onExportPoseCamera();
|
||
|
|
void onExportPoseRobot();
|
||
|
|
void onExportResultImages();
|
||
|
|
void onROIContextMenu(const QPoint& pos);
|
||
|
|
void onPoseDisplayRequested(const VisionPoseResult& pose, const QString& mode);
|
||
|
|
|
||
|
|
private:
|
||
|
|
void tryLoadDefaultStereoCalib();
|
||
|
|
void applyStereoCalibFiles(const QString& l, const QString& r, const QString& rel);
|
||
|
|
void autoLoadShapeModels();
|
||
|
|
void storeResultImage(const QString& name, const QImage& img, bool saveToExport = false);
|
||
|
|
void showCurrentResultImage();
|
||
|
|
void resetResultViewTransform();
|
||
|
|
void renderCurrentResultImage();
|
||
|
|
QRectF currentResultDrawRect() const;
|
||
|
|
void clampResultPan();
|
||
|
|
void displayPoseResult(const VisionPoseResult& p, bool estunAbc = false);
|
||
|
|
void rememberPoseOverlaySource(const QImage& image,
|
||
|
|
const VisionPoseResult& pose,
|
||
|
|
CameraSide side);
|
||
|
|
bool showGraspPointOverlay(const VisionPoseResult& pose);
|
||
|
|
void appendFusionCsv(const VisionPoseResult& leftPose,
|
||
|
|
const VisionPoseResult& rightPose,
|
||
|
|
const StereoPoseFusion::FusionResult& fusion,
|
||
|
|
const VisionPoseResult& finalPose,
|
||
|
|
qint64 totalMs);
|
||
|
|
bool ensureExportDir();
|
||
|
|
|
||
|
|
static QString defaultStereoCalibDir();
|
||
|
|
static QString defaultLeftCalFile();
|
||
|
|
static QString defaultRightCalFile();
|
||
|
|
static QString defaultRelPoseFile();
|
||
|
|
|
||
|
|
Ui::MainWindowClass& ui;
|
||
|
|
CameraPanel* m_cam;
|
||
|
|
LightPanel* m_light;
|
||
|
|
YoloPanel* m_yolo;
|
||
|
|
VisionGuidePanel* m_visionGuide;
|
||
|
|
CoordTransformPanel* m_coord;
|
||
|
|
VisionGuideMatcher* m_visionMatcher;
|
||
|
|
StereoPoseFusion* m_fusion;
|
||
|
|
|
||
|
|
QString m_leftCalFile;
|
||
|
|
QString m_rightCalFile;
|
||
|
|
QString m_stereoCalFile;
|
||
|
|
QString m_shapeModelFileLeft;
|
||
|
|
QString m_shapeModelFileRight;
|
||
|
|
|
||
|
|
QImage m_capturedFrame;
|
||
|
|
CameraSide m_capturedSide = CAM_LEFT;
|
||
|
|
VisionPoseResult m_lastPose;
|
||
|
|
MeasurementCaptureSnapshot m_captureSnapshot;
|
||
|
|
VisionPoseResult m_displayPose;
|
||
|
|
StereoPoseFusion::FusionResult m_lastFusion;
|
||
|
|
QImage m_poseOverlayBaseImage;
|
||
|
|
VisionPoseResult m_poseOverlayCenterPose;
|
||
|
|
CameraSide m_poseOverlaySide = CAM_LEFT;
|
||
|
|
QMap<QString, QImage> m_resultImages;
|
||
|
|
QString m_exportDir;
|
||
|
|
bool m_resultImagesReadyForExport = false;
|
||
|
|
bool m_measureBusy = false;
|
||
|
|
bool m_measureTimedOut = false;
|
||
|
|
quint64 m_measureRunId = 0;
|
||
|
|
VisionPoseResult m_measurePartialLeft;
|
||
|
|
VisionPoseResult m_measurePartialRight;
|
||
|
|
QThread* m_measureThread = nullptr;
|
||
|
|
double m_resultZoom = 1.0;
|
||
|
|
QPointF m_resultPan;
|
||
|
|
bool m_resultPanning = false;
|
||
|
|
QPoint m_resultPanStart;
|
||
|
|
QPointF m_resultPanStartOffset;
|
||
|
|
|
||
|
|
QPushButton* m_btnExportResultImages = nullptr;
|
||
|
|
};
|