Blend.cpp revision b28b9c0fa991bc97e8aa11da83d27f71fdfef6da
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 44b28b9c0fa991bc97e8aa11da83d27f71fdfef6dambansalint Blend::initialize(int blendingType, int stripType, 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; 49b28b9c0fa991bc97e8aa11da83d27f71fdfef6dambansal this->m_wb.stripType = stripType; 50e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen 51e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen m_wb.blendRange = m_wb.blendRangeUV = BLEND_RANGE_DEFAULT; 52e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen m_wb.nlevs = m_wb.blendRange; 53e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen m_wb.nlevsC = m_wb.blendRangeUV; 54e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen 55e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen if (m_wb.nlevs <= 0) m_wb.nlevs = 1; // Need levels for YUV processing 56e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen if (m_wb.nlevsC > m_wb.nlevs) m_wb.nlevsC = m_wb.nlevs; 57e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen 58e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen m_wb.roundoffOverlap = 1.5; 59e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen 60e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen m_pFrameYPyr = NULL; 61e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen m_pFrameUPyr = NULL; 62e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen m_pFrameVPyr = NULL; 63e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen 64e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen m_pFrameYPyr = PyramidShort::allocatePyramidPacked(m_wb.nlevs, (unsigned short) width, (unsigned short) height, BORDER); 65e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen m_pFrameUPyr = PyramidShort::allocatePyramidPacked(m_wb.nlevsC, (unsigned short) (width), (unsigned short) (height), BORDER); 66e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen m_pFrameVPyr = PyramidShort::allocatePyramidPacked(m_wb.nlevsC, (unsigned short) (width), (unsigned short) (height), BORDER); 67e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen 68e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen if (!m_pFrameYPyr || !m_pFrameUPyr || !m_pFrameVPyr) 69e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen { 70274ca49c63557a8c3ee12c8da5f75e28b4875a5dWei-Ta Chen LOGE("Error: Could not allocate pyramids for blending"); 71e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen return BLEND_RET_ERROR_MEMORY; 72e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen } 73e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen 74e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen return BLEND_RET_OK; 75e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen} 76e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen 776c5b20113ba9f91352f32e5a53df66aec0ec761ambansalinline double max(double a, double b) { return a > b ? a : b; } 786c5b20113ba9f91352f32e5a53df66aec0ec761ambansalinline double min(double a, double b) { return a < b ? a : b; } 796c5b20113ba9f91352f32e5a53df66aec0ec761ambansal 801e762b1f935c9d4a06af6dd56121590ca81d48b1mbansalvoid Blend::AlignToMiddleFrame(MosaicFrame **frames, int frames_size) 811e762b1f935c9d4a06af6dd56121590ca81d48b1mbansal{ 821e762b1f935c9d4a06af6dd56121590ca81d48b1mbansal // Unwarp this frame and Warp the others to match 831e762b1f935c9d4a06af6dd56121590ca81d48b1mbansal MosaicFrame *mb = NULL; 841e762b1f935c9d4a06af6dd56121590ca81d48b1mbansal MosaicFrame *ref = frames[int(frames_size/2)]; // Middle frame 851e762b1f935c9d4a06af6dd56121590ca81d48b1mbansal 861e762b1f935c9d4a06af6dd56121590ca81d48b1mbansal double invtrs[3][3]; 871e762b1f935c9d4a06af6dd56121590ca81d48b1mbansal inv33d(ref->trs, invtrs); 881e762b1f935c9d4a06af6dd56121590ca81d48b1mbansal 891e762b1f935c9d4a06af6dd56121590ca81d48b1mbansal for(int mfit = 0; mfit < frames_size; mfit++) 901e762b1f935c9d4a06af6dd56121590ca81d48b1mbansal { 911e762b1f935c9d4a06af6dd56121590ca81d48b1mbansal mb = frames[mfit]; 921e762b1f935c9d4a06af6dd56121590ca81d48b1mbansal double temp[3][3]; 931e762b1f935c9d4a06af6dd56121590ca81d48b1mbansal mult33d(temp, invtrs, mb->trs); 941e762b1f935c9d4a06af6dd56121590ca81d48b1mbansal memcpy(mb->trs, temp, sizeof(temp)); 951e762b1f935c9d4a06af6dd56121590ca81d48b1mbansal normProjMat33d(mb->trs); 961e762b1f935c9d4a06af6dd56121590ca81d48b1mbansal } 971e762b1f935c9d4a06af6dd56121590ca81d48b1mbansal} 981e762b1f935c9d4a06af6dd56121590ca81d48b1mbansal 99b28b9c0fa991bc97e8aa11da83d27f71fdfef6dambansalint Blend::runBlend(MosaicFrame **oframes, MosaicFrame **rframes, 100b28b9c0fa991bc97e8aa11da83d27f71fdfef6dambansal int frames_size, 10150b3c890986aadb3780b4da8c0b8dbb0f1422ebambansal ImageType &imageMosaicYVU, int &mosaicWidth, int &mosaicHeight, 102e1178a73fd5756771d25d0b8375452450f509e99mbansal float &progress, bool &cancelComputation) 103e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen{ 104e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen int ret; 105e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen int numCenters; 106e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen 107b28b9c0fa991bc97e8aa11da83d27f71fdfef6dambansal MosaicFrame **frames; 108b28b9c0fa991bc97e8aa11da83d27f71fdfef6dambansal 109b28b9c0fa991bc97e8aa11da83d27f71fdfef6dambansal // For THIN strip mode, accept all frames for blending 110b28b9c0fa991bc97e8aa11da83d27f71fdfef6dambansal if (m_wb.stripType == STRIP_TYPE_THIN) 111b28b9c0fa991bc97e8aa11da83d27f71fdfef6dambansal { 112b28b9c0fa991bc97e8aa11da83d27f71fdfef6dambansal frames = oframes; 113b28b9c0fa991bc97e8aa11da83d27f71fdfef6dambansal } 114b28b9c0fa991bc97e8aa11da83d27f71fdfef6dambansal else // For WIDE strip mode, first select the relevant frames to blend. 115b28b9c0fa991bc97e8aa11da83d27f71fdfef6dambansal { 116b28b9c0fa991bc97e8aa11da83d27f71fdfef6dambansal SelectRelevantFrames(oframes, frames_size, rframes, frames_size); 117b28b9c0fa991bc97e8aa11da83d27f71fdfef6dambansal frames = rframes; 118b28b9c0fa991bc97e8aa11da83d27f71fdfef6dambansal } 119b28b9c0fa991bc97e8aa11da83d27f71fdfef6dambansal 120fa45108679c51623e716acbc3301b1e4535c3267Wei-Ta Chen ComputeBlendParameters(frames, frames_size, true); 121e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen numCenters = frames_size; 122e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen 123e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen if (numCenters == 0) 124e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen { 125274ca49c63557a8c3ee12c8da5f75e28b4875a5dWei-Ta Chen LOGE("Error: No frames to blend"); 126e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen return BLEND_RET_ERROR; 127e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen } 128e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen 129e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen if (!(m_AllSites = m_Triangulator.allocMemory(numCenters))) 130e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen { 131e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen return BLEND_RET_ERROR_MEMORY; 132e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen } 133e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen 1346c5b20113ba9f91352f32e5a53df66aec0ec761ambansal // Bounding rectangle (real numbers) of the final mosaic computed by projecting 1356c5b20113ba9f91352f32e5a53df66aec0ec761ambansal // each input frame into the mosaic coordinate system. 136e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen BlendRect global_rect; 137e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen 138e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen global_rect.lft = global_rect.bot = 2e30; // min values 139e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen global_rect.rgt = global_rect.top = -2e30; // max values 140e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen MosaicFrame *mb = NULL; 141e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen double halfwidth = width / 2.0; 142e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen double halfheight = height / 2.0; 143e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen 144e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen double z, x0, y0, x1, y1, x2, y2, x3, y3; 145e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen 1466c5b20113ba9f91352f32e5a53df66aec0ec761ambansal // Corners of the first and last frames in mosaic coordinate system 1476c5b20113ba9f91352f32e5a53df66aec0ec761ambansal double xf[4] = {0.0, 0.0, 0.0, 0.0}; 1486c5b20113ba9f91352f32e5a53df66aec0ec761ambansal double xl[4] = {0.0, 0.0, 0.0, 0.0}; 1496c5b20113ba9f91352f32e5a53df66aec0ec761ambansal 150e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen // Determine the extents of the final mosaic 151e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen CSite *csite = m_AllSites ; 152e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen for(int mfit = 0; mfit < frames_size; mfit++) 153e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen { 154e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen mb = frames[mfit]; 155e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen 156e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen // Compute clipping for this frame's rect 157e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen FrameToMosaicRect(mb->width, mb->height, mb->trs, mb->brect); 158e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen // Clip global rect using this frame's rect 159e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen ClipRect(mb->brect, global_rect); 160e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen 161e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen // Calculate the corner points 162e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen FrameToMosaic(mb->trs, 0.0, 0.0, x0, y0); 163e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen FrameToMosaic(mb->trs, 0.0, mb->height-1.0, x1, y1); 164e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen FrameToMosaic(mb->trs, mb->width-1.0, mb->height-1.0, x2, y2); 165e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen FrameToMosaic(mb->trs, mb->width-1.0, 0.0, x3, y3); 166e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen 1676c5b20113ba9f91352f32e5a53df66aec0ec761ambansal if(mfit == 0) 1686c5b20113ba9f91352f32e5a53df66aec0ec761ambansal { 1696c5b20113ba9f91352f32e5a53df66aec0ec761ambansal xf[0] = x0; 1706c5b20113ba9f91352f32e5a53df66aec0ec761ambansal xf[1] = x1; 1716c5b20113ba9f91352f32e5a53df66aec0ec761ambansal xf[2] = x3; 1726c5b20113ba9f91352f32e5a53df66aec0ec761ambansal xf[3] = x2; 1736c5b20113ba9f91352f32e5a53df66aec0ec761ambansal } 1746c5b20113ba9f91352f32e5a53df66aec0ec761ambansal 1756c5b20113ba9f91352f32e5a53df66aec0ec761ambansal if(mfit==frames_size-1) 1766c5b20113ba9f91352f32e5a53df66aec0ec761ambansal { 1776c5b20113ba9f91352f32e5a53df66aec0ec761ambansal xl[0] = x0; 1786c5b20113ba9f91352f32e5a53df66aec0ec761ambansal xl[1] = x1; 1796c5b20113ba9f91352f32e5a53df66aec0ec761ambansal xl[2] = x3; 1806c5b20113ba9f91352f32e5a53df66aec0ec761ambansal xl[3] = x2; 1816c5b20113ba9f91352f32e5a53df66aec0ec761ambansal } 1826c5b20113ba9f91352f32e5a53df66aec0ec761ambansal 183e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen // Compute the centroid of the warped region 184e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen FindQuadCentroid(x0, y0, x1, y1, x2, y2, x3, y3, csite->getVCenter().x, csite->getVCenter().y); 185e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen 186e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen csite->setMb(mb); 187e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen csite++; 188e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen } 189e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen 190e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen // Get origin and sizes 1916c5b20113ba9f91352f32e5a53df66aec0ec761ambansal 1926c5b20113ba9f91352f32e5a53df66aec0ec761ambansal // Bounding rectangle (int numbers) of the final mosaic computed by projecting 1936c5b20113ba9f91352f32e5a53df66aec0ec761ambansal // each input frame into the mosaic coordinate system. 194e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen MosaicRect fullRect; 195e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen 196e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen fullRect.left = (int) floor(global_rect.lft); // min-x 197e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen fullRect.top = (int) floor(global_rect.bot); // min-y 198e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen fullRect.right = (int) ceil(global_rect.rgt); // max-x 199e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen fullRect.bottom = (int) ceil(global_rect.top);// max-y 200e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen Mwidth = (unsigned short) (fullRect.right - fullRect.left + 1); 201e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen Mheight = (unsigned short) (fullRect.bottom - fullRect.top + 1); 202e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen 2036c5b20113ba9f91352f32e5a53df66aec0ec761ambansal int xlt, xrt; 2046c5b20113ba9f91352f32e5a53df66aec0ec761ambansal 2056c5b20113ba9f91352f32e5a53df66aec0ec761ambansal if(frames[0]->trs[0][2] < frames[frames_size-1]->trs[0][2]) //left->right mosaic 2066c5b20113ba9f91352f32e5a53df66aec0ec761ambansal { 2076c5b20113ba9f91352f32e5a53df66aec0ec761ambansal xlt = max(xf[0],xf[1]) - fullRect.left; 2086c5b20113ba9f91352f32e5a53df66aec0ec761ambansal xrt = min(xl[2],xl[3]) - fullRect.left; 2096c5b20113ba9f91352f32e5a53df66aec0ec761ambansal } 2106c5b20113ba9f91352f32e5a53df66aec0ec761ambansal else 2116c5b20113ba9f91352f32e5a53df66aec0ec761ambansal { 2126c5b20113ba9f91352f32e5a53df66aec0ec761ambansal xlt = max(xl[0],xl[1]) - fullRect.left; 2136c5b20113ba9f91352f32e5a53df66aec0ec761ambansal xrt = min(xf[2],xf[3]) - fullRect.left; 2146c5b20113ba9f91352f32e5a53df66aec0ec761ambansal } 2156c5b20113ba9f91352f32e5a53df66aec0ec761ambansal 2166c5b20113ba9f91352f32e5a53df66aec0ec761ambansal 217e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen // Make sure image width is multiple of 4 218e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen Mwidth = (unsigned short) ((Mwidth + 3) & ~3); 219e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen Mheight = (unsigned short) ((Mheight + 3) & ~3); // Round up. 220e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen 221e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen if (Mwidth < width || Mheight < height) 222e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen { 223274ca49c63557a8c3ee12c8da5f75e28b4875a5dWei-Ta Chen LOGE("RunBlend: aborting - consistency check failed, w=%d, h=%d", Mwidth, Mheight); 224e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen return BLEND_RET_ERROR; 225e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen } 226e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen 227e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen YUVinfo *imgMos = YUVinfo::allocateImage(Mwidth, Mheight); 228e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen if (imgMos == NULL) 229e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen { 230274ca49c63557a8c3ee12c8da5f75e28b4875a5dWei-Ta Chen LOGE("RunBlend: aborting - couldn't alloc %d x %d mosaic image", Mwidth, Mheight); 231e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen return BLEND_RET_ERROR_MEMORY; 232e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen } 233e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen 234e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen // Set the Y image to 255 so we can distinguish when frame idx are written to it 235e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen memset(imgMos->Y.ptr[0], 255, (imgMos->Y.width * imgMos->Y.height)); 236e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen // Set the v and u images to black 237e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen memset(imgMos->V.ptr[0], 128, (imgMos->V.width * imgMos->V.height) << 1); 238e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen 239e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen // Do the triangulation. It returns a sorted list of edges 240e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen SEdgeVector *edge; 241e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen int n = m_Triangulator.triangulate(&edge, numCenters, width, height); 242e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen m_Triangulator.linkNeighbors(edge, n, numCenters); 243e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen 2446c5b20113ba9f91352f32e5a53df66aec0ec761ambansal // Bounding rectangle that determines the positioning of the rectangle that is 2456c5b20113ba9f91352f32e5a53df66aec0ec761ambansal // cropped out of the computed mosaic to get rid of the gray borders. 246e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen MosaicRect cropping_rect; 247e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen 2486c5b20113ba9f91352f32e5a53df66aec0ec761ambansal cropping_rect.left = xlt; 2496c5b20113ba9f91352f32e5a53df66aec0ec761ambansal cropping_rect.right = xrt; 2506c5b20113ba9f91352f32e5a53df66aec0ec761ambansal 251e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen // Do merging and blending : 25250b3c890986aadb3780b4da8c0b8dbb0f1422ebambansal ret = DoMergeAndBlend(frames, numCenters, width, height, *imgMos, fullRect, 253e1178a73fd5756771d25d0b8375452450f509e99mbansal cropping_rect, progress, cancelComputation); 254e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen 255e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen if (m_wb.blendingType == BLEND_TYPE_HORZ) 256e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen CropFinalMosaic(*imgMos, cropping_rect); 257e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen 258e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen 259e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen m_Triangulator.freeMemory(); // note: can be called even if delaunay_alloc() wasn't successful 260e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen 261e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen imageMosaicYVU = imgMos->Y.ptr[0]; 262e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen 263e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen 264e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen if (m_wb.blendingType == BLEND_TYPE_HORZ) 265e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen { 266e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen mosaicWidth = cropping_rect.right - cropping_rect.left + 1; 267e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen mosaicHeight = cropping_rect.bottom - cropping_rect.top + 1; 268e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen } 269e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen else 270e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen { 271e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen mosaicWidth = Mwidth; 272e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen mosaicHeight = Mheight; 273e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen } 274e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen 275e1178a73fd5756771d25d0b8375452450f509e99mbansal return ret; 276e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen} 277e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen 278e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen 279e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chenint Blend::FillFramePyramid(MosaicFrame *mb) 280e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen{ 281e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen ImageType mbY, mbU, mbV; 282e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen // Lay this image, centered into the temporary buffer 283e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen mbY = mb->image; 284e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen mbU = mb->getU(); 285e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen mbV = mb->getV(); 286e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen 287e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen int h, w; 288e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen 289e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen for(h=0; h<height; h++) 290e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen { 291e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen ImageTypeShort yptr = m_pFrameYPyr->ptr[h]; 292e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen ImageTypeShort uptr = m_pFrameUPyr->ptr[h]; 293e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen ImageTypeShort vptr = m_pFrameVPyr->ptr[h]; 294e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen 295e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen for(w=0; w<width; w++) 296e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen { 297e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen yptr[w] = (short) ((*(mbY++)) << 3); 298e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen uptr[w] = (short) ((*(mbU++)) << 3); 299e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen vptr[w] = (short) ((*(mbV++)) << 3); 300e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen } 301e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen } 302e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen 303e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen // Spread the image through the border 304e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen PyramidShort::BorderSpread(m_pFrameYPyr, BORDER, BORDER, BORDER, BORDER); 305e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen PyramidShort::BorderSpread(m_pFrameUPyr, BORDER, BORDER, BORDER, BORDER); 306e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen PyramidShort::BorderSpread(m_pFrameVPyr, BORDER, BORDER, BORDER, BORDER); 307e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen 308e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen // Generate Laplacian pyramids 309e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen if (!PyramidShort::BorderReduce(m_pFrameYPyr, m_wb.nlevs) || !PyramidShort::BorderExpand(m_pFrameYPyr, m_wb.nlevs, -1) || 310e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen !PyramidShort::BorderReduce(m_pFrameUPyr, m_wb.nlevsC) || !PyramidShort::BorderExpand(m_pFrameUPyr, m_wb.nlevsC, -1) || 311e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen !PyramidShort::BorderReduce(m_pFrameVPyr, m_wb.nlevsC) || !PyramidShort::BorderExpand(m_pFrameVPyr, m_wb.nlevsC, -1)) 312e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen { 313274ca49c63557a8c3ee12c8da5f75e28b4875a5dWei-Ta Chen LOGE("Error: Could not generate Laplacian pyramids"); 314e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen return BLEND_RET_ERROR; 315e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen } 316e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen else 317e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen { 318e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen return BLEND_RET_OK; 319e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen } 320e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen} 321e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen 322e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chenint Blend::DoMergeAndBlend(MosaicFrame **frames, int nsite, 32350b3c890986aadb3780b4da8c0b8dbb0f1422ebambansal int width, int height, YUVinfo &imgMos, MosaicRect &rect, 324e1178a73fd5756771d25d0b8375452450f509e99mbansal MosaicRect &cropping_rect, float &progress, bool &cancelComputation) 325e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen{ 326e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen m_pMosaicYPyr = NULL; 327e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen m_pMosaicUPyr = NULL; 328e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen m_pMosaicVPyr = NULL; 329e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen 330e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen m_pMosaicYPyr = PyramidShort::allocatePyramidPacked(m_wb.nlevs,(unsigned short)rect.Width(),(unsigned short)rect.Height(),BORDER); 331e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen m_pMosaicUPyr = PyramidShort::allocatePyramidPacked(m_wb.nlevsC,(unsigned short)rect.Width(),(unsigned short)rect.Height(),BORDER); 332e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen m_pMosaicVPyr = PyramidShort::allocatePyramidPacked(m_wb.nlevsC,(unsigned short)rect.Width(),(unsigned short)rect.Height(),BORDER); 333e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen if (!m_pMosaicYPyr || !m_pMosaicUPyr || !m_pMosaicVPyr) 334e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen { 335274ca49c63557a8c3ee12c8da5f75e28b4875a5dWei-Ta Chen LOGE("Error: Could not allocate pyramids for blending"); 336e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen return BLEND_RET_ERROR_MEMORY; 337e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen } 338e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen 339e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen MosaicFrame *mb; 340e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen 341e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen CSite *esite = m_AllSites + nsite; 342e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen int site_idx; 343e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen 344e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen // First go through each frame and for each mosaic pixel determine which frame it should come from 345e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen site_idx = 0; 346e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen for(CSite *csite = m_AllSites; csite < esite; csite++) 347e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen { 348e1178a73fd5756771d25d0b8375452450f509e99mbansal if(cancelComputation) 349e1178a73fd5756771d25d0b8375452450f509e99mbansal { 350e1178a73fd5756771d25d0b8375452450f509e99mbansal if (m_pMosaicVPyr) free(m_pMosaicVPyr); 351e1178a73fd5756771d25d0b8375452450f509e99mbansal if (m_pMosaicUPyr) free(m_pMosaicUPyr); 352e1178a73fd5756771d25d0b8375452450f509e99mbansal if (m_pMosaicYPyr) free(m_pMosaicYPyr); 353e1178a73fd5756771d25d0b8375452450f509e99mbansal return BLEND_RET_CANCELLED; 354e1178a73fd5756771d25d0b8375452450f509e99mbansal } 355e1178a73fd5756771d25d0b8375452450f509e99mbansal 356e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen mb = csite->getMb(); 357e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen 358e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen mb->vcrect = mb->brect; 359e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen ClipBlendRect(csite, mb->vcrect); 360e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen 361e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen ComputeMask(csite, mb->vcrect, mb->brect, rect, imgMos, site_idx); 362e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen 363e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen site_idx++; 364e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen } 365e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen 366b28b9c0fa991bc97e8aa11da83d27f71fdfef6dambansal ////////// imgMos.Y, imgMos.V, imgMos.U are used as follows ////////////// 367b28b9c0fa991bc97e8aa11da83d27f71fdfef6dambansal ////////////////////// THIN STRIP MODE /////////////////////////////////// 368b28b9c0fa991bc97e8aa11da83d27f71fdfef6dambansal 369b28b9c0fa991bc97e8aa11da83d27f71fdfef6dambansal // imgMos.Y is used to store the index of the image from which each pixel 370b28b9c0fa991bc97e8aa11da83d27f71fdfef6dambansal // in the output mosaic can be read out for the thin-strip mode. Thus, 371b28b9c0fa991bc97e8aa11da83d27f71fdfef6dambansal // there is no special handling for pixels around the seam. Also, imgMos.Y 372b28b9c0fa991bc97e8aa11da83d27f71fdfef6dambansal // is set to 255 wherever we can't get its value from any input image e.g. 373b28b9c0fa991bc97e8aa11da83d27f71fdfef6dambansal // in the gray border areas. imgMos.V and imgMos.U are set to 128 for the 374b28b9c0fa991bc97e8aa11da83d27f71fdfef6dambansal // thin-strip mode. 375b28b9c0fa991bc97e8aa11da83d27f71fdfef6dambansal 376b28b9c0fa991bc97e8aa11da83d27f71fdfef6dambansal ////////////////////// WIDE STRIP MODE /////////////////////////////////// 377b28b9c0fa991bc97e8aa11da83d27f71fdfef6dambansal 378b28b9c0fa991bc97e8aa11da83d27f71fdfef6dambansal // imgMos.Y is used the same way as the thin-strip mode. 379b28b9c0fa991bc97e8aa11da83d27f71fdfef6dambansal // imgMos.V is used to store the index of the neighboring image which 380b28b9c0fa991bc97e8aa11da83d27f71fdfef6dambansal // should contribute to the color of an output pixel in a band around 381b28b9c0fa991bc97e8aa11da83d27f71fdfef6dambansal // the seam. Thus, in this band, we will crossfade between the color values 382b28b9c0fa991bc97e8aa11da83d27f71fdfef6dambansal // from the image index imgMos.Y and image index imgMos.V. imgMos.U is 383b28b9c0fa991bc97e8aa11da83d27f71fdfef6dambansal // used to store the weight (multiplied by 100) that each image will 384b28b9c0fa991bc97e8aa11da83d27f71fdfef6dambansal // contribute to the blending process. Thus, we start at 99% contribution 385b28b9c0fa991bc97e8aa11da83d27f71fdfef6dambansal // from the first image, then go to 50% contribution from each image at 386b28b9c0fa991bc97e8aa11da83d27f71fdfef6dambansal // the seam. Then, the contribution from the second image goes up to 99%. 387b28b9c0fa991bc97e8aa11da83d27f71fdfef6dambansal 388b28b9c0fa991bc97e8aa11da83d27f71fdfef6dambansal // For WIDE mode, set the pixel masks to guide the blender to cross-fade 389b28b9c0fa991bc97e8aa11da83d27f71fdfef6dambansal // between the images on either side of each seam: 390b28b9c0fa991bc97e8aa11da83d27f71fdfef6dambansal if (m_wb.stripType == STRIP_TYPE_WIDE) 391b28b9c0fa991bc97e8aa11da83d27f71fdfef6dambansal { 392b28b9c0fa991bc97e8aa11da83d27f71fdfef6dambansal // Set the number of pixels around the seam to cross-fade between 393b28b9c0fa991bc97e8aa11da83d27f71fdfef6dambansal // the two component images, 394b28b9c0fa991bc97e8aa11da83d27f71fdfef6dambansal int tw = STRIP_CROSS_FADE_WIDTH * width; 395b28b9c0fa991bc97e8aa11da83d27f71fdfef6dambansal 396b28b9c0fa991bc97e8aa11da83d27f71fdfef6dambansal for(int y = 0; y < imgMos.Y.height; y++) 397b28b9c0fa991bc97e8aa11da83d27f71fdfef6dambansal { 398b28b9c0fa991bc97e8aa11da83d27f71fdfef6dambansal for(int x = tw; x < imgMos.Y.width - tw + 1; ) 399b28b9c0fa991bc97e8aa11da83d27f71fdfef6dambansal { 400b28b9c0fa991bc97e8aa11da83d27f71fdfef6dambansal // Determine where the seam is... 401b28b9c0fa991bc97e8aa11da83d27f71fdfef6dambansal if (imgMos.Y.ptr[y][x] != imgMos.Y.ptr[y][x+1] && 402b28b9c0fa991bc97e8aa11da83d27f71fdfef6dambansal imgMos.Y.ptr[y][x] != 255 && 403b28b9c0fa991bc97e8aa11da83d27f71fdfef6dambansal imgMos.Y.ptr[y][x+1] != 255) 404b28b9c0fa991bc97e8aa11da83d27f71fdfef6dambansal { 405b28b9c0fa991bc97e8aa11da83d27f71fdfef6dambansal // Find the image indices on both sides of the seam 406b28b9c0fa991bc97e8aa11da83d27f71fdfef6dambansal unsigned char idx1 = imgMos.Y.ptr[y][x]; 407b28b9c0fa991bc97e8aa11da83d27f71fdfef6dambansal unsigned char idx2 = imgMos.Y.ptr[y][x+1]; 408b28b9c0fa991bc97e8aa11da83d27f71fdfef6dambansal 409b28b9c0fa991bc97e8aa11da83d27f71fdfef6dambansal for (int o = tw; o >= 0; o--) 410b28b9c0fa991bc97e8aa11da83d27f71fdfef6dambansal { 411b28b9c0fa991bc97e8aa11da83d27f71fdfef6dambansal // Set the image index to use for cross-fading 412b28b9c0fa991bc97e8aa11da83d27f71fdfef6dambansal imgMos.V.ptr[y][x - o] = idx2; 413b28b9c0fa991bc97e8aa11da83d27f71fdfef6dambansal // Set the intensity weights to use for cross-fading 414b28b9c0fa991bc97e8aa11da83d27f71fdfef6dambansal imgMos.U.ptr[y][x - o] = 50 + (99 - 50) * o / tw; 415b28b9c0fa991bc97e8aa11da83d27f71fdfef6dambansal } 416b28b9c0fa991bc97e8aa11da83d27f71fdfef6dambansal 417b28b9c0fa991bc97e8aa11da83d27f71fdfef6dambansal for (int o = 1; o <= tw; o++) 418b28b9c0fa991bc97e8aa11da83d27f71fdfef6dambansal { 419b28b9c0fa991bc97e8aa11da83d27f71fdfef6dambansal // Set the image index to use for cross-fading 420b28b9c0fa991bc97e8aa11da83d27f71fdfef6dambansal imgMos.V.ptr[y][x + o] = idx1; 421b28b9c0fa991bc97e8aa11da83d27f71fdfef6dambansal // Set the intensity weights to use for cross-fading 422b28b9c0fa991bc97e8aa11da83d27f71fdfef6dambansal imgMos.U.ptr[y][x + o] = imgMos.U.ptr[y][x - o]; 423b28b9c0fa991bc97e8aa11da83d27f71fdfef6dambansal } 424b28b9c0fa991bc97e8aa11da83d27f71fdfef6dambansal 425b28b9c0fa991bc97e8aa11da83d27f71fdfef6dambansal x += (tw + 1); 426b28b9c0fa991bc97e8aa11da83d27f71fdfef6dambansal } 427b28b9c0fa991bc97e8aa11da83d27f71fdfef6dambansal else 428b28b9c0fa991bc97e8aa11da83d27f71fdfef6dambansal { 429b28b9c0fa991bc97e8aa11da83d27f71fdfef6dambansal x++; 430b28b9c0fa991bc97e8aa11da83d27f71fdfef6dambansal } 431b28b9c0fa991bc97e8aa11da83d27f71fdfef6dambansal } 432b28b9c0fa991bc97e8aa11da83d27f71fdfef6dambansal } 433b28b9c0fa991bc97e8aa11da83d27f71fdfef6dambansal } 434b28b9c0fa991bc97e8aa11da83d27f71fdfef6dambansal 435e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen // Now perform the actual blending using the frame assignment determined above 436e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen site_idx = 0; 437e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen for(CSite *csite = m_AllSites; csite < esite; csite++) 438e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen { 439e1178a73fd5756771d25d0b8375452450f509e99mbansal if(cancelComputation) 440e1178a73fd5756771d25d0b8375452450f509e99mbansal { 441e1178a73fd5756771d25d0b8375452450f509e99mbansal if (m_pMosaicVPyr) free(m_pMosaicVPyr); 442e1178a73fd5756771d25d0b8375452450f509e99mbansal if (m_pMosaicUPyr) free(m_pMosaicUPyr); 443e1178a73fd5756771d25d0b8375452450f509e99mbansal if (m_pMosaicYPyr) free(m_pMosaicYPyr); 444e1178a73fd5756771d25d0b8375452450f509e99mbansal return BLEND_RET_CANCELLED; 445e1178a73fd5756771d25d0b8375452450f509e99mbansal } 446e1178a73fd5756771d25d0b8375452450f509e99mbansal 447e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen mb = csite->getMb(); 448e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen 449e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen 450e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen if(FillFramePyramid(mb)!=BLEND_RET_OK) 451e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen return BLEND_RET_ERROR; 452e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen 453e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen ProcessPyramidForThisFrame(csite, mb->vcrect, mb->brect, rect, imgMos, mb->trs, site_idx); 454e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen 45550b3c890986aadb3780b4da8c0b8dbb0f1422ebambansal progress += TIME_PERCENT_BLEND/nsite; 45650b3c890986aadb3780b4da8c0b8dbb0f1422ebambansal 457e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen site_idx++; 458e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen } 459e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen 460e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen 461e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen // Blend 462e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen PerformFinalBlending(imgMos, cropping_rect); 463e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen 464e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen if (m_pMosaicVPyr) free(m_pMosaicVPyr); 465e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen if (m_pMosaicUPyr) free(m_pMosaicUPyr); 466e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen if (m_pMosaicYPyr) free(m_pMosaicYPyr); 467e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen 46850b3c890986aadb3780b4da8c0b8dbb0f1422ebambansal progress += TIME_PERCENT_FINAL; 46950b3c890986aadb3780b4da8c0b8dbb0f1422ebambansal 470e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen return BLEND_RET_OK; 471e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen} 472e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen 473e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chenvoid Blend::CropFinalMosaic(YUVinfo &imgMos, MosaicRect &cropping_rect) 474e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen{ 475e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen int i, j, k; 476e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen ImageType yimg; 477e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen ImageType uimg; 478e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen ImageType vimg; 479e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen 480e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen 481e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen yimg = imgMos.Y.ptr[0]; 482e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen uimg = imgMos.U.ptr[0]; 483e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen vimg = imgMos.V.ptr[0]; 484e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen 485e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen k = 0; 486e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen for (j = cropping_rect.top; j <= cropping_rect.bottom; j++) 487e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen { 488e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen for (i = cropping_rect.left; i <= cropping_rect.right; i++) 489e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen { 490e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen yimg[k] = yimg[j*imgMos.Y.width+i]; 491e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen k++; 492e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen } 493e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen } 494e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen for (j = cropping_rect.top; j <= cropping_rect.bottom; j++) 495e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen { 496e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen for (i = cropping_rect.left; i <= cropping_rect.right; i++) 497e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen { 498e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen yimg[k] = vimg[j*imgMos.Y.width+i]; 499e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen k++; 500e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen } 501e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen } 502e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen for (j = cropping_rect.top; j <= cropping_rect.bottom; j++) 503e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen { 504e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen for (i = cropping_rect.left; i <= cropping_rect.right; i++) 505e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen { 506e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen yimg[k] = uimg[j*imgMos.Y.width+i]; 507e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen k++; 508e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen } 509e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen } 510e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen} 511e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen 512e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chenint Blend::PerformFinalBlending(YUVinfo &imgMos, MosaicRect &cropping_rect) 513e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen{ 514e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen if (!PyramidShort::BorderExpand(m_pMosaicYPyr, m_wb.nlevs, 1) || !PyramidShort::BorderExpand(m_pMosaicUPyr, m_wb.nlevsC, 1) || 515e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen !PyramidShort::BorderExpand(m_pMosaicVPyr, m_wb.nlevsC, 1)) 516e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen { 517274ca49c63557a8c3ee12c8da5f75e28b4875a5dWei-Ta Chen LOGE("Error: Could not BorderExpand!"); 518e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen return BLEND_RET_ERROR; 519e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen } 520e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen 521e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen ImageTypeShort myimg; 522e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen ImageTypeShort muimg; 523e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen ImageTypeShort mvimg; 524e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen ImageType yimg; 525e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen ImageType uimg; 526e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen ImageType vimg; 527e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen 528e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen int cx = (int)imgMos.Y.width/2; 529e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen int cy = (int)imgMos.Y.height/2; 530e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen 5316c5b20113ba9f91352f32e5a53df66aec0ec761ambansal // 2D boolean array that contains true wherever the mosaic image data is 5326c5b20113ba9f91352f32e5a53df66aec0ec761ambansal // invalid (i.e. in the gray border). 5336c5b20113ba9f91352f32e5a53df66aec0ec761ambansal bool **b = new bool*[imgMos.Y.height]; 5346c5b20113ba9f91352f32e5a53df66aec0ec761ambansal 5356c5b20113ba9f91352f32e5a53df66aec0ec761ambansal for(int j=0; j<imgMos.Y.height; j++) 5366c5b20113ba9f91352f32e5a53df66aec0ec761ambansal { 5376c5b20113ba9f91352f32e5a53df66aec0ec761ambansal b[j] = new bool[imgMos.Y.width]; 5386c5b20113ba9f91352f32e5a53df66aec0ec761ambansal } 539e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen 540e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen // Copy the resulting image into the full image using the mask 541e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen int i, j; 542e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen 543e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen yimg = imgMos.Y.ptr[0]; 544e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen uimg = imgMos.U.ptr[0]; 545e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen vimg = imgMos.V.ptr[0]; 546e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen 547e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen for (j = 0; j < imgMos.Y.height; j++) 548e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen { 549e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen myimg = m_pMosaicYPyr->ptr[j]; 550e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen muimg = m_pMosaicUPyr->ptr[j]; 551e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen mvimg = m_pMosaicVPyr->ptr[j]; 552e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen 5536c5b20113ba9f91352f32e5a53df66aec0ec761ambansal for (i = 0; i<imgMos.Y.width; i++) 554e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen { 555e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen // A final mask was set up previously, 556e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen // if the value is zero skip it, otherwise replace it. 557e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen if (*yimg <255) 558e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen { 559e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen short value = (short) ((*myimg) >> 3); 560e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen if (value < 0) value = 0; 561e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen else if (value > 255) value = 255; 562e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen *yimg = (unsigned char) value; 563e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen 564e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen value = (short) ((*muimg) >> 3); 565e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen if (value < 0) value = 0; 566e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen else if (value > 255) value = 255; 567e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen *uimg = (unsigned char) value; 568e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen 569e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen value = (short) ((*mvimg) >> 3); 570e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen if (value < 0) value = 0; 571e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen else if (value > 255) value = 255; 572e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen *vimg = (unsigned char) value; 573e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen 5746c5b20113ba9f91352f32e5a53df66aec0ec761ambansal b[j][i] = false; 5756c5b20113ba9f91352f32e5a53df66aec0ec761ambansal 576e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen } 577e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen else 578e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen { // set border color in here 579e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen *yimg = (unsigned char) 96; 5806c5b20113ba9f91352f32e5a53df66aec0ec761ambansal *uimg = (unsigned char) 128; 5816c5b20113ba9f91352f32e5a53df66aec0ec761ambansal *vimg = (unsigned char) 128; 5826c5b20113ba9f91352f32e5a53df66aec0ec761ambansal 5836c5b20113ba9f91352f32e5a53df66aec0ec761ambansal b[j][i] = true; 584e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen } 585e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen 586e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen yimg++; 587e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen uimg++; 588e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen vimg++; 589e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen myimg++; 590e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen muimg++; 591e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen mvimg++; 592e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen } 593e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen } 594e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen 5956c5b20113ba9f91352f32e5a53df66aec0ec761ambansal //Scan through each row and increment top if the row contains any gray 596e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen for (j = 0; j < imgMos.Y.height; j++) 597e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen { 5986c5b20113ba9f91352f32e5a53df66aec0ec761ambansal for (i = cropping_rect.left; i < cropping_rect.right; i++) 599e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen { 6006c5b20113ba9f91352f32e5a53df66aec0ec761ambansal if (b[j][i]) 601e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen { 6026c5b20113ba9f91352f32e5a53df66aec0ec761ambansal break; // to next row 603e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen } 604e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen } 605e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen 6066c5b20113ba9f91352f32e5a53df66aec0ec761ambansal if (i == cropping_rect.right) //no gray pixel in this row! 6076c5b20113ba9f91352f32e5a53df66aec0ec761ambansal { 6086c5b20113ba9f91352f32e5a53df66aec0ec761ambansal cropping_rect.top = j; 6096c5b20113ba9f91352f32e5a53df66aec0ec761ambansal break; 6106c5b20113ba9f91352f32e5a53df66aec0ec761ambansal } 611e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen } 612e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen 6136c5b20113ba9f91352f32e5a53df66aec0ec761ambansal //Scan through each row and decrement bottom if the row contains any gray 6146c5b20113ba9f91352f32e5a53df66aec0ec761ambansal for (j = imgMos.Y.height-1; j >= 0; j--) 615e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen { 6166c5b20113ba9f91352f32e5a53df66aec0ec761ambansal for (i = cropping_rect.left; i < cropping_rect.right; i++) 617e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen { 6186c5b20113ba9f91352f32e5a53df66aec0ec761ambansal if (b[j][i]) 619e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen { 6206c5b20113ba9f91352f32e5a53df66aec0ec761ambansal break; // to next row 621e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen } 622e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen } 623e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen 6246c5b20113ba9f91352f32e5a53df66aec0ec761ambansal if (i == cropping_rect.right) //no gray pixel in this row! 6256c5b20113ba9f91352f32e5a53df66aec0ec761ambansal { 6266c5b20113ba9f91352f32e5a53df66aec0ec761ambansal cropping_rect.bottom = j; 6276c5b20113ba9f91352f32e5a53df66aec0ec761ambansal break; 6286c5b20113ba9f91352f32e5a53df66aec0ec761ambansal } 6296c5b20113ba9f91352f32e5a53df66aec0ec761ambansal } 630e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen 6316c5b20113ba9f91352f32e5a53df66aec0ec761ambansal for(int j=0; j<imgMos.Y.height; j++) 6326c5b20113ba9f91352f32e5a53df66aec0ec761ambansal { 6336c5b20113ba9f91352f32e5a53df66aec0ec761ambansal delete b[j]; 634e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen } 635e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen 6366c5b20113ba9f91352f32e5a53df66aec0ec761ambansal delete b; 637e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen 638e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen return BLEND_RET_OK; 639e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen} 640e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen 641e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chenvoid Blend::ComputeMask(CSite *csite, BlendRect &vcrect, BlendRect &brect, MosaicRect &rect, YUVinfo &imgMos, int site_idx) 642e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen{ 643e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen PyramidShort *dptr = m_pMosaicYPyr; 644e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen 645e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen int nC = m_wb.nlevsC; 646e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen int l = (int) ((vcrect.lft - rect.left)); 647e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen int b = (int) ((vcrect.bot - rect.top)); 648e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen int r = (int) ((vcrect.rgt - rect.left)); 649e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen int t = (int) ((vcrect.top - rect.top)); 650e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen 651e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen if (vcrect.lft == brect.lft) 652e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen l = (l <= 0) ? -BORDER : l - BORDER; 653e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen else if (l < -BORDER) 654e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen l = -BORDER; 655e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen 656e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen if (vcrect.bot == brect.bot) 657e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen b = (b <= 0) ? -BORDER : b - BORDER; 658e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen else if (b < -BORDER) 659e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen b = -BORDER; 660e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen 661e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen if (vcrect.rgt == brect.rgt) 662e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen r = (r >= dptr->width) ? dptr->width + BORDER - 1 : r + BORDER; 663e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen else if (r >= dptr->width + BORDER) 664e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen r = dptr->width + BORDER - 1; 665e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen 666e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen if (vcrect.top == brect.top) 667e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen t = (t >= dptr->height) ? dptr->height + BORDER - 1 : t + BORDER; 668e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen else if (t >= dptr->height + BORDER) 669e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen t = dptr->height + BORDER - 1; 670e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen 671e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen // Walk the Region of interest and populate the pyramid 672e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen for (int j = b; j <= t; j++) 673e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen { 674e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen int jj = j; 675e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen double sj = jj + rect.top; 676e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen 677e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen for (int i = l; i <= r; i++) 678e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen { 679e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen int ii = i; 680e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen // project point and then triangulate to neighbors 681e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen double si = ii + rect.left; 682e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen 683e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen double dself = hypotSq(csite->getVCenter().x - si, csite->getVCenter().y - sj); 684e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen int inMask = ((unsigned) ii < imgMos.Y.width && 685e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen (unsigned) jj < imgMos.Y.height) ? 1 : 0; 686e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen 687e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen if(!inMask) 688e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen continue; 689e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen 690e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen // scan the neighbors to see if this is a valid position 691e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen unsigned char mask = (unsigned char) 255; 692e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen SEdgeVector *ce; 693e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen int ecnt; 694e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen for (ce = csite->getNeighbor(), ecnt = csite->getNumNeighbors(); ecnt--; ce++) 695e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen { 696e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen double d1 = hypotSq(m_AllSites[ce->second].getVCenter().x - si, 697e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen m_AllSites[ce->second].getVCenter().y - sj); 698e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen if (d1 < dself) 699e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen { 700e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen break; 701e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen } 702e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen } 703e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen 704e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen if (ecnt >= 0) continue; 705e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen 706e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen imgMos.Y.ptr[jj][ii] = (unsigned char)site_idx; 707e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen } 708e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen } 709e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen} 710e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen 711e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chenvoid Blend::ProcessPyramidForThisFrame(CSite *csite, BlendRect &vcrect, BlendRect &brect, MosaicRect &rect, YUVinfo &imgMos, double trs[3][3], int site_idx) 712e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen{ 713e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen // Put the Region of interest (for all levels) into m_pMosaicYPyr 714e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen double inv_trs[3][3]; 715e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen inv33d(trs, inv_trs); 716e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen 717e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen // Process each pyramid level 718e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen PyramidShort *sptr = m_pFrameYPyr; 719e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen PyramidShort *suptr = m_pFrameUPyr; 720e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen PyramidShort *svptr = m_pFrameVPyr; 721e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen 722e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen PyramidShort *dptr = m_pMosaicYPyr; 723e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen PyramidShort *duptr = m_pMosaicUPyr; 724e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen PyramidShort *dvptr = m_pMosaicVPyr; 725e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen 726e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen int dscale = 0; // distance scale for the current level 727e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen int nC = m_wb.nlevsC; 728e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen for (int n = m_wb.nlevs; n--; dscale++, dptr++, sptr++, dvptr++, duptr++, svptr++, suptr++, nC--) 729e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen { 730e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen int l = (int) ((vcrect.lft - rect.left) / (1 << dscale)); 731e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen int b = (int) ((vcrect.bot - rect.top) / (1 << dscale)); 732e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen int r = (int) ((vcrect.rgt - rect.left) / (1 << dscale) + .5); 733e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen int t = (int) ((vcrect.top - rect.top) / (1 << dscale) + .5); 734e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen 735e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen if (vcrect.lft == brect.lft) 736e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen l = (l <= 0) ? -BORDER : l - BORDER; 737e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen else if (l < -BORDER) 738e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen l = -BORDER; 739e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen 740e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen if (vcrect.bot == brect.bot) 741e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen b = (b <= 0) ? -BORDER : b - BORDER; 742e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen else if (b < -BORDER) 743e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen b = -BORDER; 744e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen 745e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen if (vcrect.rgt == brect.rgt) 746e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen r = (r >= dptr->width) ? dptr->width + BORDER - 1 : r + BORDER; 747e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen else if (r >= dptr->width + BORDER) 748e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen r = dptr->width + BORDER - 1; 749e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen 750e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen if (vcrect.top == brect.top) 751e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen t = (t >= dptr->height) ? dptr->height + BORDER - 1 : t + BORDER; 752e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen else if (t >= dptr->height + BORDER) 753e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen t = dptr->height + BORDER - 1; 754e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen 755e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen // Walk the Region of interest and populate the pyramid 756e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen for (int j = b; j <= t; j++) 757e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen { 758e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen int jj = (j << dscale); 759e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen double sj = jj + rect.top; 760e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen 761e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen for (int i = l; i <= r; i++) 762e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen { 763e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen int ii = (i << dscale); 764e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen // project point and then triangulate to neighbors 765e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen double si = ii + rect.left; 766e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen 767e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen int inMask = ((unsigned) ii < imgMos.Y.width && 768e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen (unsigned) jj < imgMos.Y.height) ? 1 : 0; 769e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen 770b28b9c0fa991bc97e8aa11da83d27f71fdfef6dambansal if(inMask && imgMos.Y.ptr[jj][ii] != site_idx && 771b28b9c0fa991bc97e8aa11da83d27f71fdfef6dambansal imgMos.V.ptr[jj][ii] != site_idx && 772b28b9c0fa991bc97e8aa11da83d27f71fdfef6dambansal imgMos.Y.ptr[jj][ii] != 255) 773e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen continue; 774e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen 775b28b9c0fa991bc97e8aa11da83d27f71fdfef6dambansal // Setup weights for cross-fading 776b28b9c0fa991bc97e8aa11da83d27f71fdfef6dambansal // Weight of the intensity already in the output pixel 777b28b9c0fa991bc97e8aa11da83d27f71fdfef6dambansal double wt0 = 0.0; 778b28b9c0fa991bc97e8aa11da83d27f71fdfef6dambansal // Weight of the intensity from the input pixel (current frame) 779b28b9c0fa991bc97e8aa11da83d27f71fdfef6dambansal double wt1 = 1.0; 780b28b9c0fa991bc97e8aa11da83d27f71fdfef6dambansal 781b28b9c0fa991bc97e8aa11da83d27f71fdfef6dambansal if (m_wb.stripType == STRIP_TYPE_WIDE) 782b28b9c0fa991bc97e8aa11da83d27f71fdfef6dambansal { 783b28b9c0fa991bc97e8aa11da83d27f71fdfef6dambansal if(inMask && imgMos.Y.ptr[jj][ii] != 255) 784b28b9c0fa991bc97e8aa11da83d27f71fdfef6dambansal { 785b28b9c0fa991bc97e8aa11da83d27f71fdfef6dambansal if(imgMos.V.ptr[jj][ii] == 128) // Not on a seam 786b28b9c0fa991bc97e8aa11da83d27f71fdfef6dambansal { 787b28b9c0fa991bc97e8aa11da83d27f71fdfef6dambansal wt0 = 0.0; 788b28b9c0fa991bc97e8aa11da83d27f71fdfef6dambansal wt1 = 1.0; 789b28b9c0fa991bc97e8aa11da83d27f71fdfef6dambansal } 790b28b9c0fa991bc97e8aa11da83d27f71fdfef6dambansal else 791b28b9c0fa991bc97e8aa11da83d27f71fdfef6dambansal { 792b28b9c0fa991bc97e8aa11da83d27f71fdfef6dambansal wt0 = 1.0; 793b28b9c0fa991bc97e8aa11da83d27f71fdfef6dambansal wt1 = ((imgMos.Y.ptr[jj][ii] == site_idx) ? 794b28b9c0fa991bc97e8aa11da83d27f71fdfef6dambansal (double)imgMos.U.ptr[jj][ii] / 100.0 : 795b28b9c0fa991bc97e8aa11da83d27f71fdfef6dambansal 1.0 - (double)imgMos.U.ptr[jj][ii] / 100.0); 796b28b9c0fa991bc97e8aa11da83d27f71fdfef6dambansal } 797b28b9c0fa991bc97e8aa11da83d27f71fdfef6dambansal } 798b28b9c0fa991bc97e8aa11da83d27f71fdfef6dambansal } 799b28b9c0fa991bc97e8aa11da83d27f71fdfef6dambansal 800e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen // Project this mosaic point into the original frame coordinate space 801e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen double xx, yy; 802e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen 803e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen MosaicToFrame(inv_trs, si, sj, xx, yy); 804e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen 805e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen if (xx < 0.0 || yy < 0.0 || xx > width - 1.0 || yy > height - 1.0) 806e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen { 807e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen if(inMask) 808e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen { 809e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen imgMos.Y.ptr[jj][ii] = 255; 810b28b9c0fa991bc97e8aa11da83d27f71fdfef6dambansal wt0 = 0.0f; 811b28b9c0fa991bc97e8aa11da83d27f71fdfef6dambansal wt1 = 1.0f; 812e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen } 813e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen } 814e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen 815e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen xx /= (1 << dscale); 816e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen yy /= (1 << dscale); 817e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen 818e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen 819e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen int x1 = (xx >= 0.0) ? (int) xx : (int) floor(xx); 820e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen int y1 = (yy >= 0.0) ? (int) yy : (int) floor(yy); 821e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen 822e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen // Final destination in extended pyramid 823e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen#ifndef LINEAR_INTERP 824b28b9c0fa991bc97e8aa11da83d27f71fdfef6dambansal if(inSegment(x1, sptr->width, BORDER-1) && 825b28b9c0fa991bc97e8aa11da83d27f71fdfef6dambansal inSegment(y1, sptr->height, BORDER-1)) 826e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen { 827e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen double xfrac = xx - x1; 828e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen double yfrac = yy - y1; 829b28b9c0fa991bc97e8aa11da83d27f71fdfef6dambansal dptr->ptr[j][i] = (short) (wt0 * dptr->ptr[j][i] + .5 + 830b28b9c0fa991bc97e8aa11da83d27f71fdfef6dambansal wt1 * ciCalc(sptr, x1, y1, xfrac, yfrac)); 831e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen if (dvptr >= m_pMosaicVPyr && nC > 0) 832e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen { 833b28b9c0fa991bc97e8aa11da83d27f71fdfef6dambansal duptr->ptr[j][i] = (short) (wt0 * duptr->ptr[j][i] + .5 + 834b28b9c0fa991bc97e8aa11da83d27f71fdfef6dambansal wt1 * ciCalc(suptr, x1, y1, xfrac, yfrac)); 835b28b9c0fa991bc97e8aa11da83d27f71fdfef6dambansal dvptr->ptr[j][i] = (short) (wt0 * dvptr->ptr[j][i] + .5 + 836b28b9c0fa991bc97e8aa11da83d27f71fdfef6dambansal wt1 * ciCalc(svptr, x1, y1, xfrac, yfrac)); 837e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen } 838e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen } 839e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen#else 840e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen if(inSegment(x1, sptr->width, BORDER) && inSegment(y1, sptr->height, BORDER)) 841e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen { 842e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen int x2 = x1 + 1; 843e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen int y2 = y1 + 1; 844e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen double xfrac = xx - x1; 845e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen double yfrac = yy - y1; 846e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen double y1val = sptr->ptr[y1][x1] + 847e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen (sptr->ptr[y1][x2] - sptr->ptr[y1][x1]) * xfrac; 848e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen double y2val = sptr->ptr[y2][x1] + 849e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen (sptr->ptr[y2][x2] - sptr->ptr[y2][x1]) * xfrac; 850e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen dptr->ptr[j][i] = (short) (y1val + yfrac * (y2val - y1val)); 851e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen 852e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen if (dvptr >= m_pMosaicVPyr && nC > 0) 853e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen { 854e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen y1val = suptr->ptr[y1][x1] + 855e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen (suptr->ptr[y1][x2] - suptr->ptr[y1][x1]) * xfrac; 856e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen y2val = suptr->ptr[y2][x1] + 857e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen (suptr->ptr[y2][x2] - suptr->ptr[y2][x1]) * xfrac; 858e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen 859e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen duptr->ptr[j][i] = (short) (y1val + yfrac * (y2val - y1val)); 860e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen 861e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen y1val = svptr->ptr[y1][x1] + 862e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen (svptr->ptr[y1][x2] - svptr->ptr[y1][x1]) * xfrac; 863e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen y2val = svptr->ptr[y2][x1] + 864e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen (svptr->ptr[y2][x2] - svptr->ptr[y2][x1]) * xfrac; 865e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen 866e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen dvptr->ptr[j][i] = (short) (y1val + yfrac * (y2val - y1val)); 867e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen } 868e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen } 869e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen#endif 870e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen else 871e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen { 872e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen clipToSegment(x1, sptr->width, BORDER); 873e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen clipToSegment(y1, sptr->height, BORDER); 874e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen 875b28b9c0fa991bc97e8aa11da83d27f71fdfef6dambansal dptr->ptr[j][i] = (short) (wt0 * dptr->ptr[j][i] + 0.5 + 876b28b9c0fa991bc97e8aa11da83d27f71fdfef6dambansal wt1 * sptr->ptr[y1][x1] ); 877e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen if (dvptr >= m_pMosaicVPyr && nC > 0) 878e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen { 879b28b9c0fa991bc97e8aa11da83d27f71fdfef6dambansal dvptr->ptr[j][i] = (short) (wt0 * dvptr->ptr[j][i] + 880b28b9c0fa991bc97e8aa11da83d27f71fdfef6dambansal 0.5 + wt1 * svptr->ptr[y1][x1] ); 881b28b9c0fa991bc97e8aa11da83d27f71fdfef6dambansal duptr->ptr[j][i] = (short) (wt0 * duptr->ptr[j][i] + 882b28b9c0fa991bc97e8aa11da83d27f71fdfef6dambansal 0.5 + wt1 * suptr->ptr[y1][x1] ); 883e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen } 884e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen } 885e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen } 886e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen } 887e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen } 888e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen} 889e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen 890e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chenvoid Blend::MosaicToFrame(double trs[3][3], double x, double y, double &wx, double &wy) 891e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen{ 892e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen double X, Y, z; 893e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen if (m_wb.theta == 0.0) 894e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen { 895e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen X = x; 896e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen Y = y; 897e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen } 898e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen else if (m_wb.horizontal) 899e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen { 900e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen double alpha = x * m_wb.direction / m_wb.width; 901e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen double length = (y - alpha * m_wb.correction) * m_wb.direction + m_wb.radius; 902e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen double deltaTheta = m_wb.theta * alpha; 903e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen double sinTheta = sin(deltaTheta); 904e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen double cosTheta = sqrt(1.0 - sinTheta * sinTheta) * m_wb.direction; 905e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen X = length * sinTheta + m_wb.x; 906e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen Y = length * cosTheta + m_wb.y; 907e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen } 908e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen else 909e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen { 910e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen double alpha = y * m_wb.direction / m_wb.width; 911e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen double length = (x - alpha * m_wb.correction) * m_wb.direction + m_wb.radius; 912e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen double deltaTheta = m_wb.theta * alpha; 913e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen double sinTheta = sin(deltaTheta); 914e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen double cosTheta = sqrt(1.0 - sinTheta * sinTheta) * m_wb.direction; 915e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen Y = length * sinTheta + m_wb.y; 916e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen X = length * cosTheta + m_wb.x; 917e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen } 918e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen z = ProjZ(trs, X, Y, 1.0); 919e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen wx = ProjX(trs, X, Y, z, 1.0); 920e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen wy = ProjY(trs, X, Y, z, 1.0); 921e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen} 922e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen 923e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chenvoid Blend::FrameToMosaic(double trs[3][3], double x, double y, double &wx, double &wy) 924e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen{ 925e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen // Project into the intermediate Mosaic coordinate system 926e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen double z = ProjZ(trs, x, y, 1.0); 927e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen double X = ProjX(trs, x, y, z, 1.0); 928e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen double Y = ProjY(trs, x, y, z, 1.0); 929e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen 930e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen if (m_wb.theta == 0.0) 931e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen { 932e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen // No rotation, then this is all we need to do. 933e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen wx = X; 934e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen wy = Y; 935e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen } 936e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen else if (m_wb.horizontal) 937e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen { 938e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen double deltaX = X - m_wb.x; 939e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen double deltaY = Y - m_wb.y; 940e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen double length = sqrt(deltaX * deltaX + deltaY * deltaY); 941e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen double deltaTheta = asin(deltaX / length); 942e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen double alpha = deltaTheta / m_wb.theta; 943e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen wx = alpha * m_wb.width * m_wb.direction; 944e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen wy = (length - m_wb.radius) * m_wb.direction + alpha * m_wb.correction; 945e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen } 946e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen else 947e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen { 948e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen double deltaX = X - m_wb.x; 949e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen double deltaY = Y - m_wb.y; 950e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen double length = sqrt(deltaX * deltaX + deltaY * deltaY); 951e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen double deltaTheta = asin(deltaY / length); 952e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen double alpha = deltaTheta / m_wb.theta; 953e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen wy = alpha * m_wb.width * m_wb.direction; 954e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen wx = (length - m_wb.radius) * m_wb.direction + alpha * m_wb.correction; 955e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen } 956e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen} 957e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen 958e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen 959e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen 960e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen// Clip the region of interest as small as possible by using the Voronoi edges of 961e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen// the neighbors 962e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chenvoid Blend::ClipBlendRect(CSite *csite, BlendRect &brect) 963e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen{ 964e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen SEdgeVector *ce; 965e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen int ecnt; 966e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen for (ce = csite->getNeighbor(), ecnt = csite->getNumNeighbors(); ecnt--; ce++) 967e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen { 968e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen // calculate the Voronoi bisector intersection 969e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen const double epsilon = 1e-5; 970e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen double dx = (m_AllSites[ce->second].getVCenter().x - m_AllSites[ce->first].getVCenter().x); 971e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen double dy = (m_AllSites[ce->second].getVCenter().y - m_AllSites[ce->first].getVCenter().y); 972e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen double xmid = m_AllSites[ce->first].getVCenter().x + dx/2.0; 973e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen double ymid = m_AllSites[ce->first].getVCenter().y + dy/2.0; 974e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen double inter; 975e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen 976e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen if (dx > epsilon) 977e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen { 978e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen // neighbor is on right 979e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen if ((inter = m_wb.roundoffOverlap + xmid - dy * (((dy >= 0.0) ? brect.bot : brect.top) - ymid) / dx) < brect.rgt) 980e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen brect.rgt = inter; 981e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen } 982e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen else if (dx < -epsilon) 983e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen { 984e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen // neighbor is on left 985e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen if ((inter = -m_wb.roundoffOverlap + xmid - dy * (((dy >= 0.0) ? brect.bot : brect.top) - ymid) / dx) > brect.lft) 986e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen brect.lft = inter; 987e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen } 988e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen if (dy > epsilon) 989e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen { 990e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen // neighbor is above 991e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen if ((inter = m_wb.roundoffOverlap + ymid - dx * (((dx >= 0.0) ? brect.lft : brect.rgt) - xmid) / dy) < brect.top) 992e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen brect.top = inter; 993e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen } 994e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen else if (dy < -epsilon) 995e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen { 996e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen // neighbor is below 997e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen if ((inter = -m_wb.roundoffOverlap + ymid - dx * (((dx >= 0.0) ? brect.lft : brect.rgt) - xmid) / dy) > brect.bot) 998e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen brect.bot = inter; 999e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen } 1000e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen } 1001e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen} 1002e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen 1003e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chenvoid Blend::FrameToMosaicRect(int width, int height, double trs[3][3], BlendRect &brect) 1004e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen{ 1005e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen // We need to walk the perimeter since the borders can be bent. 1006e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen brect.lft = brect.bot = 2e30; 1007e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen brect.rgt = brect.top = -2e30; 1008e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen double xpos, ypos; 1009e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen double lasty = height - 1.0; 1010e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen double lastx = width - 1.0; 1011e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen int i; 1012e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen 1013e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen for (i = width; i--;) 1014e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen { 1015e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen 1016e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen FrameToMosaic(trs, (double) i, 0.0, xpos, ypos); 1017e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen ClipRect(xpos, ypos, brect); 1018e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen FrameToMosaic(trs, (double) i, lasty, xpos, ypos); 1019e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen ClipRect(xpos, ypos, brect); 1020e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen } 1021e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen for (i = height; i--;) 1022e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen { 1023e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen FrameToMosaic(trs, 0.0, (double) i, xpos, ypos); 1024e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen ClipRect(xpos, ypos, brect); 1025e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen FrameToMosaic(trs, lastx, (double) i, xpos, ypos); 1026e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen ClipRect(xpos, ypos, brect); 1027e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen } 1028e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen} 1029e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen 1030b28b9c0fa991bc97e8aa11da83d27f71fdfef6dambansalvoid Blend::SelectRelevantFrames(MosaicFrame **frames, int frames_size, 1031b28b9c0fa991bc97e8aa11da83d27f71fdfef6dambansal MosaicFrame **relevant_frames, int &relevant_frames_size) 1032b28b9c0fa991bc97e8aa11da83d27f71fdfef6dambansal{ 1033b28b9c0fa991bc97e8aa11da83d27f71fdfef6dambansal MosaicFrame *first = frames[0]; 1034b28b9c0fa991bc97e8aa11da83d27f71fdfef6dambansal MosaicFrame *last = frames[frames_size-1]; 1035b28b9c0fa991bc97e8aa11da83d27f71fdfef6dambansal MosaicFrame *mb; 1036b28b9c0fa991bc97e8aa11da83d27f71fdfef6dambansal 1037b28b9c0fa991bc97e8aa11da83d27f71fdfef6dambansal double fxpos = first->trs[0][2], fypos = first->trs[1][2]; 1038b28b9c0fa991bc97e8aa11da83d27f71fdfef6dambansal 1039b28b9c0fa991bc97e8aa11da83d27f71fdfef6dambansal double midX = last->width / 2.0; 1040b28b9c0fa991bc97e8aa11da83d27f71fdfef6dambansal double midY = last->height / 2.0; 1041b28b9c0fa991bc97e8aa11da83d27f71fdfef6dambansal double z = ProjZ(first->trs, midX, midY, 1.0); 1042b28b9c0fa991bc97e8aa11da83d27f71fdfef6dambansal double firstX, firstY; 1043b28b9c0fa991bc97e8aa11da83d27f71fdfef6dambansal double prevX = firstX = ProjX(first->trs, midX, midY, z, 1.0); 1044b28b9c0fa991bc97e8aa11da83d27f71fdfef6dambansal double prevY = firstY = ProjY(first->trs, midX, midY, z, 1.0); 1045b28b9c0fa991bc97e8aa11da83d27f71fdfef6dambansal 1046b28b9c0fa991bc97e8aa11da83d27f71fdfef6dambansal relevant_frames[0] = first; // Add first frame by default 1047b28b9c0fa991bc97e8aa11da83d27f71fdfef6dambansal relevant_frames_size = 1; 1048b28b9c0fa991bc97e8aa11da83d27f71fdfef6dambansal 1049b28b9c0fa991bc97e8aa11da83d27f71fdfef6dambansal for (int i = 0; i < frames_size - 1; i++) 1050b28b9c0fa991bc97e8aa11da83d27f71fdfef6dambansal { 1051b28b9c0fa991bc97e8aa11da83d27f71fdfef6dambansal mb = frames[i]; 1052b28b9c0fa991bc97e8aa11da83d27f71fdfef6dambansal double currX, currY; 1053b28b9c0fa991bc97e8aa11da83d27f71fdfef6dambansal z = ProjZ(mb->trs, midX, midY, 1.0); 1054b28b9c0fa991bc97e8aa11da83d27f71fdfef6dambansal currX = ProjX(mb->trs, midX, midY, z, 1.0); 1055b28b9c0fa991bc97e8aa11da83d27f71fdfef6dambansal currY = ProjY(mb->trs, midX, midY, z, 1.0); 1056b28b9c0fa991bc97e8aa11da83d27f71fdfef6dambansal double deltaX = currX - prevX; 1057b28b9c0fa991bc97e8aa11da83d27f71fdfef6dambansal double deltaY = currY - prevY; 1058b28b9c0fa991bc97e8aa11da83d27f71fdfef6dambansal double center2centerDist = sqrt(deltaY * deltaY + deltaX * deltaX); 1059b28b9c0fa991bc97e8aa11da83d27f71fdfef6dambansal 1060b28b9c0fa991bc97e8aa11da83d27f71fdfef6dambansal if (fabs(deltaX) > STRIP_SEPARATION_THRESHOLD * last->width) 1061b28b9c0fa991bc97e8aa11da83d27f71fdfef6dambansal { 1062b28b9c0fa991bc97e8aa11da83d27f71fdfef6dambansal relevant_frames[relevant_frames_size] = mb; 1063b28b9c0fa991bc97e8aa11da83d27f71fdfef6dambansal relevant_frames_size++; 1064b28b9c0fa991bc97e8aa11da83d27f71fdfef6dambansal 1065b28b9c0fa991bc97e8aa11da83d27f71fdfef6dambansal prevX = currX; 1066b28b9c0fa991bc97e8aa11da83d27f71fdfef6dambansal prevY = currY; 1067b28b9c0fa991bc97e8aa11da83d27f71fdfef6dambansal } 1068b28b9c0fa991bc97e8aa11da83d27f71fdfef6dambansal } 1069e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen 1070b28b9c0fa991bc97e8aa11da83d27f71fdfef6dambansal // Add last frame by default 1071b28b9c0fa991bc97e8aa11da83d27f71fdfef6dambansal relevant_frames[relevant_frames_size] = last; 1072b28b9c0fa991bc97e8aa11da83d27f71fdfef6dambansal relevant_frames_size++; 1073b28b9c0fa991bc97e8aa11da83d27f71fdfef6dambansal} 1074e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen 1075e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chenvoid Blend::ComputeBlendParameters(MosaicFrame **frames, int frames_size, int is360) 1076e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen{ 10776c5b20113ba9f91352f32e5a53df66aec0ec761ambansal // For FULL and PAN modes, we do not unwarp the mosaic into a rectangular coordinate system 10786c5b20113ba9f91352f32e5a53df66aec0ec761ambansal // and so we set the theta to 0 and return. 1079e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen if (m_wb.blendingType != BLEND_TYPE_CYLPAN && m_wb.blendingType != BLEND_TYPE_HORZ) 1080e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen { 1081e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen m_wb.theta = 0.0; 1082e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen return; 1083e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen } 1084e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen 1085e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen MosaicFrame *first = frames[0]; 1086e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen MosaicFrame *last = frames[frames_size-1]; 1087e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen MosaicFrame *mb; 1088e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen 10891e762b1f935c9d4a06af6dd56121590ca81d48b1mbansal double lxpos = last->trs[0][2], lypos = last->trs[1][2]; 10901e762b1f935c9d4a06af6dd56121590ca81d48b1mbansal double fxpos = first->trs[0][2], fypos = first->trs[1][2]; 1091e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen 1092e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen // Calculate warp to produce proper stitching. 1093e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen // get x, y displacement 1094e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen double midX = last->width / 2.0; 1095e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen double midY = last->height / 2.0; 1096e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen double z = ProjZ(first->trs, midX, midY, 1.0); 1097e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen double firstX, firstY; 1098e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen double prevX = firstX = ProjX(first->trs, midX, midY, z, 1.0); 1099e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen double prevY = firstY = ProjY(first->trs, midX, midY, z, 1.0); 1100e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen 1101e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen double arcLength, lastTheta; 1102e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen m_wb.theta = lastTheta = arcLength = 0.0; 11036c5b20113ba9f91352f32e5a53df66aec0ec761ambansal 11046c5b20113ba9f91352f32e5a53df66aec0ec761ambansal // Step through all the frames to compute the total arc-length of the cone 11056c5b20113ba9f91352f32e5a53df66aec0ec761ambansal // swept while capturing the mosaic (in the original conical coordinate system). 1106e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen for (int i = 0; i < frames_size; i++) 1107e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen { 1108e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen mb = frames[i]; 1109e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen double currX, currY; 1110e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen z = ProjZ(mb->trs, midX, midY, 1.0); 1111e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen currX = ProjX(mb->trs, midX, midY, z, 1.0); 1112e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen currY = ProjY(mb->trs, midX, midY, z, 1.0); 1113e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen double deltaX = currX - prevX; 1114e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen double deltaY = currY - prevY; 11156c5b20113ba9f91352f32e5a53df66aec0ec761ambansal 11166c5b20113ba9f91352f32e5a53df66aec0ec761ambansal // The arcLength is computed by summing the lengths of the chords 11176c5b20113ba9f91352f32e5a53df66aec0ec761ambansal // connecting the pairwise projected image centers of the input image frames. 1118e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen arcLength += sqrt(deltaY * deltaY + deltaX * deltaX); 11196c5b20113ba9f91352f32e5a53df66aec0ec761ambansal 1120e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen if (!is360) 1121e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen { 1122e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen double thisTheta = asin(mb->trs[1][0]); 1123e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen m_wb.theta += thisTheta - lastTheta; 1124e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen lastTheta = thisTheta; 1125e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen } 11266c5b20113ba9f91352f32e5a53df66aec0ec761ambansal 1127e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen prevX = currX; 1128e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen prevY = currY; 1129e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen } 1130e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen 11316c5b20113ba9f91352f32e5a53df66aec0ec761ambansal // Stretch this to end at the proper alignment i.e. the width of the 11326c5b20113ba9f91352f32e5a53df66aec0ec761ambansal // rectangle is determined by the arcLength computed above and the cone 11336c5b20113ba9f91352f32e5a53df66aec0ec761ambansal // sector angle is determined using the rotation of the last frame. 1134e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen m_wb.width = arcLength; 1135e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen if (is360) m_wb.theta = asin(last->trs[1][0]); 1136e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen 1137e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen // If there is no rotation, we're done. 1138e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen if (m_wb.theta != 0.0) 1139e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen { 1140e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen double dx = prevX - firstX; 1141e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen double dy = prevY - firstY; 11426c5b20113ba9f91352f32e5a53df66aec0ec761ambansal 11436c5b20113ba9f91352f32e5a53df66aec0ec761ambansal // If the mosaic was captured by sweeping horizontally 1144e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen if (abs(lxpos - fxpos) > abs(lypos - fypos)) 1145e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen { 1146e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen m_wb.horizontal = 1; 1147e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen // Calculate radius position to make ends exactly the same Y offset 1148e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen double radiusTheta = dx / cos(3.14159 / 2.0 - m_wb.theta); 1149e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen m_wb.radius = dy + radiusTheta * cos(m_wb.theta); 1150e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen if (m_wb.radius < 0.0) m_wb.radius = -m_wb.radius; 1151e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen } 1152e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen else 1153e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen { 1154e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen m_wb.horizontal = 0; 1155e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen // Calculate radius position to make ends exactly the same Y offset 1156e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen double radiusTheta = dy / cos(3.14159 / 2.0 - m_wb.theta); 1157e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen m_wb.radius = dx + radiusTheta * cos(m_wb.theta); 1158e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen if (m_wb.radius < 0.0) m_wb.radius = -m_wb.radius; 1159e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen } 1160e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen 1161e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen // Determine major direction 1162e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen if (m_wb.horizontal) 1163e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen { 1164e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen // Horizontal strip 11656c5b20113ba9f91352f32e5a53df66aec0ec761ambansal // m_wb.x,y record the origin of the rectangle coordinate system. 1166e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen if (is360) m_wb.x = firstX; 1167e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen else 1168e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen { 1169e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen if (lxpos - fxpos < 0) 1170e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen { 1171e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen m_wb.x = firstX + midX; 1172e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen z = ProjZ(last->trs, 0.0, midY, 1.0); 1173e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen prevX = ProjX(last->trs, 0.0, midY, z, 1.0); 1174e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen prevY = ProjY(last->trs, 0.0, midY, z, 1.0); 1175e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen } 1176e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen else 1177e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen { 1178e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen m_wb.x = firstX - midX; 1179e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen z = ProjZ(last->trs, last->width - 1.0, midY, 1.0); 1180e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen prevX = ProjX(last->trs, last->width - 1.0, midY, z, 1.0); 1181e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen prevY = ProjY(last->trs, last->width - 1.0, midY, z, 1.0); 1182e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen } 1183e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen } 1184e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen dy = prevY - firstY; 1185e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen if (dy < 0.0) m_wb.direction = 1.0; 1186e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen else m_wb.direction = -1.0; 1187e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen m_wb.y = firstY - m_wb.radius * m_wb.direction; 1188e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen if (dy * m_wb.theta > 0.0) m_wb.width = -m_wb.width; 1189e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen } 1190e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen else 1191e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen { 1192e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen // Vertical strip 1193e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen if (is360) m_wb.y = firstY; 1194e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen else 1195e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen { 1196e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen if (lypos - fypos < 0) 1197e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen { 1198e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen m_wb.x = firstY + midY; 1199e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen z = ProjZ(last->trs, midX, 0.0, 1.0); 1200e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen prevX = ProjX(last->trs, midX, 0.0, z, 1.0); 1201e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen prevY = ProjY(last->trs, midX, 0.0, z, 1.0); 1202e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen } 1203e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen else 1204e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen { 1205e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen m_wb.x = firstX - midX; 1206e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen z = ProjZ(last->trs, midX, last->height - 1.0, 1.0); 1207e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen prevX = ProjX(last->trs, midX, last->height - 1.0, z, 1.0); 1208e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen prevY = ProjY(last->trs, midX, last->height - 1.0, z, 1.0); 1209e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen } 1210e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen } 1211e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen dx = prevX - firstX; 1212e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen if (dx < 0.0) m_wb.direction = 1.0; 1213e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen else m_wb.direction = -1.0; 1214e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen m_wb.x = firstX - m_wb.radius * m_wb.direction; 1215e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen if (dx * m_wb.theta > 0.0) m_wb.width = -m_wb.width; 1216e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen } 1217e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen 1218e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen // Calculate the correct correction factor 1219e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen double deltaX = prevX - m_wb.x; 1220e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen double deltaY = prevY - m_wb.y; 1221e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen double length = sqrt(deltaX * deltaX + deltaY * deltaY); 1222e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen double deltaTheta = (m_wb.horizontal) ? deltaX : deltaY; 1223e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen deltaTheta = asin(deltaTheta / length); 1224e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen m_wb.correction = ((m_wb.radius - length) * m_wb.direction) / 1225e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen (deltaTheta / m_wb.theta); 1226e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen } 1227e295e32b68cf04f0d99138bf4a6d25555f3aef99Wei-Ta Chen} 1228