CoordinateTransform.h

Go to the documentation of this file.

/*
 *  Copyright (c) 2018, Martin Duy Tat
 *  All rights reserved.
 *  Redistribution and use in source and binary forms, with or without
 *  modification, are permitted provided that the following conditions are met:
 *  1. Redistributions of source code must retain the above copyright notice,
 *     this list of conditions and the following disclaimer.
 *  2. Redistributions in binary form must reproduce the above copyright notice,
 *     this list of conditions and the following disclaimer in the documentation
 *     and/or other materials provided with the distribution.
 *  3. Neither the name of STFC nor the names of its contributors may be used to
 *     endorse or promote products derived from this software without specific
 *     prior written permission.
 *
 *  THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS"
 *  AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
 *  IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
 *  ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR CONTRIBUTORS BE
 *  LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
 *  CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
 *  SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
 *  INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
 *  CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
 *  ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
 *  POSSIBILITY OF SUCH DAMAGE.
 */

#ifndef COORDINATE_TRANSFORM_H
#define COORDINATE_TRANSFORM_H

#include <vector>

namespace coordinatetransform {

struct myParams {
    double s_0;
    double lambdaleft;
    double lambdaright;
    double rho;
};

class CoordinateTransform {
public:
    CoordinateTransform() = delete;
    CoordinateTransform(const double &xlab,
                        const double &ylab,
                        const double &zlab,
                        const double &s_0,
                        const double &lambdaleft,
                        const double &lambdaright,
                        const double &rho);
    CoordinateTransform(const CoordinateTransform &transform);
    ~CoordinateTransform();
    CoordinateTransform& operator= (const CoordinateTransform &transform);
    std::vector<double> getTransformation() const;
    std::vector<double> calcReferenceTrajectory(const double &s) const;
    std::vector<double> getUnitTangentVector(const double &s) const;
private:
    void calcSCoordinate(const double &xlab, const double &ylab);
    void calcXCoordinate(const double &xlab, const double &ylab);
    void transformFromEntranceCoordinates(std::vector<double> &coordinates,
                                          const double &boundingBoxLength);
    double s_0_m;
    double lambdaleft_m;
    double lambdaright_m;
    double rho_m;
    double x_m;
    double z_m;
    double s_m;
    static const double error;
    static const int workspaceSize;
    static const int algorithm;
};

double getUnitTangentVectorX(double s, void *p);
double getUnitTangentVectorY(double s, void *p);

}
#endif