#include "Astra2FrameTimestampCalculator.hpp"
#include "usb/uvc/UvcTypes.hpp"
#include "frame/Frame.hpp"
namespace libobsensor {
Astra2VideoFrameTimestampCalculator::Astra2VideoFrameTimestampCalculator(IDevice *owner, uint64_t deviceTimeFreq, uint64_t frameTimeFreq)
: FrameTimestampCalculatorBaseDeviceTime(owner, deviceTimeFreq, frameTimeFreq) {}
void Astra2VideoFrameTimestampCalculator::calculate(std::shared_ptr<Frame> frame) {
auto srcTimestamp = frame->getTimeStampUsec();
auto metadata = frame->getMetadata();
auto uvcPayload = reinterpret_cast<const StandardUvcFramePayloadHeader *>(metadata);
auto timestampOffsetUs = (static_cast<int16_t>(uvcPayload->scrSourceClock[2] << 8) | uvcPayload->scrSourceClock[1]) * 100;
srcTimestamp += timestampOffsetUs;
auto rstTimestamp = FrameTimestampCalculatorBaseDeviceTime::calculate(srcTimestamp);
frame->setTimeStampUsec(rstTimestamp);
}
Astra2LVideoFrameTimestampCalculator::Astra2LVideoFrameTimestampCalculator(IDevice *owner, uint64_t deviceTimeFreq, uint64_t frameTimeFreq)
: FrameTimestampCalculatorBaseDeviceTime(owner, deviceTimeFreq, frameTimeFreq) {}
void Astra2LVideoFrameTimestampCalculator::calculate(std::shared_ptr<Frame> frame) {
auto metadata = frame->getMetadata();
auto uvcPayload = reinterpret_cast<const StandardUvcFramePayloadHeader *>(metadata);
auto srcTimestamp = *reinterpret_cast<const uint32_t *>(uvcPayload->scrSourceClock);
auto rstTimestamp = FrameTimestampCalculatorBaseDeviceTime::calculate(srcTimestamp);
frame->setTimeStampUsec(rstTimestamp);
}
}