RangingAndRssiFingerprintLocated.java

/*
 * Copyright (C) 2018 Alberto Irurueta Carro (alberto@irurueta.com)
 *
 * 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 com.irurueta.navigation.indoor;

import com.irurueta.algebra.Matrix;
import com.irurueta.geometry.Point;

import java.util.List;

/**
 * Contains located ranging and RSSI readings from several radio sources.
 *
 * @param <S> a {@link RadioSource} type.
 * @param <P> a {@link Point} type.
 * @param <R> a {@link RangingReading} type.
 */
public class RangingAndRssiFingerprintLocated<S extends RadioSource, R extends RangingAndRssiReading<S>,
        P extends Point<?>> extends RangingAndRssiFingerprint<S, R> implements FingerprintLocated<P> {

    /**
     * Position where fingerprint readings were made.
     */
    private P position;

    /**
     * Covariance of inhomogeneous coordinates of current
     * position (if available).
     */
    private Matrix positionCovariance;

    /**
     * Constructor.
     *
     * @param readings non-located ranging and RSSI readings defining the
     *                 fingerprint.
     * @param position position where readings were made.
     * @throws IllegalArgumentException if either readings or position are
     *                                  null.
     */
    public RangingAndRssiFingerprintLocated(final List<R> readings, final P position) {
        super(readings);

        if (position == null) {
            throw new IllegalArgumentException();
        }

        this.position = position;
    }

    /**
     * Constructor.
     *
     * @param readings           non-located ranging and RSSI readings defining the
     *                           fingerprint.
     * @param position           position where readings were made.
     * @param positionCovariance covariance of inhomogeneous coordinates of current
     *                           position (if available).
     * @throws IllegalArgumentException if either readings or position are null, or
     *                                  covariance has invalid size.
     */
    public RangingAndRssiFingerprintLocated(final List<R> readings, final P position, final Matrix positionCovariance) {
        this(readings, position);

        if (positionCovariance != null) {
            final var dims = position.getDimensions();
            if (positionCovariance.getRows() != dims || positionCovariance.getColumns() != dims) {
                throw new IllegalArgumentException();
            }
        }
        this.positionCovariance = positionCovariance;
    }

    /**
     * Empty constructor.
     */
    public RangingAndRssiFingerprintLocated() {
        super();
    }

    /**
     * Gets position where fingerprint readings were made.
     *
     * @return position where fingerprint readings were made.
     */
    public P getPosition() {
        return position;
    }

    /**
     * Gets covariance of inhomogeneous coordinates of current position (if available).
     *
     * @return covariance of position or null.
     */
    public Matrix getPositionCovariance() {
        return positionCovariance;
    }
}