FisheyeFilter.java revision 65953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9
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.KeyValueMap; 2665953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Rennimport android.filterfw.core.NativeProgram; 2765953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Rennimport android.filterfw.core.NativeFrame; 2865953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Rennimport android.filterfw.core.Program; 2965953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Rennimport android.filterfw.core.ShaderProgram; 3065953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Rennimport android.filterfw.format.ImageFormat; 3165953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn 3265953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Rennimport android.util.Log; 3365953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn 3465953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Rennimport java.lang.Math; 3565953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Rennimport java.util.Set; 3665953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn 3765953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn/** 3865953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn * @hide 3965953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn */ 4065953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Rennpublic class FisheyeFilter extends Filter { 4165953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn private static final String TAG = "FisheyeFilter"; 4265953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn 4365953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn // This parameter has range between 0 and 1. It controls the effect of radial distortion. 4465953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn // The larger the value, the more prominent the distortion effect becomes (a straight line 4565953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn // becomes a curve). 4665953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn @GenerateFieldPort(name = "scale", hasDefault = true) 4765953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn private float mScale = 0f; 4865953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn 4965953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn @GenerateFieldPort(name = "tile_size", hasDefault = true) 5065953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn private int mTileSize = 640; 5165953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn 5265953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn private Program mProgram; 5365953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn 5465953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn private int mWidth = 0; 5565953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn private int mHeight = 0; 5665953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn private int mTarget = FrameFormat.TARGET_UNSPECIFIED; 5765953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn 5865953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn private static final String mFisheyeShader = 5965953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn "precision mediump float;\n" + 6065953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn "uniform sampler2D tex_sampler_0;\n" + 6165953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn "uniform vec2 center;\n" + 6265953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn "uniform float alpha;\n" + 6365953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn "uniform float bound;\n" + 6465953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn "uniform float radius2;\n" + 6565953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn "uniform float factor;\n" + 6665953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn "uniform float inv_height;\n" + 6765953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn "uniform float inv_width;\n" + 6865953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn "varying vec2 v_texcoord;\n" + 6965953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn "void main() {\n" + 7065953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn " const float m_pi_2 = 1.570963;\n" + 7165953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn " float dist = distance(gl_FragCoord.xy, center);\n" + 7265953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn " float radian = m_pi_2 - atan(alpha * sqrt(radius2 - dist * dist), dist);\n" + 7365953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn " float scale = radian * factor / dist;\n" + 7465953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn " vec2 new_coord = gl_FragCoord.xy * scale + (1.0 - scale) * center;\n" + 7565953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn " new_coord.x *= inv_width;\n" + 7665953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn " new_coord.y *= inv_height;\n" + 7765953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn " vec4 color = texture2D(tex_sampler_0, new_coord);\n" + 7865953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn " gl_FragColor = color;\n" + 7965953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn "}\n"; 8065953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn 8165953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn public FisheyeFilter(String name) { 8265953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn super(name); 8365953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn } 8465953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn 8565953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn @Override 8665953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn public void setupPorts() { 8765953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn addMaskedInputPort("image", ImageFormat.create(ImageFormat.COLORSPACE_RGBA)); 8865953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn addOutputBasedOnInput("image", "image"); 8965953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn } 9065953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn 9165953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn @Override 9265953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn public FrameFormat getOutputFormat(String portName, FrameFormat inputFormat) { 9365953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn return inputFormat; 9465953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn } 9565953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn 9665953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn public void initProgram(FilterContext context, int target) { 9765953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn switch (target) { 9865953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn case FrameFormat.TARGET_GPU: 9965953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn ShaderProgram shaderProgram = new ShaderProgram(context, mFisheyeShader); 10065953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn shaderProgram.setMaximumTileSize(mTileSize); 10165953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn mProgram = shaderProgram; 10265953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn break; 10365953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn 10465953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn default: 10565953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn throw new RuntimeException("Filter FisheyeFilter does not support frames of " + 10665953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn "target " + target + "!"); 10765953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn } 10865953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn mTarget = target; 10965953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn } 11065953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn 11165953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn @Override 11265953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn public void process(FilterContext context) { 11365953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn // Get input frame 11465953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn Frame input = pullInput("image"); 11565953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn FrameFormat inputFormat = input.getFormat(); 11665953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn 11765953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn // Create output frame 11865953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn Frame output = context.getFrameManager().newFrame(inputFormat); 11965953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn 12065953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn // Create program if not created already 12165953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn if (mProgram == null || inputFormat.getTarget() != mTarget) { 12265953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn initProgram(context, inputFormat.getTarget()); 12365953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn } 12465953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn 12565953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn // Check if the frame size has changed 12665953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn if (inputFormat.getWidth() != mWidth || inputFormat.getHeight() != mHeight) { 12765953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn updateFrameSize(inputFormat.getWidth(), inputFormat.getHeight()); 12865953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn } 12965953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn 13065953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn // Process 13165953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn mProgram.process(input, output); 13265953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn 13365953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn // Push output 13465953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn pushOutput("image", output); 13565953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn 13665953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn // Release pushed frame 13765953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn output.release(); 13865953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn } 13965953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn 14065953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn @Override 14165953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn public void fieldPortValueUpdated(String name, FilterContext context) { 14265953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn if (mProgram != null) { 14365953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn updateProgramParams(); 14465953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn } 14565953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn } 14665953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn 14765953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn private void updateFrameSize(int width, int height) { 14865953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn float center[] = {0.5f * width, 0.5f * height}; 14965953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn 15065953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn mProgram.setHostValue("center", center); 15165953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn mProgram.setHostValue("inv_width", 1.0f / width); 15265953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn mProgram.setHostValue("inv_height", 1.0f / height); 15365953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn 15465953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn mWidth = width; 15565953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn mHeight = height; 15665953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn 15765953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn updateProgramParams(); 15865953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn } 15965953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn 16065953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn private void updateProgramParams() { 16165953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn final float pi = 3.14159265f; 16265953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn 16365953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn float alpha = mScale * 2.0f + 0.75f; 16465953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn float bound2 = 0.25f * (mWidth * mWidth + mHeight * mHeight); 16565953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn float bound = (float) Math.sqrt(bound2); 16665953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn float radius = 1.15f * bound; 16765953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn float radius2 = radius * radius; 16865953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn float max_radian = 0.5f * pi - 16965953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn (float) Math.atan(alpha / bound * (float) Math.sqrt(radius2 - bound2)); 17065953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn float factor = bound / max_radian; 17165953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn 17265953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn mProgram.setHostValue("radius2",radius2); 17365953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn mProgram.setHostValue("factor", factor); 17465953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn mProgram.setHostValue("alpha", (float) (mScale * 2.0 + 0.75)); 17565953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn } 17665953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn 17765953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn 17865953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn} 179