|  | /* | 
|  | * Copyright 2018, The Android Open Source Project | 
|  | * | 
|  | * Licensed under the Apache License, Version 2.0 (the "License"); | 
|  | * you may not use this file except in compliance with the License. | 
|  | * You may obtain a copy of the License at | 
|  | * | 
|  | *     http://www.apache.org/licenses/LICENSE-2.0 | 
|  | * | 
|  | * Unless required by applicable law or agreed to in writing, software | 
|  | * distributed under the License is distributed on an "AS IS" BASIS, | 
|  | * WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied. | 
|  | * See the License for the specific language governing permissions and | 
|  | * limitations under the License. | 
|  | */ | 
|  |  | 
|  | //#define LOG_NDEBUG 0 | 
|  | #define LOG_TAG "Codec2BufferUtils" | 
|  | #define ATRACE_TAG  ATRACE_TAG_VIDEO | 
|  | #include <utils/Log.h> | 
|  | #include <utils/Trace.h> | 
|  |  | 
|  | #include <libyuv.h> | 
|  |  | 
|  | #include <list> | 
|  | #include <mutex> | 
|  |  | 
|  | #include <android/hardware_buffer.h> | 
|  | #include <media/hardware/HardwareAPI.h> | 
|  | #include <media/stagefright/foundation/AUtils.h> | 
|  |  | 
|  | #include <C2Debug.h> | 
|  |  | 
|  | #include "Codec2BufferUtils.h" | 
|  |  | 
|  | namespace android { | 
|  |  | 
|  | namespace { | 
|  |  | 
|  | /** | 
|  | * A flippable, optimizable memcpy. Constructs such as (from ? src : dst) | 
|  | * do not work as the results are always const. | 
|  | */ | 
|  | template<bool ToA, size_t S> | 
|  | struct MemCopier { | 
|  | template<typename A, typename B> | 
|  | inline static void copy(A *a, const B *b, size_t size) { | 
|  | __builtin_memcpy(a, b, size); | 
|  | } | 
|  | }; | 
|  |  | 
|  | template<size_t S> | 
|  | struct MemCopier<false, S> { | 
|  | template<typename A, typename B> | 
|  | inline static void copy(const A *a, B *b, size_t size) { | 
|  | MemCopier<true, S>::copy(b, a, size); | 
|  | } | 
|  | }; | 
|  |  | 
|  | /** | 
|  | * Copies between a MediaImage and a graphic view. | 
|  | * | 
|  | * \param ToMediaImage whether to copy to (or from) the MediaImage | 
|  | * \param view graphic view (could be ConstGraphicView or GraphicView depending on direction) | 
|  | * \param img MediaImage data | 
|  | * \param imgBase base of MediaImage (could be const uint8_t* or uint8_t* depending on direction) | 
|  | */ | 
|  | template<bool ToMediaImage, typename View, typename ImagePixel> | 
|  | static status_t _ImageCopy(View &view, const MediaImage2 *img, ImagePixel *imgBase) { | 
|  | // TODO: more efficient copying --- e.g. copy interleaved planes together, etc. | 
|  | const C2PlanarLayout &layout = view.layout(); | 
|  | const size_t bpp = divUp(img->mBitDepthAllocated, 8u); | 
|  |  | 
|  | for (uint32_t i = 0; i < layout.numPlanes; ++i) { | 
|  | typename std::conditional<ToMediaImage, uint8_t, const uint8_t>::type *imgRow = | 
|  | imgBase + img->mPlane[i].mOffset; | 
|  | typename std::conditional<ToMediaImage, const uint8_t, uint8_t>::type *viewRow = | 
|  | viewRow = view.data()[i]; | 
|  | const C2PlaneInfo &plane = layout.planes[i]; | 
|  | if (plane.colSampling != img->mPlane[i].mHorizSubsampling | 
|  | || plane.rowSampling != img->mPlane[i].mVertSubsampling | 
|  | || plane.allocatedDepth != img->mBitDepthAllocated | 
|  | || plane.allocatedDepth < plane.bitDepth | 
|  | // MediaImage only supports MSB values | 
|  | || plane.rightShift != plane.allocatedDepth - plane.bitDepth | 
|  | || (bpp > 1 && plane.endianness != plane.NATIVE)) { | 
|  | return BAD_VALUE; | 
|  | } | 
|  |  | 
|  | uint32_t planeW = img->mWidth / plane.colSampling; | 
|  | uint32_t planeH = img->mHeight / plane.rowSampling; | 
|  |  | 
|  | bool canCopyByRow = (plane.colInc == bpp) && (img->mPlane[i].mColInc == bpp); | 
|  | bool canCopyByPlane = canCopyByRow && (plane.rowInc == img->mPlane[i].mRowInc); | 
|  | if (canCopyByPlane) { | 
|  | MemCopier<ToMediaImage, 0>::copy(imgRow, viewRow, plane.rowInc * planeH); | 
|  | } else if (canCopyByRow) { | 
|  | for (uint32_t row = 0; row < planeH; ++row) { | 
|  | MemCopier<ToMediaImage, 0>::copy( | 
|  | imgRow, viewRow, std::min(plane.rowInc, img->mPlane[i].mRowInc)); | 
|  | imgRow += img->mPlane[i].mRowInc; | 
|  | viewRow += plane.rowInc; | 
|  | } | 
|  | } else { | 
|  | for (uint32_t row = 0; row < planeH; ++row) { | 
|  | decltype(imgRow) imgPtr = imgRow; | 
|  | decltype(viewRow) viewPtr = viewRow; | 
|  | for (uint32_t col = 0; col < planeW; ++col) { | 
|  | MemCopier<ToMediaImage, 0>::copy(imgPtr, viewPtr, bpp); | 
|  | imgPtr += img->mPlane[i].mColInc; | 
|  | viewPtr += plane.colInc; | 
|  | } | 
|  | imgRow += img->mPlane[i].mRowInc; | 
|  | viewRow += plane.rowInc; | 
|  | } | 
|  | } | 
|  | } | 
|  | return OK; | 
|  | } | 
|  |  | 
|  | }  // namespace | 
|  |  | 
|  | status_t ImageCopy(uint8_t *imgBase, const MediaImage2 *img, const C2GraphicView &view) { | 
|  | if (img == nullptr | 
|  | || imgBase == nullptr | 
|  | || view.crop().width != img->mWidth | 
|  | || view.crop().height != img->mHeight) { | 
|  | return BAD_VALUE; | 
|  | } | 
|  | const uint8_t* src_y = view.data()[0]; | 
|  | const uint8_t* src_u = view.data()[1]; | 
|  | const uint8_t* src_v = view.data()[2]; | 
|  | int32_t src_stride_y = view.layout().planes[0].rowInc; | 
|  | int32_t src_stride_u = view.layout().planes[1].rowInc; | 
|  | int32_t src_stride_v = view.layout().planes[2].rowInc; | 
|  | uint8_t* dst_y = imgBase + img->mPlane[0].mOffset; | 
|  | uint8_t* dst_u = imgBase + img->mPlane[1].mOffset; | 
|  | uint8_t* dst_v = imgBase + img->mPlane[2].mOffset; | 
|  | int32_t dst_stride_y = img->mPlane[0].mRowInc; | 
|  | int32_t dst_stride_u = img->mPlane[1].mRowInc; | 
|  | int32_t dst_stride_v = img->mPlane[2].mRowInc; | 
|  | int width = view.crop().width; | 
|  | int height = view.crop().height; | 
|  |  | 
|  | if (IsNV12(view)) { | 
|  | if (IsNV12(img)) { | 
|  | ScopedTrace trace(ATRACE_TAG, "ImageCopy: NV12->NV12"); | 
|  | libyuv::CopyPlane(src_y, src_stride_y, dst_y, dst_stride_y, width, height); | 
|  | libyuv::CopyPlane(src_u, src_stride_u, dst_u, dst_stride_u, width, height / 2); | 
|  | return OK; | 
|  | } else if (IsNV21(img)) { | 
|  | ScopedTrace trace(ATRACE_TAG, "ImageCopy: NV12->NV21"); | 
|  | if (!libyuv::NV21ToNV12(src_y, src_stride_y, src_u, src_stride_u, | 
|  | dst_y, dst_stride_y, dst_v, dst_stride_v, width, height)) { | 
|  | return OK; | 
|  | } | 
|  | } else if (IsI420(img)) { | 
|  | ScopedTrace trace(ATRACE_TAG, "ImageCopy: NV12->I420"); | 
|  | if (!libyuv::NV12ToI420(src_y, src_stride_y, src_u, src_stride_u, dst_y, dst_stride_y, | 
|  | dst_u, dst_stride_u, dst_v, dst_stride_v, width, height)) { | 
|  | return OK; | 
|  | } | 
|  | } | 
|  | } else if (IsNV21(view)) { | 
|  | if (IsNV12(img)) { | 
|  | ScopedTrace trace(ATRACE_TAG, "ImageCopy: NV21->NV12"); | 
|  | if (!libyuv::NV21ToNV12(src_y, src_stride_y, src_v, src_stride_v, | 
|  | dst_y, dst_stride_y, dst_u, dst_stride_u, width, height)) { | 
|  | return OK; | 
|  | } | 
|  | } else if (IsNV21(img)) { | 
|  | ScopedTrace trace(ATRACE_TAG, "ImageCopy: NV21->NV21"); | 
|  | libyuv::CopyPlane(src_y, src_stride_y, dst_y, dst_stride_y, width, height); | 
|  | libyuv::CopyPlane(src_v, src_stride_v, dst_v, dst_stride_v, width, height / 2); | 
|  | return OK; | 
|  | } else if (IsI420(img)) { | 
|  | ScopedTrace trace(ATRACE_TAG, "ImageCopy: NV21->I420"); | 
|  | if (!libyuv::NV21ToI420(src_y, src_stride_y, src_v, src_stride_v, dst_y, dst_stride_y, | 
|  | dst_u, dst_stride_u, dst_v, dst_stride_v, width, height)) { | 
|  | return OK; | 
|  | } | 
|  | } | 
|  | } else if (IsI420(view)) { | 
|  | if (IsNV12(img)) { | 
|  | ScopedTrace trace(ATRACE_TAG, "ImageCopy: I420->NV12"); | 
|  | if (!libyuv::I420ToNV12(src_y, src_stride_y, src_u, src_stride_u, src_v, src_stride_v, | 
|  | dst_y, dst_stride_y, dst_u, dst_stride_u, width, height)) { | 
|  | return OK; | 
|  | } | 
|  | } else if (IsNV21(img)) { | 
|  | ScopedTrace trace(ATRACE_TAG, "ImageCopy: I420->NV21"); | 
|  | if (!libyuv::I420ToNV21(src_y, src_stride_y, src_u, src_stride_u, src_v, src_stride_v, | 
|  | dst_y, dst_stride_y, dst_v, dst_stride_v, width, height)) { | 
|  | return OK; | 
|  | } | 
|  | } else if (IsI420(img)) { | 
|  | ScopedTrace trace(ATRACE_TAG, "ImageCopy: I420->I420"); | 
|  | libyuv::CopyPlane(src_y, src_stride_y, dst_y, dst_stride_y, width, height); | 
|  | libyuv::CopyPlane(src_u, src_stride_u, dst_u, dst_stride_u, width / 2, height / 2); | 
|  | libyuv::CopyPlane(src_v, src_stride_v, dst_v, dst_stride_v, width / 2, height / 2); | 
|  | return OK; | 
|  | } | 
|  | } | 
|  | ScopedTrace trace(ATRACE_TAG, "ImageCopy: generic"); | 
|  | return _ImageCopy<true>(view, img, imgBase); | 
|  | } | 
|  |  | 
|  | status_t ImageCopy(C2GraphicView &view, const uint8_t *imgBase, const MediaImage2 *img) { | 
|  | if (img == nullptr | 
|  | || imgBase == nullptr | 
|  | || view.crop().width != img->mWidth | 
|  | || view.crop().height != img->mHeight) { | 
|  | return BAD_VALUE; | 
|  | } | 
|  | const uint8_t* src_y = imgBase + img->mPlane[0].mOffset; | 
|  | const uint8_t* src_u = imgBase + img->mPlane[1].mOffset; | 
|  | const uint8_t* src_v = imgBase + img->mPlane[2].mOffset; | 
|  | int32_t src_stride_y = img->mPlane[0].mRowInc; | 
|  | int32_t src_stride_u = img->mPlane[1].mRowInc; | 
|  | int32_t src_stride_v = img->mPlane[2].mRowInc; | 
|  | uint8_t* dst_y = view.data()[0]; | 
|  | uint8_t* dst_u = view.data()[1]; | 
|  | uint8_t* dst_v = view.data()[2]; | 
|  | int32_t dst_stride_y = view.layout().planes[0].rowInc; | 
|  | int32_t dst_stride_u = view.layout().planes[1].rowInc; | 
|  | int32_t dst_stride_v = view.layout().planes[2].rowInc; | 
|  | int width = view.crop().width; | 
|  | int height = view.crop().height; | 
|  | if (IsNV12(img)) { | 
|  | if (IsNV12(view)) { | 
|  | ScopedTrace trace(ATRACE_TAG, "ImageCopy: NV12->NV12"); | 
|  | libyuv::CopyPlane(src_y, src_stride_y, dst_y, dst_stride_y, width, height); | 
|  | libyuv::CopyPlane(src_u, src_stride_u, dst_u, dst_stride_u, width, height / 2); | 
|  | return OK; | 
|  | } else if (IsNV21(view)) { | 
|  | ScopedTrace trace(ATRACE_TAG, "ImageCopy: NV12->NV21"); | 
|  | if (!libyuv::NV21ToNV12(src_y, src_stride_y, src_u, src_stride_u, | 
|  | dst_y, dst_stride_y, dst_v, dst_stride_v, width, height)) { | 
|  | return OK; | 
|  | } | 
|  | } else if (IsI420(view)) { | 
|  | ScopedTrace trace(ATRACE_TAG, "ImageCopy: NV12->I420"); | 
|  | if (!libyuv::NV12ToI420(src_y, src_stride_y, src_u, src_stride_u, dst_y, dst_stride_y, | 
|  | dst_u, dst_stride_u, dst_v, dst_stride_v, width, height)) { | 
|  | return OK; | 
|  | } | 
|  | } | 
|  | } else if (IsNV21(img)) { | 
|  | if (IsNV12(view)) { | 
|  | ScopedTrace trace(ATRACE_TAG, "ImageCopy: NV21->NV12"); | 
|  | if (!libyuv::NV21ToNV12(src_y, src_stride_y, src_v, src_stride_v, | 
|  | dst_y, dst_stride_y, dst_u, dst_stride_u, width, height)) { | 
|  | return OK; | 
|  | } | 
|  | } else if (IsNV21(view)) { | 
|  | ScopedTrace trace(ATRACE_TAG, "ImageCopy: NV21->NV21"); | 
|  | libyuv::CopyPlane(src_y, src_stride_y, dst_y, dst_stride_y, width, height); | 
|  | libyuv::CopyPlane(src_v, src_stride_v, dst_v, dst_stride_v, width, height / 2); | 
|  | return OK; | 
|  | } else if (IsI420(view)) { | 
|  | ScopedTrace trace(ATRACE_TAG, "ImageCopy: NV21->I420"); | 
|  | if (!libyuv::NV21ToI420(src_y, src_stride_y, src_v, src_stride_v, dst_y, dst_stride_y, | 
|  | dst_u, dst_stride_u, dst_v, dst_stride_v, width, height)) { | 
|  | return OK; | 
|  | } | 
|  | } | 
|  | } else if (IsI420(img)) { | 
|  | if (IsNV12(view)) { | 
|  | ScopedTrace trace(ATRACE_TAG, "ImageCopy: I420->NV12"); | 
|  | if (!libyuv::I420ToNV12(src_y, src_stride_y, src_u, src_stride_u, src_v, src_stride_v, | 
|  | dst_y, dst_stride_y, dst_u, dst_stride_u, width, height)) { | 
|  | return OK; | 
|  | } | 
|  | } else if (IsNV21(view)) { | 
|  | ScopedTrace trace(ATRACE_TAG, "ImageCopy: I420->NV21"); | 
|  | if (!libyuv::I420ToNV21(src_y, src_stride_y, src_u, src_stride_u, src_v, src_stride_v, | 
|  | dst_y, dst_stride_y, dst_v, dst_stride_v, width, height)) { | 
|  | return OK; | 
|  | } | 
|  | } else if (IsI420(view)) { | 
|  | ScopedTrace trace(ATRACE_TAG, "ImageCopy: I420->I420"); | 
|  | libyuv::CopyPlane(src_y, src_stride_y, dst_y, dst_stride_y, width, height); | 
|  | libyuv::CopyPlane(src_u, src_stride_u, dst_u, dst_stride_u, width / 2, height / 2); | 
|  | libyuv::CopyPlane(src_v, src_stride_v, dst_v, dst_stride_v, width / 2, height / 2); | 
|  | return OK; | 
|  | } | 
|  | } | 
|  | ScopedTrace trace(ATRACE_TAG, "ImageCopy: generic"); | 
|  | return _ImageCopy<false>(view, img, imgBase); | 
|  | } | 
|  |  | 
|  | bool IsYUV420(const C2GraphicView &view) { | 
|  | const C2PlanarLayout &layout = view.layout(); | 
|  | return (layout.numPlanes == 3 | 
|  | && layout.type == C2PlanarLayout::TYPE_YUV | 
|  | && layout.planes[layout.PLANE_Y].channel == C2PlaneInfo::CHANNEL_Y | 
|  | && layout.planes[layout.PLANE_Y].allocatedDepth == 8 | 
|  | && layout.planes[layout.PLANE_Y].bitDepth == 8 | 
|  | && layout.planes[layout.PLANE_Y].rightShift == 0 | 
|  | && layout.planes[layout.PLANE_Y].colSampling == 1 | 
|  | && layout.planes[layout.PLANE_Y].rowSampling == 1 | 
|  | && layout.planes[layout.PLANE_U].channel == C2PlaneInfo::CHANNEL_CB | 
|  | && layout.planes[layout.PLANE_U].allocatedDepth == 8 | 
|  | && layout.planes[layout.PLANE_U].bitDepth == 8 | 
|  | && layout.planes[layout.PLANE_U].rightShift == 0 | 
|  | && layout.planes[layout.PLANE_U].colSampling == 2 | 
|  | && layout.planes[layout.PLANE_U].rowSampling == 2 | 
|  | && layout.planes[layout.PLANE_V].channel == C2PlaneInfo::CHANNEL_CR | 
|  | && layout.planes[layout.PLANE_V].allocatedDepth == 8 | 
|  | && layout.planes[layout.PLANE_V].bitDepth == 8 | 
|  | && layout.planes[layout.PLANE_V].rightShift == 0 | 
|  | && layout.planes[layout.PLANE_V].colSampling == 2 | 
|  | && layout.planes[layout.PLANE_V].rowSampling == 2); | 
|  | } | 
|  |  | 
|  | bool IsYUV420_10bit(const C2GraphicView &view) { | 
|  | const C2PlanarLayout &layout = view.layout(); | 
|  | return (layout.numPlanes == 3 | 
|  | && layout.type == C2PlanarLayout::TYPE_YUV | 
|  | && layout.planes[layout.PLANE_Y].channel == C2PlaneInfo::CHANNEL_Y | 
|  | && layout.planes[layout.PLANE_Y].allocatedDepth == 16 | 
|  | && layout.planes[layout.PLANE_Y].bitDepth == 10 | 
|  | && layout.planes[layout.PLANE_Y].colSampling == 1 | 
|  | && layout.planes[layout.PLANE_Y].rowSampling == 1 | 
|  | && layout.planes[layout.PLANE_U].channel == C2PlaneInfo::CHANNEL_CB | 
|  | && layout.planes[layout.PLANE_U].allocatedDepth == 16 | 
|  | && layout.planes[layout.PLANE_U].bitDepth == 10 | 
|  | && layout.planes[layout.PLANE_U].colSampling == 2 | 
|  | && layout.planes[layout.PLANE_U].rowSampling == 2 | 
|  | && layout.planes[layout.PLANE_V].channel == C2PlaneInfo::CHANNEL_CR | 
|  | && layout.planes[layout.PLANE_V].allocatedDepth == 16 | 
|  | && layout.planes[layout.PLANE_V].bitDepth == 10 | 
|  | && layout.planes[layout.PLANE_V].colSampling == 2 | 
|  | && layout.planes[layout.PLANE_V].rowSampling == 2); | 
|  | } | 
|  |  | 
|  |  | 
|  | bool IsNV12(const C2GraphicView &view) { | 
|  | if (!IsYUV420(view)) { | 
|  | return false; | 
|  | } | 
|  | const C2PlanarLayout &layout = view.layout(); | 
|  | return (layout.rootPlanes == 2 | 
|  | && layout.planes[layout.PLANE_U].colInc == 2 | 
|  | && layout.planes[layout.PLANE_U].rootIx == layout.PLANE_U | 
|  | && layout.planes[layout.PLANE_U].offset == 0 | 
|  | && layout.planes[layout.PLANE_V].colInc == 2 | 
|  | && layout.planes[layout.PLANE_V].rootIx == layout.PLANE_U | 
|  | && layout.planes[layout.PLANE_V].offset == 1); | 
|  | } | 
|  |  | 
|  | bool IsP010(const C2GraphicView &view) { | 
|  | if (!IsYUV420_10bit(view)) { | 
|  | return false; | 
|  | } | 
|  | const C2PlanarLayout &layout = view.layout(); | 
|  | return (layout.rootPlanes == 2 | 
|  | && layout.planes[layout.PLANE_U].colInc == 4 | 
|  | && layout.planes[layout.PLANE_U].rootIx == layout.PLANE_U | 
|  | && layout.planes[layout.PLANE_U].offset == 0 | 
|  | && layout.planes[layout.PLANE_V].colInc == 4 | 
|  | && layout.planes[layout.PLANE_V].rootIx == layout.PLANE_U | 
|  | && layout.planes[layout.PLANE_V].offset == 2 | 
|  | && layout.planes[layout.PLANE_Y].rightShift == 6 | 
|  | && layout.planes[layout.PLANE_U].rightShift == 6 | 
|  | && layout.planes[layout.PLANE_V].rightShift == 6); | 
|  | } | 
|  |  | 
|  |  | 
|  | bool IsNV21(const C2GraphicView &view) { | 
|  | if (!IsYUV420(view)) { | 
|  | return false; | 
|  | } | 
|  | const C2PlanarLayout &layout = view.layout(); | 
|  | return (layout.rootPlanes == 2 | 
|  | && layout.planes[layout.PLANE_U].colInc == 2 | 
|  | && layout.planes[layout.PLANE_U].rootIx == layout.PLANE_V | 
|  | && layout.planes[layout.PLANE_U].offset == 1 | 
|  | && layout.planes[layout.PLANE_V].colInc == 2 | 
|  | && layout.planes[layout.PLANE_V].rootIx == layout.PLANE_V | 
|  | && layout.planes[layout.PLANE_V].offset == 0); | 
|  | } | 
|  |  | 
|  | bool IsI420(const C2GraphicView &view) { | 
|  | if (!IsYUV420(view)) { | 
|  | return false; | 
|  | } | 
|  | const C2PlanarLayout &layout = view.layout(); | 
|  | return (layout.rootPlanes == 3 | 
|  | && layout.planes[layout.PLANE_U].colInc == 1 | 
|  | && layout.planes[layout.PLANE_U].rootIx == layout.PLANE_U | 
|  | && layout.planes[layout.PLANE_U].offset == 0 | 
|  | && layout.planes[layout.PLANE_V].colInc == 1 | 
|  | && layout.planes[layout.PLANE_V].rootIx == layout.PLANE_V | 
|  | && layout.planes[layout.PLANE_V].offset == 0); | 
|  | } | 
|  |  | 
|  | bool IsYUV420(const MediaImage2 *img) { | 
|  | return (img->mType == MediaImage2::MEDIA_IMAGE_TYPE_YUV | 
|  | && img->mNumPlanes == 3 | 
|  | && img->mBitDepth == 8 | 
|  | && img->mBitDepthAllocated == 8 | 
|  | && img->mPlane[0].mHorizSubsampling == 1 | 
|  | && img->mPlane[0].mVertSubsampling == 1 | 
|  | && img->mPlane[1].mHorizSubsampling == 2 | 
|  | && img->mPlane[1].mVertSubsampling == 2 | 
|  | && img->mPlane[2].mHorizSubsampling == 2 | 
|  | && img->mPlane[2].mVertSubsampling == 2); | 
|  | } | 
|  |  | 
|  | bool IsNV12(const MediaImage2 *img) { | 
|  | if (!IsYUV420(img)) { | 
|  | return false; | 
|  | } | 
|  | return (img->mPlane[1].mColInc == 2 | 
|  | && img->mPlane[2].mColInc == 2 | 
|  | && (img->mPlane[2].mOffset == img->mPlane[1].mOffset + 1)); | 
|  | } | 
|  |  | 
|  | bool IsNV21(const MediaImage2 *img) { | 
|  | if (!IsYUV420(img)) { | 
|  | return false; | 
|  | } | 
|  | return (img->mPlane[1].mColInc == 2 | 
|  | && img->mPlane[2].mColInc == 2 | 
|  | && (img->mPlane[1].mOffset == img->mPlane[2].mOffset + 1)); | 
|  | } | 
|  |  | 
|  | bool IsI420(const MediaImage2 *img) { | 
|  | if (!IsYUV420(img)) { | 
|  | return false; | 
|  | } | 
|  | return (img->mPlane[1].mColInc == 1 | 
|  | && img->mPlane[2].mColInc == 1 | 
|  | && img->mPlane[2].mOffset > img->mPlane[1].mOffset); | 
|  | } | 
|  |  | 
|  | FlexLayout GetYuv420FlexibleLayout() { | 
|  | static FlexLayout sLayout = []{ | 
|  | AHardwareBuffer_Desc desc = { | 
|  | 16,  // width | 
|  | 16,  // height | 
|  | 1,   // layers | 
|  | AHARDWAREBUFFER_FORMAT_Y8Cb8Cr8_420, | 
|  | AHARDWAREBUFFER_USAGE_CPU_READ_OFTEN | AHARDWAREBUFFER_USAGE_CPU_WRITE_OFTEN, | 
|  | 0,   // stride | 
|  | 0,   // rfu0 | 
|  | 0,   // rfu1 | 
|  | }; | 
|  | AHardwareBuffer *buffer = nullptr; | 
|  | int ret = AHardwareBuffer_allocate(&desc, &buffer); | 
|  | if (ret != 0) { | 
|  | return FLEX_LAYOUT_UNKNOWN; | 
|  | } | 
|  | class AutoCloser { | 
|  | public: | 
|  | AutoCloser(AHardwareBuffer *buffer) : mBuffer(buffer), mLocked(false) {} | 
|  | ~AutoCloser() { | 
|  | if (mLocked) { | 
|  | AHardwareBuffer_unlock(mBuffer, nullptr); | 
|  | } | 
|  | AHardwareBuffer_release(mBuffer); | 
|  | } | 
|  |  | 
|  | void setLocked() { mLocked = true; } | 
|  |  | 
|  | private: | 
|  | AHardwareBuffer *mBuffer; | 
|  | bool mLocked; | 
|  | } autoCloser(buffer); | 
|  | AHardwareBuffer_Planes planes; | 
|  | ret = AHardwareBuffer_lockPlanes( | 
|  | buffer, | 
|  | AHARDWAREBUFFER_USAGE_CPU_READ_OFTEN | AHARDWAREBUFFER_USAGE_CPU_WRITE_OFTEN, | 
|  | -1,       // fence | 
|  | nullptr,  // rect | 
|  | &planes); | 
|  | if (ret != 0) { | 
|  | AHardwareBuffer_release(buffer); | 
|  | return FLEX_LAYOUT_UNKNOWN; | 
|  | } | 
|  | autoCloser.setLocked(); | 
|  | if (planes.planeCount != 3) { | 
|  | return FLEX_LAYOUT_UNKNOWN; | 
|  | } | 
|  | if (planes.planes[0].pixelStride != 1) { | 
|  | return FLEX_LAYOUT_UNKNOWN; | 
|  | } | 
|  | if (planes.planes[1].pixelStride == 1 && planes.planes[2].pixelStride == 1) { | 
|  | return FLEX_LAYOUT_PLANAR; | 
|  | } | 
|  | if (planes.planes[1].pixelStride == 2 && planes.planes[2].pixelStride == 2) { | 
|  | ssize_t uvDist = | 
|  | static_cast<uint8_t *>(planes.planes[2].data) - | 
|  | static_cast<uint8_t *>(planes.planes[1].data); | 
|  | if (uvDist == 1) { | 
|  | return FLEX_LAYOUT_SEMIPLANAR_UV; | 
|  | } else if (uvDist == -1) { | 
|  | return FLEX_LAYOUT_SEMIPLANAR_VU; | 
|  | } | 
|  | return FLEX_LAYOUT_UNKNOWN; | 
|  | } | 
|  | return FLEX_LAYOUT_UNKNOWN; | 
|  | }(); | 
|  | return sLayout; | 
|  | } | 
|  |  | 
|  | MediaImage2 CreateYUV420PlanarMediaImage2( | 
|  | uint32_t width, uint32_t height, uint32_t stride, uint32_t vstride) { | 
|  | return MediaImage2 { | 
|  | .mType = MediaImage2::MEDIA_IMAGE_TYPE_YUV, | 
|  | .mNumPlanes = 3, | 
|  | .mWidth = width, | 
|  | .mHeight = height, | 
|  | .mBitDepth = 8, | 
|  | .mBitDepthAllocated = 8, | 
|  | .mPlane = { | 
|  | { | 
|  | .mOffset = 0, | 
|  | .mColInc = 1, | 
|  | .mRowInc = (int32_t)stride, | 
|  | .mHorizSubsampling = 1, | 
|  | .mVertSubsampling = 1, | 
|  | }, | 
|  | { | 
|  | .mOffset = stride * vstride, | 
|  | .mColInc = 1, | 
|  | .mRowInc = (int32_t)stride / 2, | 
|  | .mHorizSubsampling = 2, | 
|  | .mVertSubsampling = 2, | 
|  | }, | 
|  | { | 
|  | .mOffset = stride * vstride * 5 / 4, | 
|  | .mColInc = 1, | 
|  | .mRowInc = (int32_t)stride / 2, | 
|  | .mHorizSubsampling = 2, | 
|  | .mVertSubsampling = 2, | 
|  | } | 
|  | }, | 
|  | }; | 
|  | } | 
|  |  | 
|  | MediaImage2 CreateYUV420SemiPlanarMediaImage2( | 
|  | uint32_t width, uint32_t height, uint32_t stride, uint32_t vstride) { | 
|  | return MediaImage2 { | 
|  | .mType = MediaImage2::MEDIA_IMAGE_TYPE_YUV, | 
|  | .mNumPlanes = 3, | 
|  | .mWidth = width, | 
|  | .mHeight = height, | 
|  | .mBitDepth = 8, | 
|  | .mBitDepthAllocated = 8, | 
|  | .mPlane = { | 
|  | { | 
|  | .mOffset = 0, | 
|  | .mColInc = 1, | 
|  | .mRowInc = (int32_t)stride, | 
|  | .mHorizSubsampling = 1, | 
|  | .mVertSubsampling = 1, | 
|  | }, | 
|  | { | 
|  | .mOffset = stride * vstride, | 
|  | .mColInc = 2, | 
|  | .mRowInc = (int32_t)stride, | 
|  | .mHorizSubsampling = 2, | 
|  | .mVertSubsampling = 2, | 
|  | }, | 
|  | { | 
|  | .mOffset = stride * vstride + 1, | 
|  | .mColInc = 2, | 
|  | .mRowInc = (int32_t)stride, | 
|  | .mHorizSubsampling = 2, | 
|  | .mVertSubsampling = 2, | 
|  | } | 
|  | }, | 
|  | }; | 
|  | } | 
|  |  | 
|  | // Matrix coefficient to convert RGB to Planar YUV data. | 
|  | // Each sub-array represents the 3X3 coeff used with R, G and B | 
|  | static const int16_t bt601Matrix[2][3][3] = { | 
|  | { { 77, 150, 29 }, { -43, -85, 128 }, { 128, -107, -21 } }, /* RANGE_FULL */ | 
|  | { { 66, 129, 25 }, { -38, -74, 112 }, { 112, -94, -18 } },  /* RANGE_LIMITED */ | 
|  | }; | 
|  |  | 
|  | static const int16_t bt709Matrix[2][3][3] = { | 
|  | // TRICKY: 18 is adjusted to 19 so that sum of row 1 is 256 | 
|  | { { 54, 183, 19 }, { -29, -99, 128 }, { 128, -116, -12 } }, /* RANGE_FULL */ | 
|  | // TRICKY: -87 is adjusted to -86 so that sum of row 2 is 0 | 
|  | { { 47, 157, 16 }, { -26, -86, 112 }, { 112, -102, -10 } }, /* RANGE_LIMITED */ | 
|  | }; | 
|  |  | 
|  | status_t ConvertRGBToPlanarYUV( | 
|  | uint8_t *dstY, size_t dstStride, size_t dstVStride, size_t bufferSize, | 
|  | const C2GraphicView &src, C2Color::matrix_t colorMatrix, C2Color::range_t colorRange) { | 
|  | CHECK(dstY != nullptr); | 
|  | CHECK((src.width() & 1) == 0); | 
|  | CHECK((src.height() & 1) == 0); | 
|  |  | 
|  | if (dstStride * dstVStride * 3 / 2 > bufferSize) { | 
|  | ALOGD("conversion buffer is too small for converting from RGB to YUV"); | 
|  | return NO_MEMORY; | 
|  | } | 
|  |  | 
|  | uint8_t *dstU = dstY + dstStride * dstVStride; | 
|  | uint8_t *dstV = dstU + (dstStride >> 1) * (dstVStride >> 1); | 
|  |  | 
|  | const C2PlanarLayout &layout = src.layout(); | 
|  | const uint8_t *pRed   = src.data()[C2PlanarLayout::PLANE_R]; | 
|  | const uint8_t *pGreen = src.data()[C2PlanarLayout::PLANE_G]; | 
|  | const uint8_t *pBlue  = src.data()[C2PlanarLayout::PLANE_B]; | 
|  |  | 
|  | // set default range as limited | 
|  | if (colorRange != C2Color::RANGE_FULL && colorRange != C2Color::RANGE_LIMITED) { | 
|  | colorRange = C2Color::RANGE_LIMITED; | 
|  | } | 
|  | const int16_t (*weights)[3] = | 
|  | (colorMatrix == C2Color::MATRIX_BT709) ? | 
|  | bt709Matrix[colorRange - 1] : bt601Matrix[colorRange - 1]; | 
|  | uint8_t zeroLvl =  colorRange == C2Color::RANGE_FULL ? 0 : 16; | 
|  | uint8_t maxLvlLuma =  colorRange == C2Color::RANGE_FULL ? 255 : 235; | 
|  | uint8_t maxLvlChroma =  colorRange == C2Color::RANGE_FULL ? 255 : 240; | 
|  |  | 
|  | #define CLIP3(min,v,max) (((v) < (min)) ? (min) : (((max) > (v)) ? (v) : (max))) | 
|  | for (size_t y = 0; y < src.height(); ++y) { | 
|  | for (size_t x = 0; x < src.width(); ++x) { | 
|  | uint8_t r = *pRed; | 
|  | uint8_t g = *pGreen; | 
|  | uint8_t b = *pBlue; | 
|  |  | 
|  | unsigned luma = ((r * weights[0][0] + g * weights[0][1] + b * weights[0][2]) >> 8) + | 
|  | zeroLvl; | 
|  |  | 
|  | dstY[x] = CLIP3(zeroLvl, luma, maxLvlLuma); | 
|  |  | 
|  | if ((x & 1) == 0 && (y & 1) == 0) { | 
|  | unsigned U = ((r * weights[1][0] + g * weights[1][1] + b * weights[1][2]) >> 8) + | 
|  | 128; | 
|  |  | 
|  | unsigned V = ((r * weights[2][0] + g * weights[2][1] + b * weights[2][2]) >> 8) + | 
|  | 128; | 
|  |  | 
|  | dstU[x >> 1] = CLIP3(zeroLvl, U, maxLvlChroma); | 
|  | dstV[x >> 1] = CLIP3(zeroLvl, V, maxLvlChroma); | 
|  | } | 
|  | pRed   += layout.planes[C2PlanarLayout::PLANE_R].colInc; | 
|  | pGreen += layout.planes[C2PlanarLayout::PLANE_G].colInc; | 
|  | pBlue  += layout.planes[C2PlanarLayout::PLANE_B].colInc; | 
|  | } | 
|  |  | 
|  | if ((y & 1) == 0) { | 
|  | dstU += dstStride >> 1; | 
|  | dstV += dstStride >> 1; | 
|  | } | 
|  |  | 
|  | pRed   -= layout.planes[C2PlanarLayout::PLANE_R].colInc * src.width(); | 
|  | pGreen -= layout.planes[C2PlanarLayout::PLANE_G].colInc * src.width(); | 
|  | pBlue  -= layout.planes[C2PlanarLayout::PLANE_B].colInc * src.width(); | 
|  | pRed   += layout.planes[C2PlanarLayout::PLANE_R].rowInc; | 
|  | pGreen += layout.planes[C2PlanarLayout::PLANE_G].rowInc; | 
|  | pBlue  += layout.planes[C2PlanarLayout::PLANE_B].rowInc; | 
|  |  | 
|  | dstY += dstStride; | 
|  | } | 
|  | return OK; | 
|  | } | 
|  |  | 
|  | namespace { | 
|  |  | 
|  | /** | 
|  | * A block of raw allocated memory. | 
|  | */ | 
|  | struct MemoryBlockPoolBlock { | 
|  | MemoryBlockPoolBlock(size_t size) | 
|  | : mData(new uint8_t[size]), mSize(mData ? size : 0) { } | 
|  |  | 
|  | ~MemoryBlockPoolBlock() { | 
|  | delete[] mData; | 
|  | } | 
|  |  | 
|  | const uint8_t *data() const { | 
|  | return mData; | 
|  | } | 
|  |  | 
|  | size_t size() const { | 
|  | return mSize; | 
|  | } | 
|  |  | 
|  | C2_DO_NOT_COPY(MemoryBlockPoolBlock); | 
|  |  | 
|  | private: | 
|  | uint8_t *mData; | 
|  | size_t mSize; | 
|  | }; | 
|  |  | 
|  | /** | 
|  | * A simple raw memory block pool implementation. | 
|  | */ | 
|  | struct MemoryBlockPoolImpl { | 
|  | void release(std::list<MemoryBlockPoolBlock>::const_iterator block) { | 
|  | std::lock_guard<std::mutex> lock(mMutex); | 
|  | // return block to free blocks if it is the current size; otherwise, discard | 
|  | if (block->size() == mCurrentSize) { | 
|  | mFreeBlocks.splice(mFreeBlocks.begin(), mBlocksInUse, block); | 
|  | } else { | 
|  | mBlocksInUse.erase(block); | 
|  | } | 
|  | } | 
|  |  | 
|  | std::list<MemoryBlockPoolBlock>::const_iterator fetch(size_t size) { | 
|  | std::lock_guard<std::mutex> lock(mMutex); | 
|  | mFreeBlocks.remove_if([size](const MemoryBlockPoolBlock &block) -> bool { | 
|  | return block.size() != size; | 
|  | }); | 
|  | mCurrentSize = size; | 
|  | if (mFreeBlocks.empty()) { | 
|  | mBlocksInUse.emplace_front(size); | 
|  | } else { | 
|  | mBlocksInUse.splice(mBlocksInUse.begin(), mFreeBlocks, mFreeBlocks.begin()); | 
|  | } | 
|  | return mBlocksInUse.begin(); | 
|  | } | 
|  |  | 
|  | MemoryBlockPoolImpl() = default; | 
|  |  | 
|  | C2_DO_NOT_COPY(MemoryBlockPoolImpl); | 
|  |  | 
|  | private: | 
|  | std::mutex mMutex; | 
|  | std::list<MemoryBlockPoolBlock> mFreeBlocks; | 
|  | std::list<MemoryBlockPoolBlock> mBlocksInUse; | 
|  | size_t mCurrentSize; | 
|  | }; | 
|  |  | 
|  | } // namespace | 
|  |  | 
|  | struct MemoryBlockPool::Impl : MemoryBlockPoolImpl { | 
|  | }; | 
|  |  | 
|  | struct MemoryBlock::Impl { | 
|  | Impl(std::list<MemoryBlockPoolBlock>::const_iterator block, | 
|  | std::shared_ptr<MemoryBlockPoolImpl> pool) | 
|  | : mBlock(block), mPool(pool) { | 
|  | } | 
|  |  | 
|  | ~Impl() { | 
|  | mPool->release(mBlock); | 
|  | } | 
|  |  | 
|  | const uint8_t *data() const { | 
|  | return mBlock->data(); | 
|  | } | 
|  |  | 
|  | size_t size() const { | 
|  | return mBlock->size(); | 
|  | } | 
|  |  | 
|  | private: | 
|  | std::list<MemoryBlockPoolBlock>::const_iterator mBlock; | 
|  | std::shared_ptr<MemoryBlockPoolImpl> mPool; | 
|  | }; | 
|  |  | 
|  | MemoryBlock MemoryBlockPool::fetch(size_t size) { | 
|  | std::list<MemoryBlockPoolBlock>::const_iterator poolBlock = mImpl->fetch(size); | 
|  | return MemoryBlock(std::make_shared<MemoryBlock::Impl>( | 
|  | poolBlock, std::static_pointer_cast<MemoryBlockPoolImpl>(mImpl))); | 
|  | } | 
|  |  | 
|  | MemoryBlockPool::MemoryBlockPool() | 
|  | : mImpl(std::make_shared<MemoryBlockPool::Impl>()) { | 
|  | } | 
|  |  | 
|  | MemoryBlock::MemoryBlock(std::shared_ptr<MemoryBlock::Impl> impl) | 
|  | : mImpl(impl) { | 
|  | } | 
|  |  | 
|  | MemoryBlock::MemoryBlock() = default; | 
|  |  | 
|  | MemoryBlock::~MemoryBlock() = default; | 
|  |  | 
|  | const uint8_t* MemoryBlock::data() const { | 
|  | return mImpl ? mImpl->data() : nullptr; | 
|  | } | 
|  |  | 
|  | size_t MemoryBlock::size() const { | 
|  | return mImpl ? mImpl->size() : 0; | 
|  | } | 
|  |  | 
|  | MemoryBlock MemoryBlock::Allocate(size_t size) { | 
|  | return MemoryBlockPool().fetch(size); | 
|  | } | 
|  |  | 
|  | }  // namespace android |