|
2 | 2 | #include <QDebug> |
3 | 3 | #include <QString> |
4 | 4 | #include <QVideoFrame> |
| 5 | +#include <QCoreApplication> |
| 6 | +#include <QSettings> |
5 | 7 | #include <gphoto2/gphoto2-camera.h> |
6 | 8 | #include <gphoto2/gphoto2-context.h> |
7 | 9 | #include <gphoto2/gphoto2-list.h> |
8 | 10 | #include <gphoto2/gphoto2-port.h> |
| 11 | +#include <thread> |
| 12 | +#include <chrono> |
9 | 13 |
|
10 | 14 | namespace { |
11 | 15 | constexpr auto capturingFailLimit = 10; |
@@ -85,10 +89,60 @@ GPhotoCameraWorker::GPhotoCameraWorker() |
85 | 89 |
|
86 | 90 | mKeepAliveTimer.setInterval(1000 * 60); // Check every minute |
87 | 91 | mKeepAliveTimer.setSingleShot(true); |
| 92 | + |
| 93 | + // Trigger camera wake-up GPIO on startup before camera enumeration |
| 94 | + triggerCameraWakeup(); |
88 | 95 | } |
89 | 96 | GPhotoCameraWorker::~GPhotoCameraWorker() {} |
90 | 97 |
|
| 98 | +void GPhotoCameraWorker::triggerCameraWakeup() { |
| 99 | + // Read GPIO settings from QSettings |
| 100 | + QSettings settings; |
| 101 | + |
| 102 | + bool gpioEnabled = settings.value("gpioEnabled", false).toBool(); |
| 103 | + bool cameraWakeupEnabled = settings.value("gpioCameraWakeupEnabled", false).toBool(); |
| 104 | + |
| 105 | + if (!gpioEnabled || !cameraWakeupEnabled) { |
| 106 | + return; |
| 107 | + } |
| 108 | + |
| 109 | + QString gpioChip = settings.value("gpioChip", "/dev/gpiochip0").toString(); |
| 110 | + int wakeupLine = settings.value("gpioCameraWakeupLine", 17).toInt(); |
| 111 | + int delayMs = settings.value("gpioCameraWakeupDelayMs", 100).toInt(); |
| 112 | + |
| 113 | + qDebug() << "Triggering camera wake-up GPIO on" << gpioChip << "line" << wakeupLine; |
| 114 | + |
| 115 | + try { |
| 116 | + // Create GPIO instance for wake-up |
| 117 | + mCameraWakeupGpio = std::make_unique<GPIO>(); |
| 118 | + mCameraWakeupGpio->setChipPath(gpioChip); |
| 119 | + mCameraWakeupGpio->setLine(wakeupLine); |
| 120 | + mCameraWakeupGpio->setMode(GPIO::Output); |
| 121 | + mCameraWakeupGpio->setEnabled(true); |
| 122 | + |
| 123 | + // Trigger GPIO (set high) |
| 124 | + mCameraWakeupGpio->setValue(1.0); |
| 125 | + |
| 126 | + // Wait for delay |
| 127 | + if (delayMs > 0) { |
| 128 | + std::this_thread::sleep_for(std::chrono::milliseconds(delayMs)); |
| 129 | + } |
| 130 | + |
| 131 | + // Release GPIO (set low) |
| 132 | + mCameraWakeupGpio->setValue(0.0); |
| 133 | + mCameraWakeupGpio->setEnabled(false); |
| 134 | + mCameraWakeupGpio.reset(); |
| 135 | + |
| 136 | + qDebug() << "Camera wake-up GPIO trigger completed"; |
| 137 | + } catch (const std::exception &e) { |
| 138 | + qWarning() << "Failed to trigger camera wake-up GPIO:" << e.what(); |
| 139 | + } |
| 140 | +} |
| 141 | + |
91 | 142 | void GPhotoCameraWorker::startCamera(const QString &cameraName) { |
| 143 | + // Trigger camera wake-up GPIO before starting camera |
| 144 | + triggerCameraWakeup(); |
| 145 | + |
92 | 146 | if (mCameraStarted) { |
93 | 147 | stopCamera(); |
94 | 148 | } |
|
0 commit comments