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" + 610a1013229254cdc146d4ce2f4b4aef301b018f09Ruei-sung Lin "uniform vec2 scale;\n" + 6265953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn "uniform float alpha;\n" + 6365953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn "uniform float radius2;\n" + 6465953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn "uniform float factor;\n" + 6565953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn "varying vec2 v_texcoord;\n" + 6665953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn "void main() {\n" + 6765953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn " const float m_pi_2 = 1.570963;\n" + 680a1013229254cdc146d4ce2f4b4aef301b018f09Ruei-sung Lin " vec2 coord = v_texcoord - vec2(0.5, 0.5);\n" + 690a1013229254cdc146d4ce2f4b4aef301b018f09Ruei-sung Lin " float dist = length(coord * scale);\n" + 7065953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn " float radian = m_pi_2 - atan(alpha * sqrt(radius2 - dist * dist), dist);\n" + 710a1013229254cdc146d4ce2f4b4aef301b018f09Ruei-sung Lin " float scalar = radian * factor / dist;\n" + 720a1013229254cdc146d4ce2f4b4aef301b018f09Ruei-sung Lin " vec2 new_coord = coord * scalar + vec2(0.5, 0.5);\n" + 730a1013229254cdc146d4ce2f4b4aef301b018f09Ruei-sung Lin " gl_FragColor = texture2D(tex_sampler_0, new_coord);\n" + 7465953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn "}\n"; 7565953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn 7665953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn public FisheyeFilter(String name) { 7765953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn super(name); 7865953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn } 7965953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn 8065953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn @Override 8165953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn public void setupPorts() { 8265953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn addMaskedInputPort("image", ImageFormat.create(ImageFormat.COLORSPACE_RGBA)); 8365953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn addOutputBasedOnInput("image", "image"); 8465953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn } 8565953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn 8665953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn @Override 8765953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn public FrameFormat getOutputFormat(String portName, FrameFormat inputFormat) { 8865953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn return inputFormat; 8965953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn } 9065953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn 9165953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn public void initProgram(FilterContext context, int target) { 9265953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn switch (target) { 9365953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn case FrameFormat.TARGET_GPU: 9465953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn ShaderProgram shaderProgram = new ShaderProgram(context, mFisheyeShader); 9565953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn shaderProgram.setMaximumTileSize(mTileSize); 9665953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn mProgram = shaderProgram; 9765953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn break; 9865953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn 9965953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn default: 10065953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn throw new RuntimeException("Filter FisheyeFilter does not support frames of " + 10165953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn "target " + target + "!"); 10265953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn } 10365953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn mTarget = target; 10465953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn } 10565953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn 10665953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn @Override 10765953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn public void process(FilterContext context) { 10865953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn // Get input frame 10965953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn Frame input = pullInput("image"); 11065953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn FrameFormat inputFormat = input.getFormat(); 11165953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn 11265953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn // Create output frame 11365953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn Frame output = context.getFrameManager().newFrame(inputFormat); 11465953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn 11565953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn // Create program if not created already 11665953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn if (mProgram == null || inputFormat.getTarget() != mTarget) { 11765953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn initProgram(context, inputFormat.getTarget()); 11865953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn } 11965953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn 12065953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn // Check if the frame size has changed 12165953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn if (inputFormat.getWidth() != mWidth || inputFormat.getHeight() != mHeight) { 12265953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn updateFrameSize(inputFormat.getWidth(), inputFormat.getHeight()); 12365953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn } 12465953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn 12565953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn // Process 12665953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn mProgram.process(input, output); 12765953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn 12865953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn // Push output 12965953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn pushOutput("image", output); 13065953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn 13165953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn // Release pushed frame 13265953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn output.release(); 13365953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn } 13465953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn 13565953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn @Override 13665953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn public void fieldPortValueUpdated(String name, FilterContext context) { 13765953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn if (mProgram != null) { 13865953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn updateProgramParams(); 13965953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn } 14065953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn } 14165953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn 14265953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn private void updateFrameSize(int width, int height) { 14365953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn mWidth = width; 14465953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn mHeight = height; 14565953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn 14665953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn updateProgramParams(); 14765953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn } 14865953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn 14965953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn private void updateProgramParams() { 15065953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn final float pi = 3.14159265f; 1510a1013229254cdc146d4ce2f4b4aef301b018f09Ruei-sung Lin float scale[] = new float[2]; 1520a1013229254cdc146d4ce2f4b4aef301b018f09Ruei-sung Lin if (mWidth > mHeight) { 1530a1013229254cdc146d4ce2f4b4aef301b018f09Ruei-sung Lin scale[0] = 1f; 1540a1013229254cdc146d4ce2f4b4aef301b018f09Ruei-sung Lin scale[1] = ((float) mHeight) / mWidth; 1550a1013229254cdc146d4ce2f4b4aef301b018f09Ruei-sung Lin } else { 1560a1013229254cdc146d4ce2f4b4aef301b018f09Ruei-sung Lin scale[0] = ((float) mWidth) / mHeight; 1570a1013229254cdc146d4ce2f4b4aef301b018f09Ruei-sung Lin scale[1] = 1f; 1580a1013229254cdc146d4ce2f4b4aef301b018f09Ruei-sung Lin } 15965953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn float alpha = mScale * 2.0f + 0.75f; 1600a1013229254cdc146d4ce2f4b4aef301b018f09Ruei-sung Lin float bound2 = 0.25f * (scale[0] * scale[0] + scale[1] * scale[1]); 16165953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn float bound = (float) Math.sqrt(bound2); 16265953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn float radius = 1.15f * bound; 16365953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn float radius2 = radius * radius; 16465953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn float max_radian = 0.5f * pi - 16565953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn (float) Math.atan(alpha / bound * (float) Math.sqrt(radius2 - bound2)); 16665953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn float factor = bound / max_radian; 16765953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn 1680a1013229254cdc146d4ce2f4b4aef301b018f09Ruei-sung Lin mProgram.setHostValue("scale", scale); 16965953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn mProgram.setHostValue("radius2",radius2); 17065953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn mProgram.setHostValue("factor", factor); 1710a1013229254cdc146d4ce2f4b4aef301b018f09Ruei-sung Lin mProgram.setHostValue("alpha", alpha); 17265953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn } 17365953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn} 174