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 Rennimport android.filterfw.geometry.Quad;
2965953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Rennimport android.filterfw.geometry.Point;
3065953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn
3165953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn/**
3265953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn * @hide
3365953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn */
3465953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Rennpublic class StraightenFilter extends Filter {
3565953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn
3665953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn    @GenerateFieldPort(name = "angle", hasDefault = true)
3765953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn    private float mAngle = 0f;
3865953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn
3965953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn    @GenerateFieldPort(name = "maxAngle", hasDefault = true)
4065953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn    private float mMaxAngle = 45f;
4165953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn
4265953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn    @GenerateFieldPort(name = "tile_size", hasDefault = true)
4365953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn    private int mTileSize = 640;
4465953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn
4565953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn    private Program mProgram;
4665953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn
4765953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn    private int mWidth = 0;
4865953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn    private int mHeight = 0;
4965953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn    private int mTarget = FrameFormat.TARGET_UNSPECIFIED;
5065953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn
5165953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn    private static final float DEGREE_TO_RADIAN = (float) Math.PI / 180.0f;
5265953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn
5365953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn    public StraightenFilter(String name) {
5465953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn        super(name);
5565953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn    }
5665953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn
5765953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn    @Override
5865953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn    public void setupPorts() {
5965953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn        addMaskedInputPort("image", ImageFormat.create(ImageFormat.COLORSPACE_RGBA));
6065953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn        addOutputBasedOnInput("image", "image");
6165953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn    }
6265953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn
6365953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn    public void initProgram(FilterContext context, int target) {
6465953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn        switch (target) {
6565953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn            case FrameFormat.TARGET_GPU:
6665953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn                ShaderProgram shaderProgram = ShaderProgram.createIdentity(context);
6765953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn                shaderProgram.setMaximumTileSize(mTileSize);
6865953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn                mProgram = shaderProgram;
6965953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn                break;
7065953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn
7165953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn            default:
7265953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn                throw new RuntimeException("Filter Sharpen does not support frames of " +
7365953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn                    "target " + target + "!");
7465953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn        }
7565953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn        mTarget = target;
7665953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn    }
7765953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn
7865953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn    @Override
7965953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn    public void fieldPortValueUpdated(String name, FilterContext context) {
8065953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn        if (mProgram != null) {
8165953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn            updateParameters();
8265953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn        }
8365953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn    }
8465953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn
8565953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn    @Override
8665953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn    public void process(FilterContext context) {
8765953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn        // Get input frame
8865953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn        Frame input = pullInput("image");
8965953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn        FrameFormat inputFormat = input.getFormat();
9065953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn
9165953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn        // Create program if not created already
9265953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn        if (mProgram == null || inputFormat.getTarget() != mTarget) {
9365953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn            initProgram(context, inputFormat.getTarget());
9465953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn        }
9565953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn
9665953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn        // Create output frame
9765953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn        if (inputFormat.getWidth() != mWidth || inputFormat.getHeight() != mHeight) {
9865953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn            mWidth = inputFormat.getWidth();
9965953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn            mHeight = inputFormat.getHeight();
10065953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn            updateParameters();
10165953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn        }
10265953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn
10365953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn        Frame output = context.getFrameManager().newFrame(inputFormat);
10465953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn
10565953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn        // Process
10665953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn        mProgram.process(input, output);
10765953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn
10865953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn        // Push output
10965953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn        pushOutput("image", output);
11065953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn
11165953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn        // Release pushed frame
11265953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn        output.release();
11365953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn    }
11465953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn
11565953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn    private void updateParameters() {
11665953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn        float cosTheta = (float) Math.cos(mAngle * DEGREE_TO_RADIAN);
11765953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn        float sinTheta = (float) Math.sin(mAngle * DEGREE_TO_RADIAN);
11865953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn
11965953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn        if (mMaxAngle <= 0)
12065953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn            throw new RuntimeException("Max angle is out of range (0-180).");
12165953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn        mMaxAngle = (mMaxAngle > 90) ? 90 : mMaxAngle;
12265953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn
12365953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn        Point p0 = new Point(-cosTheta * mWidth + sinTheta * mHeight,
12465953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn                             -sinTheta * mWidth - cosTheta * mHeight);
12565953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn
12665953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn        Point p1 = new Point(cosTheta * mWidth + sinTheta * mHeight,
12765953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn                             sinTheta * mWidth - cosTheta * mHeight);
12865953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn
12965953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn        Point p2 = new Point(-cosTheta * mWidth - sinTheta * mHeight,
13065953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn                             -sinTheta * mWidth + cosTheta * mHeight);
13165953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn
13265953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn        Point p3 = new Point(cosTheta * mWidth - sinTheta * mHeight,
13365953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn                             sinTheta * mWidth + cosTheta * mHeight);
13465953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn
13565953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn        float maxWidth = (float) Math.max(Math.abs(p0.x), Math.abs(p1.x));
13665953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn        float maxHeight = (float) Math.max(Math.abs(p0.y), Math.abs(p1.y));
13765953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn
13865953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn        float scale = 0.5f * Math.min( mWidth / maxWidth,
13965953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn                                       mHeight / maxHeight);
14065953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn
14165953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn        p0.set(scale * p0.x / mWidth + 0.5f, scale * p0.y / mHeight + 0.5f);
14265953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn        p1.set(scale * p1.x / mWidth + 0.5f, scale * p1.y / mHeight + 0.5f);
14365953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn        p2.set(scale * p2.x / mWidth + 0.5f, scale * p2.y / mHeight + 0.5f);
14465953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn        p3.set(scale * p3.x / mWidth + 0.5f, scale * p3.y / mHeight + 0.5f);
14565953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn
14665953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn        Quad quad = new Quad(p0, p1, p2, p3);
14765953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn        ((ShaderProgram) mProgram).setSourceRegion(quad);
14865953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn    }
14965953da4636fbf5f0a24b8f5f2b5fa7d76ff13d9Marius Renn}
150