001/**
002 * Copyright (c) 2011, The University of Southampton and the individual contributors.
003 * All rights reserved.
004 *
005 * Redistribution and use in source and binary forms, with or without modification,
006 * are permitted provided that the following conditions are met:
007 *
008 *   *  Redistributions of source code must retain the above copyright notice,
009 *      this list of conditions and the following disclaimer.
010 *
011 *   *  Redistributions in binary form must reproduce the above copyright notice,
012 *      this list of conditions and the following disclaimer in the documentation
013 *      and/or other materials provided with the distribution.
014 *
015 *   *  Neither the name of the University of Southampton nor the names of its
016 *      contributors may be used to endorse or promote products derived from this
017 *      software without specific prior written permission.
018 *
019 * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS" AND
020 * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED
021 * WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE
022 * DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR CONTRIBUTORS BE LIABLE FOR
023 * ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES
024 * (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES;
025 * LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON
026 * ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
027 * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS
028 * SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
029 */
030package org.openimaj.math.geometry.transforms.residuals;
031
032import java.util.List;
033
034import org.openimaj.math.geometry.point.Point2d;
035import org.openimaj.math.model.Model;
036import org.openimaj.math.model.fit.residuals.ResidualCalculator;
037import org.openimaj.util.pair.IndependentPair;
038
039import Jama.Matrix;
040
041/**
042 * An implementation of a {@link SingleImageTransferResidual2d} that
043 * pre-transforms both sets of points by predetermined transforms.
044 * 
045 * @author Jonathon Hare (jsh2@ecs.soton.ac.uk)
046 * 
047 * @param <M>
048 *            type of model
049 * 
050 */
051public class TransformedSITR2d<M extends Model<Point2d, Point2d>> implements ResidualCalculator<Point2d, Point2d, M> {
052        Matrix t1;
053        Matrix t2;
054        M model;
055
056        /**
057         * Construct with the given transforms
058         * 
059         * @param t1
060         *            transform for first point in the pair
061         * @param t2
062         *            transform for second point in the pair
063         */
064        public TransformedSITR2d(Matrix t1, Matrix t2) {
065                this.t1 = t1;
066                this.t2 = t2;
067        }
068
069        @Override
070        public void setModel(M model) {
071                this.model = model;
072        }
073
074        @Override
075        public double computeResidual(IndependentPair<Point2d, Point2d> data) {
076                final Point2d p2_est = model.predict(data.firstObject()).transform(t1);
077
078                final Point2d so = data.secondObject().transform(t2);
079                final float dx = so.getX() - p2_est.getX();
080                final float dy = so.getY() - p2_est.getY();
081
082                return (dx * dx + dy * dy);
083        }
084
085        @Override
086        public void computeResiduals(List<? extends IndependentPair<Point2d, Point2d>> data, double[] errors) {
087                for (int i = 0; i < data.size(); i++) {
088                        final Point2d p2_est = model.predict(data.get(i).firstObject()).transform(t1);
089
090                        final Point2d so = data.get(i).secondObject().transform(t2);
091                        final float dx = so.getX() - p2_est.getX();
092                        final float dy = so.getY() - p2_est.getY();
093
094                        errors[i] = (dx * dx + dy * dy);
095                }
096        }
097}