coordinateconversions.h 2.04 KB
Newer Older
1 2 3 4 5 6 7 8 9 10 11 12 13 14 15 16 17 18 19 20 21 22 23 24 25 26 27 28 29 30 31 32 33 34 35 36 37 38 39 40 41 42 43 44 45 46 47 48 49 50 51 52 53 54 55 56 57 58
/**
 ******************************************************************************
 *
 * @file       coordinateconversions.h
 * @author     The OpenPilot Team, http://www.openpilot.org Copyright (C) 2010.
 *             Parts by Nokia Corporation (qt-info@nokia.com) Copyright (C) 2009.
 * @brief
 * @see        The GNU Public License (GPL) Version 3
 * @defgroup
 * @{
 *
 *****************************************************************************/
/*
 * This program is free software; you can redistribute it and/or modify
 * it under the terms of the GNU General Public License as published by
 * the Free Software Foundation; either version 3 of the License, or
 * (at your option) any later version.
 *
 * This program is distributed in the hope that it will be useful, but
 * WITHOUT ANY WARRANTY; without even the implied warranty of MERCHANTABILITY
 * or FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License
 * for more details.
 *
 * You should have received a copy of the GNU General Public License along
 * with this program; if not, write to the Free Software Foundation, Inc.,
 * 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA
 */

#ifndef COORDINATECONVERSIONS_H
#define COORDINATECONVERSIONS_H

#include "utils_global.h"
#ifndef EXTERNAL_USE
#include "../extensionsystem/pluginmanager.h"
#include "../../plugins/uavobjects/uavobjectmanager.h"
#include "../../plugins/uavobjects/uavobject.h"
#endif
#include "math.h"

namespace Utils {

class QTCREATOR_UTILS_EXPORT CoordinateConversions
{
public:
    CoordinateConversions();
    int GetLLA(double LLA[3], double NED[3], double position[3]);
    void RneFromLLA(double LLA[3], double Rne[3][3]);
    void LLA2ECEF(double LLA[3], double ECEF[3]);
    int ECEF2LLA(double ECEF[3], double LLA[3]);
    void LLA2Base(double LLA[3], double BaseECEF[3], float Rne[3][3], float NED[3]);
    void Quaternion2RPY(const float q[4], float rpy[3]);
    void RPY2Quaternion(const float rpy[3], float q[4]);
    void Quaternion2R(const float q[4], float Rbe[3][3]);
};

}

#endif /* COORDINATECONVERSIONS_H */