165953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn/* 265953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn * Copyright (C) 2011 The Android Open Source Project 365953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn * 465953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn * Licensed under the Apache License, Version 2.0 (the "License"); 565953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn * you may not use this file except in compliance with the License. 665953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn * You may obtain a copy of the License at 765953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn * 865953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn * http://www.apache.org/licenses/LICENSE-2.0 965953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn * 1065953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn * Unless required by applicable law or agreed to in writing, software 1165953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn * distributed under the License is distributed on an "AS IS" BASIS, 1265953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn * WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied. 1365953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn * See the License for the specific language governing permissions and 1465953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn * limitations under the License. 1565953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn */ 1665953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn 1765953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn 1865953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Rennpackage android.filterpacks.imageproc; 1965953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn 2065953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Rennimport android.filterfw.core.Filter; 2165953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Rennimport android.filterfw.core.FilterContext; 2265953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Rennimport android.filterfw.core.Frame; 2365953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Rennimport android.filterfw.core.FrameFormat; 2465953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Rennimport android.filterfw.core.GenerateFieldPort; 2565953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Rennimport android.filterfw.core.Program; 2665953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Rennimport android.filterfw.core.ShaderProgram; 2765953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Rennimport android.filterfw.format.ImageFormat; 2865953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn 2965953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Rennimport java.lang.Math; 3065953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn 3165953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn/** 3265953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn * @hide 3365953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn */ 3465953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Rennpublic class FisheyeFilter extends Filter { 3565953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn private static final String TAG = "FisheyeFilter"; 3665953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn 3765953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn // This parameter has range between 0 and 1. It controls the effect of radial distortion. 3865953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn // The larger the value, the more prominent the distortion effect becomes (a straight line 3965953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn // becomes a curve). 4065953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn @GenerateFieldPort(name = "scale", hasDefault = true) 4165953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn private float mScale = 0f; 4265953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn 4365953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn @GenerateFieldPort(name = "tile_size", hasDefault = true) 4465953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn private int mTileSize = 640; 4565953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn 4665953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn private Program mProgram; 4765953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn 4865953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn private int mWidth = 0; 4965953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn private int mHeight = 0; 5065953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn private int mTarget = FrameFormat.TARGET_UNSPECIFIED; 5165953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn 5265953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn private static final String mFisheyeShader = 5365953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn "precision mediump float;\n" + 5465953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn "uniform sampler2D tex_sampler_0;\n" + 550a1013229254cdc146d4ce2f4b4aef301b018f09Ruei-sung Lin "uniform vec2 scale;\n" + 5665953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn "uniform float alpha;\n" + 5765953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn "uniform float radius2;\n" + 5865953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn "uniform float factor;\n" + 5965953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn "varying vec2 v_texcoord;\n" + 6065953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn "void main() {\n" + 6165953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn " const float m_pi_2 = 1.570963;\n" + 620a1013229254cdc146d4ce2f4b4aef301b018f09Ruei-sung Lin " vec2 coord = v_texcoord - vec2(0.5, 0.5);\n" + 630a1013229254cdc146d4ce2f4b4aef301b018f09Ruei-sung Lin " float dist = length(coord * scale);\n" + 6465953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn " float radian = m_pi_2 - atan(alpha * sqrt(radius2 - dist * dist), dist);\n" + 650a1013229254cdc146d4ce2f4b4aef301b018f09Ruei-sung Lin " float scalar = radian * factor / dist;\n" + 660a1013229254cdc146d4ce2f4b4aef301b018f09Ruei-sung Lin " vec2 new_coord = coord * scalar + vec2(0.5, 0.5);\n" + 670a1013229254cdc146d4ce2f4b4aef301b018f09Ruei-sung Lin " gl_FragColor = texture2D(tex_sampler_0, new_coord);\n" + 6865953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn "}\n"; 6965953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn 7065953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn public FisheyeFilter(String name) { 7165953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn super(name); 7265953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn } 7365953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn 7465953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn @Override 7565953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn public void setupPorts() { 7665953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn addMaskedInputPort("image", ImageFormat.create(ImageFormat.COLORSPACE_RGBA)); 7765953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn addOutputBasedOnInput("image", "image"); 7865953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn } 7965953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn 8065953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn @Override 8165953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn public FrameFormat getOutputFormat(String portName, FrameFormat inputFormat) { 8265953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn return inputFormat; 8365953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn } 8465953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn 8565953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn public void initProgram(FilterContext context, int target) { 8665953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn switch (target) { 8765953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn case FrameFormat.TARGET_GPU: 8865953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn ShaderProgram shaderProgram = new ShaderProgram(context, mFisheyeShader); 8965953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn shaderProgram.setMaximumTileSize(mTileSize); 9065953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn mProgram = shaderProgram; 9165953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn break; 9265953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn 9365953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn default: 9465953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn throw new RuntimeException("Filter FisheyeFilter does not support frames of " + 9565953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn "target " + target + "!"); 9665953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn } 9765953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn mTarget = target; 9865953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn } 9965953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn 10065953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn @Override 10165953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn public void process(FilterContext context) { 10265953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn // Get input frame 10365953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn Frame input = pullInput("image"); 10465953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn FrameFormat inputFormat = input.getFormat(); 10565953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn 10665953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn // Create output frame 10765953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn Frame output = context.getFrameManager().newFrame(inputFormat); 10865953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn 10965953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn // Create program if not created already 11065953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn if (mProgram == null || inputFormat.getTarget() != mTarget) { 11165953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn initProgram(context, inputFormat.getTarget()); 11265953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn } 11365953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn 11465953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn // Check if the frame size has changed 11565953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn if (inputFormat.getWidth() != mWidth || inputFormat.getHeight() != mHeight) { 11665953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn updateFrameSize(inputFormat.getWidth(), inputFormat.getHeight()); 11765953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn } 11865953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn 11965953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn // Process 12065953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn mProgram.process(input, output); 12165953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn 12265953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn // Push output 12365953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn pushOutput("image", output); 12465953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn 12565953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn // Release pushed frame 12665953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn output.release(); 12765953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn } 12865953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn 12965953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn @Override 13065953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn public void fieldPortValueUpdated(String name, FilterContext context) { 13165953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn if (mProgram != null) { 13265953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn updateProgramParams(); 13365953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn } 13465953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn } 13565953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn 13665953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn private void updateFrameSize(int width, int height) { 13765953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn mWidth = width; 13865953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn mHeight = height; 13965953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn 14065953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn updateProgramParams(); 14165953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn } 14265953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn 14365953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn private void updateProgramParams() { 14465953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn final float pi = 3.14159265f; 1450a1013229254cdc146d4ce2f4b4aef301b018f09Ruei-sung Lin float scale[] = new float[2]; 1460a1013229254cdc146d4ce2f4b4aef301b018f09Ruei-sung Lin if (mWidth > mHeight) { 1470a1013229254cdc146d4ce2f4b4aef301b018f09Ruei-sung Lin scale[0] = 1f; 1480a1013229254cdc146d4ce2f4b4aef301b018f09Ruei-sung Lin scale[1] = ((float) mHeight) / mWidth; 1490a1013229254cdc146d4ce2f4b4aef301b018f09Ruei-sung Lin } else { 1500a1013229254cdc146d4ce2f4b4aef301b018f09Ruei-sung Lin scale[0] = ((float) mWidth) / mHeight; 1510a1013229254cdc146d4ce2f4b4aef301b018f09Ruei-sung Lin scale[1] = 1f; 1520a1013229254cdc146d4ce2f4b4aef301b018f09Ruei-sung Lin } 15365953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn float alpha = mScale * 2.0f + 0.75f; 1540a1013229254cdc146d4ce2f4b4aef301b018f09Ruei-sung Lin float bound2 = 0.25f * (scale[0] * scale[0] + scale[1] * scale[1]); 15565953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn float bound = (float) Math.sqrt(bound2); 15665953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn float radius = 1.15f * bound; 15765953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn float radius2 = radius * radius; 15865953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn float max_radian = 0.5f * pi - 15965953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn (float) Math.atan(alpha / bound * (float) Math.sqrt(radius2 - bound2)); 16065953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn float factor = bound / max_radian; 16165953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn 1620a1013229254cdc146d4ce2f4b4aef301b018f09Ruei-sung Lin mProgram.setHostValue("scale", scale); 16365953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn mProgram.setHostValue("radius2",radius2); 16465953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn mProgram.setHostValue("factor", factor); 1650a1013229254cdc146d4ce2f4b4aef301b018f09Ruei-sung Lin mProgram.setHostValue("alpha", alpha); 16665953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn } 16765953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn} 168