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