boofcv.alg.geo.impl.ImplRectifyImageOps_F32 Maven / Gradle / Ivy
Go to download
Show more of this group Show more artifacts with this name
Show all versions of boofcv-geo Show documentation
Show all versions of boofcv-geo Show documentation
BoofCV is an open source Java library for real-time computer vision and robotics applications.
/*
* Copyright (c) 2020, Peter Abeles. All Rights Reserved.
*
* This file is part of BoofCV (http://boofcv.org).
*
* Licensed under the Apache License, Version 2.0 (the "License");
* you may not use this file except in compliance with the License.
* You may obtain a copy of the License at
*
* http://www.apache.org/licenses/LICENSE-2.0
*
* Unless required by applicable law or agreed to in writing, software
* distributed under the License is distributed on an "AS IS" BASIS,
* WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied.
* See the License for the specific language governing permissions and
* limitations under the License.
*/
package boofcv.alg.geo.impl;
import javax.annotation.Generated;
import boofcv.alg.distort.DistortImageOps;
import boofcv.alg.distort.LensDistortionOps_F32;
import boofcv.alg.distort.PointTransformHomography_F32;
import boofcv.alg.distort.pinhole.PinholePtoN_F32;
import boofcv.struct.calib.CameraPinholeBrown;
import boofcv.struct.distort.Point2Transform2_F32;
import boofcv.struct.distort.PointToPixelTransform_F32;
import boofcv.struct.distort.SequencePoint2Transform2_F32;
import boofcv.struct.image.ImageDimension;
import georegression.struct.point.Point2D_F32;
import georegression.struct.shapes.RectangleLength2D_F32;
import org.ejml.data.FMatrixRMaj;
import org.ejml.dense.row.CommonOps_FDRM;
import org.ejml.simple.SimpleMatrix;
import static boofcv.factory.distort.LensDistortionFactory.narrow;
/**
*
* Implementation of functions inside of {@link boofcv.alg.geo.RectifyImageOps} for 32-bit floats
*
*
* @author Peter Abeles
*/
@Generated("boofcv.alg.geo.impl.ImplRectifyImageOps_F64")
public class ImplRectifyImageOps_F32 {
public static void fullViewLeft( CameraPinholeBrown paramLeft,
FMatrixRMaj rectifyLeft, FMatrixRMaj rectifyRight,
FMatrixRMaj rectifyK, ImageDimension rectifiedSize ) {
// need to take in account the order in which image distort will remove rectification later on
paramLeft = new CameraPinholeBrown(paramLeft);
Point2Transform2_F32 tranLeft = transformPixelToRect(paramLeft, rectifyLeft);
Point2D_F32 work = new Point2D_F32();
RectangleLength2D_F32 bound = DistortImageOps.boundBox_F32(paramLeft.width, paramLeft.height,
new PointToPixelTransform_F32(tranLeft), work);
// Select scale to maintain the same number of pixels
float scale = (float)Math.sqrt((paramLeft.width*paramLeft.height)/(bound.width*bound.height));
rectifiedSize.width = (int)(scale*bound.width + 0.5f);
rectifiedSize.height = (int)(scale*bound.height + 0.5f);
adjustCalibrated(rectifyLeft, rectifyRight, rectifyK, bound, scale);
}
public static void fullViewLeft( int imageWidth, int imageHeight,
FMatrixRMaj rectifyLeft, FMatrixRMaj rectifyRight ) {
Point2Transform2_F32 tranLeft = new PointTransformHomography_F32(rectifyLeft);
Point2D_F32 work = new Point2D_F32();
RectangleLength2D_F32 bound = DistortImageOps.boundBox_F32(imageWidth, imageHeight,
new PointToPixelTransform_F32(tranLeft), work);
float scaleX = imageWidth/bound.width;
float scaleY = imageHeight/bound.height;
float scale = (float)Math.min(scaleX, scaleY);
adjustUncalibrated(rectifyLeft, rectifyRight, bound, scale);
}
public static void allInsideLeft( CameraPinholeBrown paramLeft,
FMatrixRMaj rectifyLeft, FMatrixRMaj rectifyRight,
FMatrixRMaj rectifyK, ImageDimension rectifiedSize ) {
// need to take in account the order in which image distort will remove rectification later on
paramLeft = new CameraPinholeBrown(paramLeft);
Point2Transform2_F32 tranLeft = transformPixelToRect(paramLeft, rectifyLeft);
Point2D_F32 work = new Point2D_F32();
RectangleLength2D_F32 bound = LensDistortionOps_F32.boundBoxInside(paramLeft.width, paramLeft.height,
new PointToPixelTransform_F32(tranLeft), work);
LensDistortionOps_F32.roundInside(bound);
// Select scale to maintain the same number of pixels
float scale = (float)Math.sqrt((paramLeft.width*paramLeft.height)/(bound.width*bound.height));
rectifiedSize.width = (int)(scale*bound.width + 0.5f);
rectifiedSize.height = (int)(scale*bound.height + 0.5f);
adjustCalibrated(rectifyLeft, rectifyRight, rectifyK, bound, scale);
}
public static void allInsideLeft( int imageWidth, int imageHeight,
FMatrixRMaj rectifyLeft, FMatrixRMaj rectifyRight ) {
PointTransformHomography_F32 tranLeft = new PointTransformHomography_F32(rectifyLeft);
Point2D_F32 work = new Point2D_F32();
RectangleLength2D_F32 bound = LensDistortionOps_F32.boundBoxInside(imageWidth, imageHeight,
new PointToPixelTransform_F32(tranLeft), work);
float scaleX = imageWidth/bound.width;
float scaleY = imageHeight/bound.height;
float scale = (float)Math.max(scaleX, scaleY);
adjustUncalibrated(rectifyLeft, rectifyRight, bound, scale);
}
/**
* Internal function which applies the rectification adjustment to a calibrated stereo pair
*/
private static void adjustCalibrated( FMatrixRMaj rectifyLeft, FMatrixRMaj rectifyRight,
FMatrixRMaj rectifyK,
RectangleLength2D_F32 bound, float scale ) {
// translation
float deltaX = -bound.x0*scale;
float deltaY = -bound.y0*scale;
// adjustment matrix
SimpleMatrix A = new SimpleMatrix(3, 3, true, new float[]{scale, 0, deltaX, 0, scale, deltaY, 0, 0, 1});
SimpleMatrix rL = SimpleMatrix.wrap(rectifyLeft);
SimpleMatrix rR = SimpleMatrix.wrap(rectifyRight);
SimpleMatrix K = SimpleMatrix.wrap(rectifyK);
// remove previous calibration matrix
SimpleMatrix K_inv = K.invert();
rL = K_inv.mult(rL);
rR = K_inv.mult(rR);
// compute new calibration matrix and apply it
K = A.mult(K);
rectifyK.setTo(K.getFDRM());
rectifyLeft.setTo(K.mult(rL).getFDRM());
rectifyRight.setTo(K.mult(rR).getFDRM());
}
/**
* Internal function which applies the rectification adjustment to an uncalibrated stereo pair
*/
private static void adjustUncalibrated( FMatrixRMaj rectifyLeft, FMatrixRMaj rectifyRight,
RectangleLength2D_F32 bound, float scale ) {
// translation
float deltaX = -bound.x0*scale;
float deltaY = -bound.y0*scale;
// adjustment matrix
SimpleMatrix A = new SimpleMatrix(3, 3, true, new float[]{scale, 0, deltaX, 0, scale, deltaY, 0, 0, 1});
SimpleMatrix rL = SimpleMatrix.wrap(rectifyLeft);
SimpleMatrix rR = SimpleMatrix.wrap(rectifyRight);
rectifyLeft.setTo(A.mult(rL).getFDRM());
rectifyRight.setTo(A.mult(rR).getFDRM());
}
public static Point2Transform2_F32 transformRectToPixel( CameraPinholeBrown param,
FMatrixRMaj rectify ) {
Point2Transform2_F32 add_p_to_p = narrow(param).distort_F32(true, true);
FMatrixRMaj rectifyInv = new FMatrixRMaj(3, 3);
CommonOps_FDRM.invert(rectify, rectifyInv);
PointTransformHomography_F32 removeRect = new PointTransformHomography_F32(rectifyInv);
return new SequencePoint2Transform2_F32(removeRect, add_p_to_p);
}
public static Point2Transform2_F32 transformPixelToRect( CameraPinholeBrown param,
FMatrixRMaj rectify ) {
Point2Transform2_F32 remove_p_to_p = narrow(param).undistort_F32(true, true);
PointTransformHomography_F32 rectifyDistort = new PointTransformHomography_F32(rectify);
return new SequencePoint2Transform2_F32(remove_p_to_p, rectifyDistort);
}
public static Point2Transform2_F32 transformPixelToRectNorm( CameraPinholeBrown param,
FMatrixRMaj rectify,
FMatrixRMaj rectifyK ) {
if (rectifyK.get(0, 1) != 0)
throw new IllegalArgumentException("Skew should be zero in rectified images");
Point2Transform2_F32 remove_p_to_p = narrow(param).undistort_F32(true, true);
PointTransformHomography_F32 rectifyDistort = new PointTransformHomography_F32(rectify);
PinholePtoN_F32 pixelToNorm = new PinholePtoN_F32();
pixelToNorm.setK(rectifyK.get(0, 0), rectifyK.get(1, 1),
rectifyK.get(0, 1),
rectifyK.get(0, 2), rectifyK.get(1, 2));
return new SequencePoint2Transform2_F32(remove_p_to_p, rectifyDistort, pixelToNorm);
}
}