diff options
author | Laurent Pinchart <laurent.pinchart@ideasonboard.com> | 2022-10-20 00:44:55 +0300 |
---|---|---|
committer | Laurent Pinchart <laurent.pinchart@ideasonboard.com> | 2022-10-20 13:36:25 +0300 |
commit | 84ad104499d9efc0253dae1a60ee070ed375ad95 (patch) | |
tree | d10fd53eb79cebb28fa3f72b18b46dddb6382b83 /src/cam/kms_sink.cpp | |
parent | daf3f4b59f4ea0ecb42c6a39fe909f071d3a2842 (diff) |
Move test applications to src/apps/
The cam and qcam test application share code, currently through a crude
hack that references the cam source files directly from the qcam
meson.build file. To prepare for the introduction of hosting that code
in a static library, move all applications to src/apps/.
Signed-off-by: Laurent Pinchart <laurent.pinchart@ideasonboard.com>
Reviewed-by: Paul Elder <paul.elder@ideasonboard.com>
Reviewed-by: Kieran Bingham <kieran.bingham@ideasonboard.com>
Diffstat (limited to 'src/cam/kms_sink.cpp')
-rw-r--r-- | src/cam/kms_sink.cpp | 538 |
1 files changed, 0 insertions, 538 deletions
diff --git a/src/cam/kms_sink.cpp b/src/cam/kms_sink.cpp deleted file mode 100644 index 754b061e..00000000 --- a/src/cam/kms_sink.cpp +++ /dev/null @@ -1,538 +0,0 @@ -/* SPDX-License-Identifier: GPL-2.0-or-later */ -/* - * Copyright (C) 2021, Ideas on Board Oy - * - * kms_sink.cpp - KMS Sink - */ - -#include "kms_sink.h" - -#include <array> -#include <algorithm> -#include <assert.h> -#include <iostream> -#include <limits.h> -#include <memory> -#include <stdint.h> -#include <string.h> - -#include <libcamera/camera.h> -#include <libcamera/formats.h> -#include <libcamera/framebuffer.h> -#include <libcamera/stream.h> - -#include "drm.h" - -KMSSink::KMSSink(const std::string &connectorName) - : connector_(nullptr), crtc_(nullptr), plane_(nullptr), mode_(nullptr) -{ - int ret = dev_.init(); - if (ret < 0) - return; - - /* - * Find the requested connector. If no specific connector is requested, - * pick the first connected connector or, if no connector is connected, - * the first connector with unknown status. - */ - for (const DRM::Connector &conn : dev_.connectors()) { - if (!connectorName.empty()) { - if (conn.name() != connectorName) - continue; - - connector_ = &conn; - break; - } - - if (conn.status() == DRM::Connector::Connected) { - connector_ = &conn; - break; - } - - if (!connector_ && conn.status() == DRM::Connector::Unknown) - connector_ = &conn; - } - - if (!connector_) { - if (!connectorName.empty()) - std::cerr - << "Connector " << connectorName << " not found" - << std::endl; - else - std::cerr << "No connected connector found" << std::endl; - return; - } - - dev_.requestComplete.connect(this, &KMSSink::requestComplete); -} - -void KMSSink::mapBuffer(libcamera::FrameBuffer *buffer) -{ - std::array<uint32_t, 4> strides = {}; - - /* \todo Should libcamera report per-plane strides ? */ - unsigned int uvStrideMultiplier; - - switch (format_) { - case libcamera::formats::NV24: - case libcamera::formats::NV42: - uvStrideMultiplier = 4; - break; - case libcamera::formats::YUV420: - case libcamera::formats::YVU420: - case libcamera::formats::YUV422: - uvStrideMultiplier = 1; - break; - default: - uvStrideMultiplier = 2; - break; - } - - strides[0] = stride_; - for (unsigned int i = 1; i < buffer->planes().size(); ++i) - strides[i] = stride_ * uvStrideMultiplier / 2; - - std::unique_ptr<DRM::FrameBuffer> drmBuffer = - dev_.createFrameBuffer(*buffer, format_, size_, strides); - if (!drmBuffer) - return; - - buffers_.emplace(std::piecewise_construct, - std::forward_as_tuple(buffer), - std::forward_as_tuple(std::move(drmBuffer))); -} - -int KMSSink::configure(const libcamera::CameraConfiguration &config) -{ - if (!connector_) - return -EINVAL; - - crtc_ = nullptr; - plane_ = nullptr; - mode_ = nullptr; - - const libcamera::StreamConfiguration &cfg = config.at(0); - - /* Find the best mode for the stream size. */ - const std::vector<DRM::Mode> &modes = connector_->modes(); - - unsigned int cfgArea = cfg.size.width * cfg.size.height; - unsigned int bestDistance = UINT_MAX; - - for (const DRM::Mode &mode : modes) { - unsigned int modeArea = mode.hdisplay * mode.vdisplay; - unsigned int distance = modeArea > cfgArea ? modeArea - cfgArea - : cfgArea - modeArea; - - if (distance < bestDistance) { - mode_ = &mode; - bestDistance = distance; - - /* - * If the sizes match exactly, there will be no better - * match. - */ - if (distance == 0) - break; - } - } - - if (!mode_) { - std::cerr << "No modes\n"; - return -EINVAL; - } - - int ret = configurePipeline(cfg.pixelFormat); - if (ret < 0) - return ret; - - size_ = cfg.size; - stride_ = cfg.stride; - - /* Configure color space. */ - colorEncoding_ = std::nullopt; - colorRange_ = std::nullopt; - - if (cfg.colorSpace->ycbcrEncoding == libcamera::ColorSpace::YcbcrEncoding::None) - return 0; - - /* - * The encoding and range enums are defined in the kernel but not - * exposed in public headers. - */ - enum drm_color_encoding { - DRM_COLOR_YCBCR_BT601, - DRM_COLOR_YCBCR_BT709, - DRM_COLOR_YCBCR_BT2020, - }; - - enum drm_color_range { - DRM_COLOR_YCBCR_LIMITED_RANGE, - DRM_COLOR_YCBCR_FULL_RANGE, - }; - - const DRM::Property *colorEncoding = plane_->property("COLOR_ENCODING"); - const DRM::Property *colorRange = plane_->property("COLOR_RANGE"); - - if (colorEncoding) { - drm_color_encoding encoding; - - switch (cfg.colorSpace->ycbcrEncoding) { - case libcamera::ColorSpace::YcbcrEncoding::Rec601: - default: - encoding = DRM_COLOR_YCBCR_BT601; - break; - case libcamera::ColorSpace::YcbcrEncoding::Rec709: - encoding = DRM_COLOR_YCBCR_BT709; - break; - case libcamera::ColorSpace::YcbcrEncoding::Rec2020: - encoding = DRM_COLOR_YCBCR_BT2020; - break; - } - - for (const auto &[id, name] : colorEncoding->enums()) { - if (id == encoding) { - colorEncoding_ = encoding; - break; - } - } - } - - if (colorRange) { - drm_color_range range; - - switch (cfg.colorSpace->range) { - case libcamera::ColorSpace::Range::Limited: - default: - range = DRM_COLOR_YCBCR_LIMITED_RANGE; - break; - case libcamera::ColorSpace::Range::Full: - range = DRM_COLOR_YCBCR_FULL_RANGE; - break; - } - - for (const auto &[id, name] : colorRange->enums()) { - if (id == range) { - colorRange_ = range; - break; - } - } - } - - if (!colorEncoding_ || !colorRange_) - std::cerr << "Color space " << cfg.colorSpace->toString() - << " not supported by the display device." - << " Colors may be wrong." << std::endl; - - return 0; -} - -int KMSSink::selectPipeline(const libcamera::PixelFormat &format) -{ - /* - * If the requested format has an alpha channel, also consider the X - * variant. - */ - libcamera::PixelFormat xFormat; - - switch (format) { - case libcamera::formats::ABGR8888: - xFormat = libcamera::formats::XBGR8888; - break; - case libcamera::formats::ARGB8888: - xFormat = libcamera::formats::XRGB8888; - break; - case libcamera::formats::BGRA8888: - xFormat = libcamera::formats::BGRX8888; - break; - case libcamera::formats::RGBA8888: - xFormat = libcamera::formats::RGBX8888; - break; - } - - /* - * Find a CRTC and plane suitable for the request format and the - * connector at the end of the pipeline. Restrict the search to primary - * planes for now. - */ - for (const DRM::Encoder *encoder : connector_->encoders()) { - for (const DRM::Crtc *crtc : encoder->possibleCrtcs()) { - for (const DRM::Plane *plane : crtc->planes()) { - if (plane->type() != DRM::Plane::TypePrimary) - continue; - - if (plane->supportsFormat(format)) { - crtc_ = crtc; - plane_ = plane; - format_ = format; - return 0; - } - - if (plane->supportsFormat(xFormat)) { - crtc_ = crtc; - plane_ = plane; - format_ = xFormat; - return 0; - } - } - } - } - - return -EPIPE; -} - -int KMSSink::configurePipeline(const libcamera::PixelFormat &format) -{ - const int ret = selectPipeline(format); - if (ret) { - std::cerr - << "Unable to find display pipeline for format " - << format << std::endl; - - return ret; - } - - std::cout - << "Using KMS plane " << plane_->id() << ", CRTC " << crtc_->id() - << ", connector " << connector_->name() - << " (" << connector_->id() << "), mode " << mode_->hdisplay - << "x" << mode_->vdisplay << "@" << mode_->vrefresh << std::endl; - - return 0; -} - -int KMSSink::start() -{ - std::unique_ptr<DRM::AtomicRequest> request; - - int ret = FrameSink::start(); - if (ret < 0) - return ret; - - /* Disable all CRTCs and planes to start from a known valid state. */ - request = std::make_unique<DRM::AtomicRequest>(&dev_); - - for (const DRM::Crtc &crtc : dev_.crtcs()) - request->addProperty(&crtc, "ACTIVE", 0); - - for (const DRM::Plane &plane : dev_.planes()) { - request->addProperty(&plane, "CRTC_ID", 0); - request->addProperty(&plane, "FB_ID", 0); - } - - ret = request->commit(DRM::AtomicRequest::FlagAllowModeset); - if (ret < 0) { - std::cerr - << "Failed to disable CRTCs and planes: " - << strerror(-ret) << std::endl; - return ret; - } - - return 0; -} - -int KMSSink::stop() -{ - /* Display pipeline. */ - DRM::AtomicRequest request(&dev_); - - request.addProperty(connector_, "CRTC_ID", 0); - request.addProperty(crtc_, "ACTIVE", 0); - request.addProperty(crtc_, "MODE_ID", 0); - request.addProperty(plane_, "CRTC_ID", 0); - request.addProperty(plane_, "FB_ID", 0); - - int ret = request.commit(DRM::AtomicRequest::FlagAllowModeset); - if (ret < 0) { - std::cerr - << "Failed to stop display pipeline: " - << strerror(-ret) << std::endl; - return ret; - } - - /* Free all buffers. */ - pending_.reset(); - queued_.reset(); - active_.reset(); - buffers_.clear(); - - return FrameSink::stop(); -} - -bool KMSSink::testModeSet(DRM::FrameBuffer *drmBuffer, - const libcamera::Rectangle &src, - const libcamera::Rectangle &dst) -{ - DRM::AtomicRequest drmRequest{ &dev_ }; - - drmRequest.addProperty(connector_, "CRTC_ID", crtc_->id()); - - drmRequest.addProperty(crtc_, "ACTIVE", 1); - drmRequest.addProperty(crtc_, "MODE_ID", mode_->toBlob(&dev_)); - - drmRequest.addProperty(plane_, "CRTC_ID", crtc_->id()); - drmRequest.addProperty(plane_, "FB_ID", drmBuffer->id()); - drmRequest.addProperty(plane_, "SRC_X", src.x << 16); - drmRequest.addProperty(plane_, "SRC_Y", src.y << 16); - drmRequest.addProperty(plane_, "SRC_W", src.width << 16); - drmRequest.addProperty(plane_, "SRC_H", src.height << 16); - drmRequest.addProperty(plane_, "CRTC_X", dst.x); - drmRequest.addProperty(plane_, "CRTC_Y", dst.y); - drmRequest.addProperty(plane_, "CRTC_W", dst.width); - drmRequest.addProperty(plane_, "CRTC_H", dst.height); - - return !drmRequest.commit(DRM::AtomicRequest::FlagAllowModeset | - DRM::AtomicRequest::FlagTestOnly); -} - -bool KMSSink::setupComposition(DRM::FrameBuffer *drmBuffer) -{ - /* - * Test composition options, from most to least desirable, to select the - * best one. - */ - const libcamera::Rectangle framebuffer{ size_ }; - const libcamera::Rectangle display{ 0, 0, mode_->hdisplay, mode_->vdisplay }; - - /* 1. Scale the frame buffer to full screen, preserving aspect ratio. */ - libcamera::Rectangle src = framebuffer; - libcamera::Rectangle dst = display.size().boundedToAspectRatio(framebuffer.size()) - .centeredTo(display.center()); - - if (testModeSet(drmBuffer, src, dst)) { - std::cout << "KMS: full-screen scaled output, square pixels" - << std::endl; - src_ = src; - dst_ = dst; - return true; - } - - /* - * 2. Scale the frame buffer to full screen, without preserving aspect - * ratio. - */ - src = framebuffer; - dst = display; - - if (testModeSet(drmBuffer, src, dst)) { - std::cout << "KMS: full-screen scaled output, non-square pixels" - << std::endl; - src_ = src; - dst_ = dst; - return true; - } - - /* 3. Center the frame buffer on the display. */ - src = display.size().centeredTo(framebuffer.center()).boundedTo(framebuffer); - dst = framebuffer.size().centeredTo(display.center()).boundedTo(display); - - if (testModeSet(drmBuffer, src, dst)) { - std::cout << "KMS: centered output" << std::endl; - src_ = src; - dst_ = dst; - return true; - } - - /* 4. Align the frame buffer on the top-left of the display. */ - src = framebuffer.boundedTo(display); - dst = display.boundedTo(framebuffer); - - if (testModeSet(drmBuffer, src, dst)) { - std::cout << "KMS: top-left aligned output" << std::endl; - src_ = src; - dst_ = dst; - return true; - } - - return false; -} - -bool KMSSink::processRequest(libcamera::Request *camRequest) -{ - /* - * Perform a very crude rate adaptation by simply dropping the request - * if the display queue is full. - */ - if (pending_) - return true; - - libcamera::FrameBuffer *buffer = camRequest->buffers().begin()->second; - auto iter = buffers_.find(buffer); - if (iter == buffers_.end()) - return true; - - DRM::FrameBuffer *drmBuffer = iter->second.get(); - - unsigned int flags = DRM::AtomicRequest::FlagAsync; - std::unique_ptr<DRM::AtomicRequest> drmRequest = - std::make_unique<DRM::AtomicRequest>(&dev_); - drmRequest->addProperty(plane_, "FB_ID", drmBuffer->id()); - - if (!active_ && !queued_) { - /* Enable the display pipeline on the first frame. */ - if (!setupComposition(drmBuffer)) { - std::cerr << "Failed to setup composition" << std::endl; - return true; - } - - drmRequest->addProperty(connector_, "CRTC_ID", crtc_->id()); - - drmRequest->addProperty(crtc_, "ACTIVE", 1); - drmRequest->addProperty(crtc_, "MODE_ID", mode_->toBlob(&dev_)); - - drmRequest->addProperty(plane_, "CRTC_ID", crtc_->id()); - drmRequest->addProperty(plane_, "SRC_X", src_.x << 16); - drmRequest->addProperty(plane_, "SRC_Y", src_.y << 16); - drmRequest->addProperty(plane_, "SRC_W", src_.width << 16); - drmRequest->addProperty(plane_, "SRC_H", src_.height << 16); - drmRequest->addProperty(plane_, "CRTC_X", dst_.x); - drmRequest->addProperty(plane_, "CRTC_Y", dst_.y); - drmRequest->addProperty(plane_, "CRTC_W", dst_.width); - drmRequest->addProperty(plane_, "CRTC_H", dst_.height); - - if (colorEncoding_) - drmRequest->addProperty(plane_, "COLOR_ENCODING", *colorEncoding_); - if (colorRange_) - drmRequest->addProperty(plane_, "COLOR_RANGE", *colorRange_); - - flags |= DRM::AtomicRequest::FlagAllowModeset; - } - - pending_ = std::make_unique<Request>(std::move(drmRequest), camRequest); - - std::lock_guard<std::mutex> lock(lock_); - - if (!queued_) { - int ret = pending_->drmRequest_->commit(flags); - if (ret < 0) { - std::cerr - << "Failed to commit atomic request: " - << strerror(-ret) << std::endl; - /* \todo Implement error handling */ - } - - queued_ = std::move(pending_); - } - - return false; -} - -void KMSSink::requestComplete(DRM::AtomicRequest *request) -{ - std::lock_guard<std::mutex> lock(lock_); - - assert(queued_ && queued_->drmRequest_.get() == request); - - /* Complete the active request, if any. */ - if (active_) - requestProcessed.emit(active_->camRequest_); - - /* The queued request becomes active. */ - active_ = std::move(queued_); - - /* Queue the pending request, if any. */ - if (pending_) { - pending_->drmRequest_->commit(DRM::AtomicRequest::FlagAsync); - queued_ = std::move(pending_); - } -} |