Blend.cpp revision 274ca49c63557a8c3ee12c8da5f75e28b4875a5d
1e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen/* 2e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen * Copyright (C) 2011 The Android Open Source Project 3e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen * 4e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen * Licensed under the Apache License, Version 2.0 (the "License"); 5e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen * you may not use this file except in compliance with the License. 6e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen * You may obtain a copy of the License at 7e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen * 8e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen * http://www.apache.org/licenses/LICENSE-2.0 9e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen * 10e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen * Unless required by applicable law or agreed to in writing, software 11e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen * distributed under the License is distributed on an "AS IS" BASIS, 12e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen * WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied. 13e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen * See the License for the specific language governing permissions and 14e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen * limitations under the License. 15e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen */ 16e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen 17e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen/////////////////////////////////////////////////// 18e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen// Blend.cpp 19e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen// $Id: Blend.cpp,v 1.22 2011/06/24 04:22:14 mbansal Exp $ 20e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen 21e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen#include <string.h> 22e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen 23e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen#include "Interp.h" 24e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen#include "Blend.h" 25e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen 26e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen#include "Geometry.h" 27e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen#include "trsMatrix.h" 28e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen 29274ca49c63557a8c3ee12c8da5f75e28b4875a5dWei-Ta Chen#include "Log.h" 30274ca49c63557a8c3ee12c8da5f75e28b4875a5dWei-Ta Chen#define LOG_TAG "BLEND" 31274ca49c63557a8c3ee12c8da5f75e28b4875a5dWei-Ta Chen 32e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta ChenBlend::Blend() 33e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen{ 34e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen m_wb.blendingType = BLEND_TYPE_NONE; 35e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen} 36e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen 37e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta ChenBlend::~Blend() 38e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen{ 39e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen if (m_pFrameVPyr) free(m_pFrameVPyr); 40e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen if (m_pFrameUPyr) free(m_pFrameUPyr); 41e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen if (m_pFrameYPyr) free(m_pFrameYPyr); 42e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen} 43e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen 44e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chenint Blend::initialize(int blendingType, int frame_width, int frame_height) 45e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen{ 46e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen this->width = frame_width; 47e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen this->height = frame_height; 48e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen this->m_wb.blendingType = blendingType; 49e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen 50e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen m_wb.blendRange = m_wb.blendRangeUV = BLEND_RANGE_DEFAULT; 51e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen m_wb.nlevs = m_wb.blendRange; 52e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen m_wb.nlevsC = m_wb.blendRangeUV; 53e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen 54e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen if (m_wb.nlevs <= 0) m_wb.nlevs = 1; // Need levels for YUV processing 55e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen if (m_wb.nlevsC > m_wb.nlevs) m_wb.nlevsC = m_wb.nlevs; 56e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen 57e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen m_wb.roundoffOverlap = 1.5; 58e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen 59e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen m_pFrameYPyr = NULL; 60e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen m_pFrameUPyr = NULL; 61e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen m_pFrameVPyr = NULL; 62e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen 63e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen m_pFrameYPyr = PyramidShort::allocatePyramidPacked(m_wb.nlevs, (unsigned short) width, (unsigned short) height, BORDER); 64e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen m_pFrameUPyr = PyramidShort::allocatePyramidPacked(m_wb.nlevsC, (unsigned short) (width), (unsigned short) (height), BORDER); 65e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen m_pFrameVPyr = PyramidShort::allocatePyramidPacked(m_wb.nlevsC, (unsigned short) (width), (unsigned short) (height), BORDER); 66e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen 67e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen if (!m_pFrameYPyr || !m_pFrameUPyr || !m_pFrameVPyr) 68e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen { 69274ca49c63557a8c3ee12c8da5f75e28b4875a5dWei-Ta Chen LOGE("Error: Could not allocate pyramids for blending"); 70e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen return BLEND_RET_ERROR_MEMORY; 71e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen } 72e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen 73e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen return BLEND_RET_OK; 74e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen} 75e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen 761e762b1f935c9d4a06af6dd56121590ca81d48b1mbansalvoid Blend::AlignToMiddleFrame(MosaicFrame **frames, int frames_size) 771e762b1f935c9d4a06af6dd56121590ca81d48b1mbansal{ 781e762b1f935c9d4a06af6dd56121590ca81d48b1mbansal // Unwarp this frame and Warp the others to match 791e762b1f935c9d4a06af6dd56121590ca81d48b1mbansal MosaicFrame *mb = NULL; 801e762b1f935c9d4a06af6dd56121590ca81d48b1mbansal MosaicFrame *ref = frames[int(frames_size/2)]; // Middle frame 811e762b1f935c9d4a06af6dd56121590ca81d48b1mbansal 821e762b1f935c9d4a06af6dd56121590ca81d48b1mbansal double invtrs[3][3]; 831e762b1f935c9d4a06af6dd56121590ca81d48b1mbansal inv33d(ref->trs, invtrs); 841e762b1f935c9d4a06af6dd56121590ca81d48b1mbansal 851e762b1f935c9d4a06af6dd56121590ca81d48b1mbansal for(int mfit = 0; mfit < frames_size; mfit++) 861e762b1f935c9d4a06af6dd56121590ca81d48b1mbansal { 871e762b1f935c9d4a06af6dd56121590ca81d48b1mbansal mb = frames[mfit]; 881e762b1f935c9d4a06af6dd56121590ca81d48b1mbansal double temp[3][3]; 891e762b1f935c9d4a06af6dd56121590ca81d48b1mbansal mult33d(temp, invtrs, mb->trs); 901e762b1f935c9d4a06af6dd56121590ca81d48b1mbansal memcpy(mb->trs, temp, sizeof(temp)); 911e762b1f935c9d4a06af6dd56121590ca81d48b1mbansal normProjMat33d(mb->trs); 921e762b1f935c9d4a06af6dd56121590ca81d48b1mbansal } 931e762b1f935c9d4a06af6dd56121590ca81d48b1mbansal} 941e762b1f935c9d4a06af6dd56121590ca81d48b1mbansal 9550b3c890986aadb3780b4da8c0b8dbb0f1422ebambansalint Blend::runBlend(MosaicFrame **frames, int frames_size, 9650b3c890986aadb3780b4da8c0b8dbb0f1422ebambansal ImageType &imageMosaicYVU, int &mosaicWidth, int &mosaicHeight, 97e1178a73fd5756771d25d0b8375452450f509e99mbansal float &progress, bool &cancelComputation) 98e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen{ 99e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen int ret; 100e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen int numCenters; 101e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen 102fa45108679c51623e716acbc3301b1e4535c3267Wei-Ta Chen ComputeBlendParameters(frames, frames_size, true); 103e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen numCenters = frames_size; 104e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen 105e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen if (numCenters == 0) 106e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen { 107274ca49c63557a8c3ee12c8da5f75e28b4875a5dWei-Ta Chen LOGE("Error: No frames to blend"); 108e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen return BLEND_RET_ERROR; 109e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen } 110e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen 111e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen if (!(m_AllSites = m_Triangulator.allocMemory(numCenters))) 112e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen { 113e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen return BLEND_RET_ERROR_MEMORY; 114e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen } 115e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen 116e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen BlendRect global_rect; 117e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen 118e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen global_rect.lft = global_rect.bot = 2e30; // min values 119e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen global_rect.rgt = global_rect.top = -2e30; // max values 120e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen MosaicFrame *mb = NULL; 121e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen double halfwidth = width / 2.0; 122e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen double halfheight = height / 2.0; 123e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen 124e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen double z, x0, y0, x1, y1, x2, y2, x3, y3; 125e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen 126e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen // Determine the extents of the final mosaic 127e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen CSite *csite = m_AllSites ; 128e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen for(int mfit = 0; mfit < frames_size; mfit++) 129e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen { 130e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen mb = frames[mfit]; 131e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen 132e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen // Compute clipping for this frame's rect 133e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen FrameToMosaicRect(mb->width, mb->height, mb->trs, mb->brect); 134e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen // Clip global rect using this frame's rect 135e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen ClipRect(mb->brect, global_rect); 136e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen 137e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen // Calculate the corner points 138e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen FrameToMosaic(mb->trs, 0.0, 0.0, x0, y0); 139e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen FrameToMosaic(mb->trs, 0.0, mb->height-1.0, x1, y1); 140e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen FrameToMosaic(mb->trs, mb->width-1.0, mb->height-1.0, x2, y2); 141e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen FrameToMosaic(mb->trs, mb->width-1.0, 0.0, x3, y3); 142e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen 143e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen // Compute the centroid of the warped region 144e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen FindQuadCentroid(x0, y0, x1, y1, x2, y2, x3, y3, csite->getVCenter().x, csite->getVCenter().y); 145e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen 146e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen csite->setMb(mb); 147e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen csite++; 148e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen } 149e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen 150e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen // Get origin and sizes 151e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen MosaicRect fullRect; 152e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen 153e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen fullRect.left = (int) floor(global_rect.lft); // min-x 154e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen fullRect.top = (int) floor(global_rect.bot); // min-y 155e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen fullRect.right = (int) ceil(global_rect.rgt); // max-x 156e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen fullRect.bottom = (int) ceil(global_rect.top);// max-y 157e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen Mwidth = (unsigned short) (fullRect.right - fullRect.left + 1); 158e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen Mheight = (unsigned short) (fullRect.bottom - fullRect.top + 1); 159e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen 160e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen // Make sure image width is multiple of 4 161e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen Mwidth = (unsigned short) ((Mwidth + 3) & ~3); 162e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen Mheight = (unsigned short) ((Mheight + 3) & ~3); // Round up. 163e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen 164e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen if (Mwidth < width || Mheight < height) 165e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen { 166274ca49c63557a8c3ee12c8da5f75e28b4875a5dWei-Ta Chen LOGE("RunBlend: aborting - consistency check failed, w=%d, h=%d", Mwidth, Mheight); 167e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen return BLEND_RET_ERROR; 168e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen } 169e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen 170e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen YUVinfo *imgMos = YUVinfo::allocateImage(Mwidth, Mheight); 171e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen if (imgMos == NULL) 172e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen { 173274ca49c63557a8c3ee12c8da5f75e28b4875a5dWei-Ta Chen LOGE("RunBlend: aborting - couldn't alloc %d x %d mosaic image", Mwidth, Mheight); 174e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen return BLEND_RET_ERROR_MEMORY; 175e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen } 176e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen 177e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen // Set the Y image to 255 so we can distinguish when frame idx are written to it 178e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen memset(imgMos->Y.ptr[0], 255, (imgMos->Y.width * imgMos->Y.height)); 179e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen // Set the v and u images to black 180e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen memset(imgMos->V.ptr[0], 128, (imgMos->V.width * imgMos->V.height) << 1); 181e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen 182e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen // Do the triangulation. It returns a sorted list of edges 183e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen SEdgeVector *edge; 184e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen int n = m_Triangulator.triangulate(&edge, numCenters, width, height); 185e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen m_Triangulator.linkNeighbors(edge, n, numCenters); 186e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen 187e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen MosaicRect cropping_rect; 188e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen 189e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen // Do merging and blending : 19050b3c890986aadb3780b4da8c0b8dbb0f1422ebambansal ret = DoMergeAndBlend(frames, numCenters, width, height, *imgMos, fullRect, 191e1178a73fd5756771d25d0b8375452450f509e99mbansal cropping_rect, progress, cancelComputation); 192e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen 193e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen if (m_wb.blendingType == BLEND_TYPE_HORZ) 194e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen CropFinalMosaic(*imgMos, cropping_rect); 195e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen 196e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen 197e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen m_Triangulator.freeMemory(); // note: can be called even if delaunay_alloc() wasn't successful 198e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen 199e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen imageMosaicYVU = imgMos->Y.ptr[0]; 200e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen 201e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen 202e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen if (m_wb.blendingType == BLEND_TYPE_HORZ) 203e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen { 204e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen mosaicWidth = cropping_rect.right - cropping_rect.left + 1; 205e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen mosaicHeight = cropping_rect.bottom - cropping_rect.top + 1; 206e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen } 207e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen else 208e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen { 209e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen mosaicWidth = Mwidth; 210e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen mosaicHeight = Mheight; 211e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen } 212e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen 213e1178a73fd5756771d25d0b8375452450f509e99mbansal return ret; 214e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen} 215e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen 216e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen 217e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chenint Blend::FillFramePyramid(MosaicFrame *mb) 218e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen{ 219e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen ImageType mbY, mbU, mbV; 220e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen // Lay this image, centered into the temporary buffer 221e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen mbY = mb->image; 222e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen mbU = mb->getU(); 223e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen mbV = mb->getV(); 224e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen 225e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen int h, w; 226e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen 227e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen for(h=0; h<height; h++) 228e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen { 229e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen ImageTypeShort yptr = m_pFrameYPyr->ptr[h]; 230e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen ImageTypeShort uptr = m_pFrameUPyr->ptr[h]; 231e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen ImageTypeShort vptr = m_pFrameVPyr->ptr[h]; 232e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen 233e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen for(w=0; w<width; w++) 234e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen { 235e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen yptr[w] = (short) ((*(mbY++)) << 3); 236e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen uptr[w] = (short) ((*(mbU++)) << 3); 237e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen vptr[w] = (short) ((*(mbV++)) << 3); 238e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen } 239e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen } 240e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen 241e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen // Spread the image through the border 242e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen PyramidShort::BorderSpread(m_pFrameYPyr, BORDER, BORDER, BORDER, BORDER); 243e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen PyramidShort::BorderSpread(m_pFrameUPyr, BORDER, BORDER, BORDER, BORDER); 244e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen PyramidShort::BorderSpread(m_pFrameVPyr, BORDER, BORDER, BORDER, BORDER); 245e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen 246e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen // Generate Laplacian pyramids 247e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen if (!PyramidShort::BorderReduce(m_pFrameYPyr, m_wb.nlevs) || !PyramidShort::BorderExpand(m_pFrameYPyr, m_wb.nlevs, -1) || 248e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen !PyramidShort::BorderReduce(m_pFrameUPyr, m_wb.nlevsC) || !PyramidShort::BorderExpand(m_pFrameUPyr, m_wb.nlevsC, -1) || 249e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen !PyramidShort::BorderReduce(m_pFrameVPyr, m_wb.nlevsC) || !PyramidShort::BorderExpand(m_pFrameVPyr, m_wb.nlevsC, -1)) 250e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen { 251274ca49c63557a8c3ee12c8da5f75e28b4875a5dWei-Ta Chen LOGE("Error: Could not generate Laplacian pyramids"); 252e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen return BLEND_RET_ERROR; 253e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen } 254e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen else 255e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen { 256e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen return BLEND_RET_OK; 257e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen } 258e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen} 259e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen 260e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chenint Blend::DoMergeAndBlend(MosaicFrame **frames, int nsite, 26150b3c890986aadb3780b4da8c0b8dbb0f1422ebambansal int width, int height, YUVinfo &imgMos, MosaicRect &rect, 262e1178a73fd5756771d25d0b8375452450f509e99mbansal MosaicRect &cropping_rect, float &progress, bool &cancelComputation) 263e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen{ 264e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen m_pMosaicYPyr = NULL; 265e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen m_pMosaicUPyr = NULL; 266e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen m_pMosaicVPyr = NULL; 267e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen 268e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen m_pMosaicYPyr = PyramidShort::allocatePyramidPacked(m_wb.nlevs,(unsigned short)rect.Width(),(unsigned short)rect.Height(),BORDER); 269e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen m_pMosaicUPyr = PyramidShort::allocatePyramidPacked(m_wb.nlevsC,(unsigned short)rect.Width(),(unsigned short)rect.Height(),BORDER); 270e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen m_pMosaicVPyr = PyramidShort::allocatePyramidPacked(m_wb.nlevsC,(unsigned short)rect.Width(),(unsigned short)rect.Height(),BORDER); 271e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen if (!m_pMosaicYPyr || !m_pMosaicUPyr || !m_pMosaicVPyr) 272e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen { 273274ca49c63557a8c3ee12c8da5f75e28b4875a5dWei-Ta Chen LOGE("Error: Could not allocate pyramids for blending"); 274e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen return BLEND_RET_ERROR_MEMORY; 275e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen } 276e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen 277e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen MosaicFrame *mb; 278e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen 279e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen CSite *esite = m_AllSites + nsite; 280e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen int site_idx; 281e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen 282e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen // First go through each frame and for each mosaic pixel determine which frame it should come from 283e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen site_idx = 0; 284e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen for(CSite *csite = m_AllSites; csite < esite; csite++) 285e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen { 286e1178a73fd5756771d25d0b8375452450f509e99mbansal if(cancelComputation) 287e1178a73fd5756771d25d0b8375452450f509e99mbansal { 288e1178a73fd5756771d25d0b8375452450f509e99mbansal if (m_pMosaicVPyr) free(m_pMosaicVPyr); 289e1178a73fd5756771d25d0b8375452450f509e99mbansal if (m_pMosaicUPyr) free(m_pMosaicUPyr); 290e1178a73fd5756771d25d0b8375452450f509e99mbansal if (m_pMosaicYPyr) free(m_pMosaicYPyr); 291e1178a73fd5756771d25d0b8375452450f509e99mbansal return BLEND_RET_CANCELLED; 292e1178a73fd5756771d25d0b8375452450f509e99mbansal } 293e1178a73fd5756771d25d0b8375452450f509e99mbansal 294e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen mb = csite->getMb(); 295e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen 296e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen mb->vcrect = mb->brect; 297e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen ClipBlendRect(csite, mb->vcrect); 298e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen 299e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen ComputeMask(csite, mb->vcrect, mb->brect, rect, imgMos, site_idx); 300e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen 301e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen site_idx++; 302e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen } 303e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen 304e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen // Now perform the actual blending using the frame assignment determined above 305e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen site_idx = 0; 306e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen for(CSite *csite = m_AllSites; csite < esite; csite++) 307e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen { 308e1178a73fd5756771d25d0b8375452450f509e99mbansal if(cancelComputation) 309e1178a73fd5756771d25d0b8375452450f509e99mbansal { 310e1178a73fd5756771d25d0b8375452450f509e99mbansal if (m_pMosaicVPyr) free(m_pMosaicVPyr); 311e1178a73fd5756771d25d0b8375452450f509e99mbansal if (m_pMosaicUPyr) free(m_pMosaicUPyr); 312e1178a73fd5756771d25d0b8375452450f509e99mbansal if (m_pMosaicYPyr) free(m_pMosaicYPyr); 313e1178a73fd5756771d25d0b8375452450f509e99mbansal return BLEND_RET_CANCELLED; 314e1178a73fd5756771d25d0b8375452450f509e99mbansal } 315e1178a73fd5756771d25d0b8375452450f509e99mbansal 316e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen mb = csite->getMb(); 317e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen 318e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen 319e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen if(FillFramePyramid(mb)!=BLEND_RET_OK) 320e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen return BLEND_RET_ERROR; 321e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen 322e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen ProcessPyramidForThisFrame(csite, mb->vcrect, mb->brect, rect, imgMos, mb->trs, site_idx); 323e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen 32450b3c890986aadb3780b4da8c0b8dbb0f1422ebambansal progress += TIME_PERCENT_BLEND/nsite; 32550b3c890986aadb3780b4da8c0b8dbb0f1422ebambansal 326e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen site_idx++; 327e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen } 328e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen 329e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen 330e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen // Blend 331e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen PerformFinalBlending(imgMos, cropping_rect); 332e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen 333e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen if (m_pMosaicVPyr) free(m_pMosaicVPyr); 334e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen if (m_pMosaicUPyr) free(m_pMosaicUPyr); 335e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen if (m_pMosaicYPyr) free(m_pMosaicYPyr); 336e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen 33750b3c890986aadb3780b4da8c0b8dbb0f1422ebambansal progress += TIME_PERCENT_FINAL; 33850b3c890986aadb3780b4da8c0b8dbb0f1422ebambansal 339e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen return BLEND_RET_OK; 340e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen} 341e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen 342e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chenvoid Blend::CropFinalMosaic(YUVinfo &imgMos, MosaicRect &cropping_rect) 343e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen{ 344e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen int i, j, k; 345e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen ImageType yimg; 346e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen ImageType uimg; 347e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen ImageType vimg; 348e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen 349e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen 350e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen yimg = imgMos.Y.ptr[0]; 351e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen uimg = imgMos.U.ptr[0]; 352e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen vimg = imgMos.V.ptr[0]; 353e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen 354e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen k = 0; 355e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen for (j = cropping_rect.top; j <= cropping_rect.bottom; j++) 356e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen { 357e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen for (i = cropping_rect.left; i <= cropping_rect.right; i++) 358e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen { 359e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen yimg[k] = yimg[j*imgMos.Y.width+i]; 360e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen k++; 361e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen } 362e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen } 363e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen for (j = cropping_rect.top; j <= cropping_rect.bottom; j++) 364e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen { 365e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen for (i = cropping_rect.left; i <= cropping_rect.right; i++) 366e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen { 367e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen yimg[k] = vimg[j*imgMos.Y.width+i]; 368e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen k++; 369e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen } 370e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen } 371e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen for (j = cropping_rect.top; j <= cropping_rect.bottom; j++) 372e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen { 373e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen for (i = cropping_rect.left; i <= cropping_rect.right; i++) 374e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen { 375e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen yimg[k] = uimg[j*imgMos.Y.width+i]; 376e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen k++; 377e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen } 378e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen } 379e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen} 380e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen 381e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chenint Blend::PerformFinalBlending(YUVinfo &imgMos, MosaicRect &cropping_rect) 382e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen{ 383e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen if (!PyramidShort::BorderExpand(m_pMosaicYPyr, m_wb.nlevs, 1) || !PyramidShort::BorderExpand(m_pMosaicUPyr, m_wb.nlevsC, 1) || 384e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen !PyramidShort::BorderExpand(m_pMosaicVPyr, m_wb.nlevsC, 1)) 385e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen { 386274ca49c63557a8c3ee12c8da5f75e28b4875a5dWei-Ta Chen LOGE("Error: Could not BorderExpand!"); 387e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen return BLEND_RET_ERROR; 388e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen } 389e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen 390e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen ImageTypeShort myimg; 391e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen ImageTypeShort muimg; 392e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen ImageTypeShort mvimg; 393e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen ImageType yimg; 394e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen ImageType uimg; 395e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen ImageType vimg; 396e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen 397e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen int cx = (int)imgMos.Y.width/2; 398e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen int cy = (int)imgMos.Y.height/2; 399e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen 400e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen cropping_rect.left = 0; 401e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen cropping_rect.right = imgMos.Y.width-1; 402e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen cropping_rect.top = 0; 403e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen cropping_rect.bottom = imgMos.Y.height-1; 404e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen 405e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen // Copy the resulting image into the full image using the mask 406e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen int i, j; 407e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen 408e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen yimg = imgMos.Y.ptr[0]; 409e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen uimg = imgMos.U.ptr[0]; 410e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen vimg = imgMos.V.ptr[0]; 411e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen 412e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen for (j = 0; j < imgMos.Y.height; j++) 413e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen { 414e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen myimg = m_pMosaicYPyr->ptr[j]; 415e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen muimg = m_pMosaicUPyr->ptr[j]; 416e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen mvimg = m_pMosaicVPyr->ptr[j]; 417e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen 418e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen for (i = imgMos.Y.width; i--;) 419e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen { 420e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen // A final mask was set up previously, 421e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen // if the value is zero skip it, otherwise replace it. 422e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen if (*yimg <255) 423e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen { 424e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen short value = (short) ((*myimg) >> 3); 425e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen if (value < 0) value = 0; 426e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen else if (value > 255) value = 255; 427e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen *yimg = (unsigned char) value; 428e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen 429e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen value = (short) ((*muimg) >> 3); 430e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen if (value < 0) value = 0; 431e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen else if (value > 255) value = 255; 432e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen *uimg = (unsigned char) value; 433e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen 434e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen value = (short) ((*mvimg) >> 3); 435e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen if (value < 0) value = 0; 436e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen else if (value > 255) value = 255; 437e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen *vimg = (unsigned char) value; 438e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen 439e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen } 440e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen else 441e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen { // set border color in here 442e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen *yimg = (unsigned char) 96; 443e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen } 444e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen 445e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen yimg++; 446e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen uimg++; 447e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen vimg++; 448e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen myimg++; 449e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen muimg++; 450e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen mvimg++; 451e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen } 452e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen } 453e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen 454e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen yimg = imgMos.Y.ptr[0]; 455e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen uimg = imgMos.U.ptr[0]; 456e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen vimg = imgMos.V.ptr[0]; 457e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen 458e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen int mincol = 0; 459e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen int maxcol = imgMos.Y.width-1; 460e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen 461e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen const int MIN_X_FS = width*1/8; 462e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen const int MAX_X_FS = imgMos.Y.width - width*1/8; 463e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen 464e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen for (j = 0; j < imgMos.Y.height; j++) 465e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen { 466e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen int minx = MIN_X_FS; 467e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen int maxx = MAX_X_FS; 468e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen 469e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen for (i = 0; i < imgMos.Y.width; i++) 470e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen { 471e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen if(*yimg == 96 && *uimg == 128 && *vimg == 128) 472e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen { 473e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen } 474e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen else 475e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen { 476e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen if(i<minx) 477e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen minx = i; 478e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen if(i>maxx) 479e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen maxx = i; 480e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen } 481e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen 482e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen yimg++; 483e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen uimg++; 484e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen vimg++; 485e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen } 486e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen 487e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen // If we never touched the values, reset them to the image limits 488e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen if(minx == MIN_X_FS) 489e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen minx = 0; 490e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen if(maxx == MAX_X_FS) 491e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen maxx = imgMos.Y.width-1; 492e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen 493e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen if(minx>mincol) 494e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen mincol = minx; 495e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen if(maxx<maxcol) 496e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen maxcol = maxx; 497e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen } 498e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen 499e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen cropping_rect.left = mincol; 500e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen cropping_rect.right = maxcol; 501e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen 502e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen // Crop rows 503e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen yimg = imgMos.Y.ptr[0]; 504e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen uimg = imgMos.U.ptr[0]; 505e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen vimg = imgMos.V.ptr[0]; 506e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen 507e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen int minrow = 0; 508e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen int maxrow = imgMos.Y.height-1; 509e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen 510e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen const int MIN_Y_FS = height*1/8; 511e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen const int MAX_Y_FS = imgMos.Y.height - height*1/8; 512e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen 513e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen for (i = 0; i < imgMos.Y.width; i++) 514e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen { 515e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen int miny = MIN_Y_FS; 516e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen int maxy = MAX_Y_FS; 517e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen 518e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen for (j = 0; j < imgMos.Y.height; j++) 519e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen { 520e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen if(*yimg == 96 && *uimg == 128 && *vimg == 128) 521e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen { 522e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen } 523e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen else 524e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen { 525e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen if(j<miny) 526e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen miny = j; 527e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen if(j>maxy) 528e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen maxy = j; 529e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen } 530e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen 531e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen yimg++; 532e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen uimg++; 533e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen vimg++; 534e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen } 535e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen 536e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen // If we never touched the values, reset them to the image limits 537e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen if(miny == MIN_Y_FS) 538e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen miny = 0; 539e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen if(maxy == MAX_Y_FS) 540e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen maxy = imgMos.Y.height-1; 541e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen 542e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen if(miny>minrow) 543e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen minrow = miny; 544e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen if(maxy<maxrow) 545e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen maxrow = maxy; 546e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen } 547e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen 548e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen cropping_rect.top = minrow; 549e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen cropping_rect.bottom = maxrow; 550e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen 551e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen return BLEND_RET_OK; 552e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen} 553e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen 554e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chenvoid Blend::ComputeMask(CSite *csite, BlendRect &vcrect, BlendRect &brect, MosaicRect &rect, YUVinfo &imgMos, int site_idx) 555e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen{ 556e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen PyramidShort *dptr = m_pMosaicYPyr; 557e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen 558e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen int nC = m_wb.nlevsC; 559e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen int l = (int) ((vcrect.lft - rect.left)); 560e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen int b = (int) ((vcrect.bot - rect.top)); 561e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen int r = (int) ((vcrect.rgt - rect.left)); 562e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen int t = (int) ((vcrect.top - rect.top)); 563e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen 564e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen if (vcrect.lft == brect.lft) 565e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen l = (l <= 0) ? -BORDER : l - BORDER; 566e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen else if (l < -BORDER) 567e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen l = -BORDER; 568e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen 569e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen if (vcrect.bot == brect.bot) 570e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen b = (b <= 0) ? -BORDER : b - BORDER; 571e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen else if (b < -BORDER) 572e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen b = -BORDER; 573e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen 574e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen if (vcrect.rgt == brect.rgt) 575e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen r = (r >= dptr->width) ? dptr->width + BORDER - 1 : r + BORDER; 576e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen else if (r >= dptr->width + BORDER) 577e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen r = dptr->width + BORDER - 1; 578e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen 579e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen if (vcrect.top == brect.top) 580e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen t = (t >= dptr->height) ? dptr->height + BORDER - 1 : t + BORDER; 581e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen else if (t >= dptr->height + BORDER) 582e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen t = dptr->height + BORDER - 1; 583e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen 584e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen // Walk the Region of interest and populate the pyramid 585e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen for (int j = b; j <= t; j++) 586e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen { 587e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen int jj = j; 588e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen double sj = jj + rect.top; 589e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen 590e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen for (int i = l; i <= r; i++) 591e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen { 592e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen int ii = i; 593e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen // project point and then triangulate to neighbors 594e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen double si = ii + rect.left; 595e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen 596e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen double dself = hypotSq(csite->getVCenter().x - si, csite->getVCenter().y - sj); 597e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen int inMask = ((unsigned) ii < imgMos.Y.width && 598e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen (unsigned) jj < imgMos.Y.height) ? 1 : 0; 599e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen 600e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen if(!inMask) 601e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen continue; 602e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen 603e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen // scan the neighbors to see if this is a valid position 604e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen unsigned char mask = (unsigned char) 255; 605e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen SEdgeVector *ce; 606e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen int ecnt; 607e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen for (ce = csite->getNeighbor(), ecnt = csite->getNumNeighbors(); ecnt--; ce++) 608e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen { 609e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen double d1 = hypotSq(m_AllSites[ce->second].getVCenter().x - si, 610e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen m_AllSites[ce->second].getVCenter().y - sj); 611e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen if (d1 < dself) 612e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen { 613e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen break; 614e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen } 615e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen } 616e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen 617e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen if (ecnt >= 0) continue; 618e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen 619e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen imgMos.Y.ptr[jj][ii] = (unsigned char)site_idx; 620e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen } 621e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen } 622e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen} 623e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen 624e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chenvoid Blend::ProcessPyramidForThisFrame(CSite *csite, BlendRect &vcrect, BlendRect &brect, MosaicRect &rect, YUVinfo &imgMos, double trs[3][3], int site_idx) 625e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen{ 626e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen // Put the Region of interest (for all levels) into m_pMosaicYPyr 627e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen double inv_trs[3][3]; 628e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen inv33d(trs, inv_trs); 629e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen 630e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen // Process each pyramid level 631e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen PyramidShort *sptr = m_pFrameYPyr; 632e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen PyramidShort *suptr = m_pFrameUPyr; 633e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen PyramidShort *svptr = m_pFrameVPyr; 634e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen 635e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen PyramidShort *dptr = m_pMosaicYPyr; 636e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen PyramidShort *duptr = m_pMosaicUPyr; 637e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen PyramidShort *dvptr = m_pMosaicVPyr; 638e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen 639e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen int dscale = 0; // distance scale for the current level 640e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen int nC = m_wb.nlevsC; 641e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen for (int n = m_wb.nlevs; n--; dscale++, dptr++, sptr++, dvptr++, duptr++, svptr++, suptr++, nC--) 642e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen { 643e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen int l = (int) ((vcrect.lft - rect.left) / (1 << dscale)); 644e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen int b = (int) ((vcrect.bot - rect.top) / (1 << dscale)); 645e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen int r = (int) ((vcrect.rgt - rect.left) / (1 << dscale) + .5); 646e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen int t = (int) ((vcrect.top - rect.top) / (1 << dscale) + .5); 647e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen 648e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen if (vcrect.lft == brect.lft) 649e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen l = (l <= 0) ? -BORDER : l - BORDER; 650e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen else if (l < -BORDER) 651e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen l = -BORDER; 652e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen 653e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen if (vcrect.bot == brect.bot) 654e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen b = (b <= 0) ? -BORDER : b - BORDER; 655e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen else if (b < -BORDER) 656e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen b = -BORDER; 657e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen 658e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen if (vcrect.rgt == brect.rgt) 659e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen r = (r >= dptr->width) ? dptr->width + BORDER - 1 : r + BORDER; 660e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen else if (r >= dptr->width + BORDER) 661e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen r = dptr->width + BORDER - 1; 662e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen 663e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen if (vcrect.top == brect.top) 664e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen t = (t >= dptr->height) ? dptr->height + BORDER - 1 : t + BORDER; 665e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen else if (t >= dptr->height + BORDER) 666e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen t = dptr->height + BORDER - 1; 667e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen 668e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen // Walk the Region of interest and populate the pyramid 669e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen for (int j = b; j <= t; j++) 670e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen { 671e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen int jj = (j << dscale); 672e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen double sj = jj + rect.top; 673e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen 674e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen for (int i = l; i <= r; i++) 675e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen { 676e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen int ii = (i << dscale); 677e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen // project point and then triangulate to neighbors 678e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen double si = ii + rect.left; 679e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen 680e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen int inMask = ((unsigned) ii < imgMos.Y.width && 681e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen (unsigned) jj < imgMos.Y.height) ? 1 : 0; 682e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen 683e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen if(inMask && imgMos.Y.ptr[jj][ii]!=site_idx && imgMos.Y.ptr[jj][ii]!=255) 684e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen continue; 685e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen 686e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen // Project this mosaic point into the original frame coordinate space 687e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen double xx, yy; 688e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen 689e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen MosaicToFrame(inv_trs, si, sj, xx, yy); 690e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen 691e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen if (xx < 0.0 || yy < 0.0 || xx > width - 1.0 || yy > height - 1.0) 692e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen { 693e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen if(inMask) 694e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen { 695e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen imgMos.Y.ptr[jj][ii] = 255; 696e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen } 697e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen } 698e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen 699e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen xx /= (1 << dscale); 700e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen yy /= (1 << dscale); 701e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen 702e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen 703e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen int x1 = (xx >= 0.0) ? (int) xx : (int) floor(xx); 704e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen int y1 = (yy >= 0.0) ? (int) yy : (int) floor(yy); 705e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen 706e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen // Final destination in extended pyramid 707e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen#ifndef LINEAR_INTERP 708e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen if(inSegment(x1, sptr->width, BORDER-1) && inSegment(y1, sptr->height, BORDER-1)) 709e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen { 710e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen double xfrac = xx - x1; 711e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen double yfrac = yy - y1; 712e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen dptr->ptr[j][i] = (short) (.5 + ciCalc(sptr, x1, y1, xfrac, yfrac)); 713e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen if (dvptr >= m_pMosaicVPyr && nC > 0) 714e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen { 715e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen duptr->ptr[j][i] = (short) (.5 + ciCalc(suptr, x1, y1, xfrac, yfrac)); 716e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen dvptr->ptr[j][i] = (short) (.5 + ciCalc(svptr, x1, y1, xfrac, yfrac)); 717e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen } 718e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen } 719e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen#else 720e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen if(inSegment(x1, sptr->width, BORDER) && inSegment(y1, sptr->height, BORDER)) 721e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen { 722e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen int x2 = x1 + 1; 723e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen int y2 = y1 + 1; 724e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen double xfrac = xx - x1; 725e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen double yfrac = yy - y1; 726e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen double y1val = sptr->ptr[y1][x1] + 727e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen (sptr->ptr[y1][x2] - sptr->ptr[y1][x1]) * xfrac; 728e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen double y2val = sptr->ptr[y2][x1] + 729e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen (sptr->ptr[y2][x2] - sptr->ptr[y2][x1]) * xfrac; 730e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen dptr->ptr[j][i] = (short) (y1val + yfrac * (y2val - y1val)); 731e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen 732e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen if (dvptr >= m_pMosaicVPyr && nC > 0) 733e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen { 734e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen y1val = suptr->ptr[y1][x1] + 735e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen (suptr->ptr[y1][x2] - suptr->ptr[y1][x1]) * xfrac; 736e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen y2val = suptr->ptr[y2][x1] + 737e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen (suptr->ptr[y2][x2] - suptr->ptr[y2][x1]) * xfrac; 738e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen 739e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen duptr->ptr[j][i] = (short) (y1val + yfrac * (y2val - y1val)); 740e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen 741e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen y1val = svptr->ptr[y1][x1] + 742e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen (svptr->ptr[y1][x2] - svptr->ptr[y1][x1]) * xfrac; 743e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen y2val = svptr->ptr[y2][x1] + 744e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen (svptr->ptr[y2][x2] - svptr->ptr[y2][x1]) * xfrac; 745e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen 746e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen dvptr->ptr[j][i] = (short) (y1val + yfrac * (y2val - y1val)); 747e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen } 748e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen } 749e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen#endif 750e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen else 751e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen { 752e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen clipToSegment(x1, sptr->width, BORDER); 753e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen clipToSegment(y1, sptr->height, BORDER); 754e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen 755e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen dptr->ptr[j][i] = sptr->ptr[y1][x1]; 756e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen if (dvptr >= m_pMosaicVPyr && nC > 0) 757e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen { 758e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen dvptr->ptr[j][i] = svptr->ptr[y1][x1]; 759e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen duptr->ptr[j][i] = suptr->ptr[y1][x1]; 760e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen } 761e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen } 762e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen } 763e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen } 764e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen } 765e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen} 766e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen 767e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chenvoid Blend::MosaicToFrame(double trs[3][3], double x, double y, double &wx, double &wy) 768e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen{ 769e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen double X, Y, z; 770e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen if (m_wb.theta == 0.0) 771e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen { 772e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen X = x; 773e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen Y = y; 774e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen } 775e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen else if (m_wb.horizontal) 776e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen { 777e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen double alpha = x * m_wb.direction / m_wb.width; 778e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen double length = (y - alpha * m_wb.correction) * m_wb.direction + m_wb.radius; 779e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen double deltaTheta = m_wb.theta * alpha; 780e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen double sinTheta = sin(deltaTheta); 781e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen double cosTheta = sqrt(1.0 - sinTheta * sinTheta) * m_wb.direction; 782e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen X = length * sinTheta + m_wb.x; 783e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen Y = length * cosTheta + m_wb.y; 784e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen } 785e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen else 786e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen { 787e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen double alpha = y * m_wb.direction / m_wb.width; 788e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen double length = (x - alpha * m_wb.correction) * m_wb.direction + m_wb.radius; 789e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen double deltaTheta = m_wb.theta * alpha; 790e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen double sinTheta = sin(deltaTheta); 791e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen double cosTheta = sqrt(1.0 - sinTheta * sinTheta) * m_wb.direction; 792e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen Y = length * sinTheta + m_wb.y; 793e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen X = length * cosTheta + m_wb.x; 794e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen } 795e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen z = ProjZ(trs, X, Y, 1.0); 796e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen wx = ProjX(trs, X, Y, z, 1.0); 797e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen wy = ProjY(trs, X, Y, z, 1.0); 798e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen} 799e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen 800e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chenvoid Blend::FrameToMosaic(double trs[3][3], double x, double y, double &wx, double &wy) 801e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen{ 802e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen // Project into the intermediate Mosaic coordinate system 803e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen double z = ProjZ(trs, x, y, 1.0); 804e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen double X = ProjX(trs, x, y, z, 1.0); 805e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen double Y = ProjY(trs, x, y, z, 1.0); 806e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen 807e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen if (m_wb.theta == 0.0) 808e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen { 809e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen // No rotation, then this is all we need to do. 810e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen wx = X; 811e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen wy = Y; 812e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen } 813e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen else if (m_wb.horizontal) 814e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen { 815e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen double deltaX = X - m_wb.x; 816e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen double deltaY = Y - m_wb.y; 817e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen double length = sqrt(deltaX * deltaX + deltaY * deltaY); 818e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen double deltaTheta = asin(deltaX / length); 819e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen double alpha = deltaTheta / m_wb.theta; 820e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen wx = alpha * m_wb.width * m_wb.direction; 821e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen wy = (length - m_wb.radius) * m_wb.direction + alpha * m_wb.correction; 822e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen } 823e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen else 824e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen { 825e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen double deltaX = X - m_wb.x; 826e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen double deltaY = Y - m_wb.y; 827e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen double length = sqrt(deltaX * deltaX + deltaY * deltaY); 828e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen double deltaTheta = asin(deltaY / length); 829e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen double alpha = deltaTheta / m_wb.theta; 830e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen wy = alpha * m_wb.width * m_wb.direction; 831e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen wx = (length - m_wb.radius) * m_wb.direction + alpha * m_wb.correction; 832e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen } 833e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen} 834e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen 835e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen 836e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen 837e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen// Clip the region of interest as small as possible by using the Voronoi edges of 838e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen// the neighbors 839e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chenvoid Blend::ClipBlendRect(CSite *csite, BlendRect &brect) 840e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen{ 841e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen SEdgeVector *ce; 842e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen int ecnt; 843e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen for (ce = csite->getNeighbor(), ecnt = csite->getNumNeighbors(); ecnt--; ce++) 844e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen { 845e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen // calculate the Voronoi bisector intersection 846e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen const double epsilon = 1e-5; 847e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen double dx = (m_AllSites[ce->second].getVCenter().x - m_AllSites[ce->first].getVCenter().x); 848e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen double dy = (m_AllSites[ce->second].getVCenter().y - m_AllSites[ce->first].getVCenter().y); 849e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen double xmid = m_AllSites[ce->first].getVCenter().x + dx/2.0; 850e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen double ymid = m_AllSites[ce->first].getVCenter().y + dy/2.0; 851e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen double inter; 852e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen 853e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen if (dx > epsilon) 854e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen { 855e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen // neighbor is on right 856e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen if ((inter = m_wb.roundoffOverlap + xmid - dy * (((dy >= 0.0) ? brect.bot : brect.top) - ymid) / dx) < brect.rgt) 857e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen brect.rgt = inter; 858e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen } 859e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen else if (dx < -epsilon) 860e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen { 861e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen // neighbor is on left 862e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen if ((inter = -m_wb.roundoffOverlap + xmid - dy * (((dy >= 0.0) ? brect.bot : brect.top) - ymid) / dx) > brect.lft) 863e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen brect.lft = inter; 864e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen } 865e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen if (dy > epsilon) 866e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen { 867e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen // neighbor is above 868e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen if ((inter = m_wb.roundoffOverlap + ymid - dx * (((dx >= 0.0) ? brect.lft : brect.rgt) - xmid) / dy) < brect.top) 869e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen brect.top = inter; 870e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen } 871e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen else if (dy < -epsilon) 872e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen { 873e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen // neighbor is below 874e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen if ((inter = -m_wb.roundoffOverlap + ymid - dx * (((dx >= 0.0) ? brect.lft : brect.rgt) - xmid) / dy) > brect.bot) 875e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen brect.bot = inter; 876e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen } 877e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen } 878e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen} 879e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen 880e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chenvoid Blend::FrameToMosaicRect(int width, int height, double trs[3][3], BlendRect &brect) 881e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen{ 882e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen // We need to walk the perimeter since the borders can be bent. 883e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen brect.lft = brect.bot = 2e30; 884e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen brect.rgt = brect.top = -2e30; 885e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen double xpos, ypos; 886e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen double lasty = height - 1.0; 887e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen double lastx = width - 1.0; 888e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen int i; 889e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen 890e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen for (i = width; i--;) 891e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen { 892e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen 893e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen FrameToMosaic(trs, (double) i, 0.0, xpos, ypos); 894e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen ClipRect(xpos, ypos, brect); 895e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen FrameToMosaic(trs, (double) i, lasty, xpos, ypos); 896e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen ClipRect(xpos, ypos, brect); 897e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen } 898e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen for (i = height; i--;) 899e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen { 900e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen FrameToMosaic(trs, 0.0, (double) i, xpos, ypos); 901e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen ClipRect(xpos, ypos, brect); 902e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen FrameToMosaic(trs, lastx, (double) i, xpos, ypos); 903e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen ClipRect(xpos, ypos, brect); 904e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen } 905e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen} 906e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen 907e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen 908e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen 909e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chenvoid Blend::ComputeBlendParameters(MosaicFrame **frames, int frames_size, int is360) 910e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen{ 911e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen if (m_wb.blendingType != BLEND_TYPE_CYLPAN && m_wb.blendingType != BLEND_TYPE_HORZ) 912e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen { 913e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen m_wb.theta = 0.0; 914e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen return; 915e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen } 916e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen 917e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen MosaicFrame *first = frames[0]; 918e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen MosaicFrame *last = frames[frames_size-1]; 919e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen MosaicFrame *mb; 920e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen 9211e762b1f935c9d4a06af6dd56121590ca81d48b1mbansal double lxpos = last->trs[0][2], lypos = last->trs[1][2]; 9221e762b1f935c9d4a06af6dd56121590ca81d48b1mbansal double fxpos = first->trs[0][2], fypos = first->trs[1][2]; 923e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen 924e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen // Calculate warp to produce proper stitching. 925e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen // get x, y displacement 926e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen double midX = last->width / 2.0; 927e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen double midY = last->height / 2.0; 928e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen double z = ProjZ(first->trs, midX, midY, 1.0); 929e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen double firstX, firstY; 930e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen double prevX = firstX = ProjX(first->trs, midX, midY, z, 1.0); 931e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen double prevY = firstY = ProjY(first->trs, midX, midY, z, 1.0); 932e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen 933e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen double arcLength, lastTheta; 934e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen m_wb.theta = lastTheta = arcLength = 0.0; 935e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen for (int i = 0; i < frames_size; i++) 936e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen { 937e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen mb = frames[i]; 938e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen double currX, currY; 939e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen z = ProjZ(mb->trs, midX, midY, 1.0); 940e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen currX = ProjX(mb->trs, midX, midY, z, 1.0); 941e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen currY = ProjY(mb->trs, midX, midY, z, 1.0); 942e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen double deltaX = currX - prevX; 943e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen double deltaY = currY - prevY; 944e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen arcLength += sqrt(deltaY * deltaY + deltaX * deltaX); 945e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen if (!is360) 946e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen { 947e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen double thisTheta = asin(mb->trs[1][0]); 948e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen m_wb.theta += thisTheta - lastTheta; 949e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen lastTheta = thisTheta; 950e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen } 951e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen prevX = currX; 952e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen prevY = currY; 953e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen } 954e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen 955e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen // In case of BMP output, stretch this to end at the proper alignment 956e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen m_wb.width = arcLength; 957e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen if (is360) m_wb.theta = asin(last->trs[1][0]); 958e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen 959e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen // If there is no rotation, we're done. 960e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen if (m_wb.theta != 0.0) 961e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen { 962e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen double dx = prevX - firstX; 963e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen double dy = prevY - firstY; 964e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen if (abs(lxpos - fxpos) > abs(lypos - fypos)) 965e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen { 966e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen m_wb.horizontal = 1; 967e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen // Calculate radius position to make ends exactly the same Y offset 968e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen double radiusTheta = dx / cos(3.14159 / 2.0 - m_wb.theta); 969e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen m_wb.radius = dy + radiusTheta * cos(m_wb.theta); 970e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen if (m_wb.radius < 0.0) m_wb.radius = -m_wb.radius; 971e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen } 972e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen else 973e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen { 974e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen m_wb.horizontal = 0; 975e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen // Calculate radius position to make ends exactly the same Y offset 976e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen double radiusTheta = dy / cos(3.14159 / 2.0 - m_wb.theta); 977e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen m_wb.radius = dx + radiusTheta * cos(m_wb.theta); 978e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen if (m_wb.radius < 0.0) m_wb.radius = -m_wb.radius; 979e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen } 980e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen 981e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen // Determine major direction 982e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen if (m_wb.horizontal) 983e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen { 984e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen // Horizontal strip 985e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen if (is360) m_wb.x = firstX; 986e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen else 987e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen { 988e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen if (lxpos - fxpos < 0) 989e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen { 990e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen m_wb.x = firstX + midX; 991e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen z = ProjZ(last->trs, 0.0, midY, 1.0); 992e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen prevX = ProjX(last->trs, 0.0, midY, z, 1.0); 993e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen prevY = ProjY(last->trs, 0.0, midY, z, 1.0); 994e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen } 995e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen else 996e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen { 997e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen m_wb.x = firstX - midX; 998e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen z = ProjZ(last->trs, last->width - 1.0, midY, 1.0); 999e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen prevX = ProjX(last->trs, last->width - 1.0, midY, z, 1.0); 1000e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen prevY = ProjY(last->trs, last->width - 1.0, midY, z, 1.0); 1001e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen } 1002e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen } 1003e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen dy = prevY - firstY; 1004e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen if (dy < 0.0) m_wb.direction = 1.0; 1005e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen else m_wb.direction = -1.0; 1006e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen m_wb.y = firstY - m_wb.radius * m_wb.direction; 1007e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen if (dy * m_wb.theta > 0.0) m_wb.width = -m_wb.width; 1008e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen } 1009e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen else 1010e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen { 1011e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen // Vertical strip 1012e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen if (is360) m_wb.y = firstY; 1013e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen else 1014e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen { 1015e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen if (lypos - fypos < 0) 1016e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen { 1017e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen m_wb.x = firstY + midY; 1018e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen z = ProjZ(last->trs, midX, 0.0, 1.0); 1019e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen prevX = ProjX(last->trs, midX, 0.0, z, 1.0); 1020e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen prevY = ProjY(last->trs, midX, 0.0, z, 1.0); 1021e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen } 1022e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen else 1023e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen { 1024e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen m_wb.x = firstX - midX; 1025e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen z = ProjZ(last->trs, midX, last->height - 1.0, 1.0); 1026e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen prevX = ProjX(last->trs, midX, last->height - 1.0, z, 1.0); 1027e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen prevY = ProjY(last->trs, midX, last->height - 1.0, z, 1.0); 1028e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen } 1029e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen } 1030e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen dx = prevX - firstX; 1031e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen if (dx < 0.0) m_wb.direction = 1.0; 1032e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen else m_wb.direction = -1.0; 1033e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen m_wb.x = firstX - m_wb.radius * m_wb.direction; 1034e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen if (dx * m_wb.theta > 0.0) m_wb.width = -m_wb.width; 1035e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen } 1036e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen 1037e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen // Calculate the correct correction factor 1038e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen double deltaX = prevX - m_wb.x; 1039e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen double deltaY = prevY - m_wb.y; 1040e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen double length = sqrt(deltaX * deltaX + deltaY * deltaY); 1041e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen double deltaTheta = (m_wb.horizontal) ? deltaX : deltaY; 1042e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen deltaTheta = asin(deltaTheta / length); 1043e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen m_wb.correction = ((m_wb.radius - length) * m_wb.direction) / 1044e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen (deltaTheta / m_wb.theta); 1045e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen } 1046e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen} 1047