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