rooty/LibrePilot
1
0
Fork 0
mirror of https://bitbucket.org/librepilot/librepilot.git synced 2025-01-18 03:52:11 +01:00
Code Issues Releases Activity

Includes example usage of the WorldMagModel module.

Browse Source 
git-svn-id: svn://svn.openpilot.org/OpenPilot/trunk@2517 ebee16cc-31ac-478f-84a7-5cbb03baadba
This commit is contained in:
pip 2011-01-21 20:49:51 +00:00 committed by pip
parent 06cb1da246
commit 9da3ccc708
1 changed files with 31 additions and 8 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

39
ground/src/plugins/opmap/opmapgadgetwidget.cpp
View File

@ -36,9 +36,12 @@
#include <QStringList> #include <QStringList>
#include <QDir> #include <QDir>
#include <QFile> #include <QFile>
#include <QDateTime>
#include <math.h> #include <math.h>
#include "utils/worldmagmodel.h"
#include "uavtalk/telemetrymanager.h" #include "uavtalk/telemetrymanager.h"
#include "extensionsystem/pluginmanager.h" #include "extensionsystem/pluginmanager.h"
#include "uavobjects/uavobjectmanager.h" #include "uavobjects/uavobjectmanager.h"
@ -46,7 +49,7 @@
#include "uavobjects/positionactual.h" #include "uavobjects/positionactual.h"
#include "uavobjects/homelocation.h" #include "uavobjects/homelocation.h"
//#define allow_manual_home_location_move // #define allow_manual_home_location_move
// ************************************************************************************* // *************************************************************************************
@ -1092,15 +1095,13 @@ void OPMapGadgetWidget::setHome(internals::PointLatLng pos_lat_lon)
// ********* // *********
// #if defined(allow_manual_home_location_move) home_position.coord = internals::PointLatLng(latitude, longitude);
home_position.coord = internals::PointLatLng(latitude, longitude);
m_map->Home->SetCoord(home_position.coord); m_map->Home->SetCoord(home_position.coord);
m_map->Home->RefreshPos(); m_map->Home->RefreshPos();
// move the magic waypoint to keep it within the safe area boundry // move the magic waypoint to keep it within the safe area boundry
keepMagicWaypointWithInSafeArea(); keepMagicWaypointWithInSafeArea();
// #endif
} }
@ -1696,6 +1697,28 @@ void OPMapGadgetWidget::onSetHomeAct_triggered()
return; return;
setHome(context_menu_lat_lon); setHome(context_menu_lat_lon);
// ***************
// calculate the magnetic model
double X, Y, Z;
QDateTime dt = QDateTime::currentDateTimeUtc();
Utils::WorldMagModel *wmm = new Utils::WorldMagModel();
if (wmm)
{
if (wmm->GetMagVector(home_position.coord.Lat(), home_position.coord.Lng(), home_position.altitude, dt.date().month(), dt.date().day(), dt.date().year(), &X, &Y, &Z) >= 0)
{
QString s = "lat:" + QString::number(home_position.coord.Lat(), 'f', 7) + " lon:" + QString::number(home_position.coord.Lng(), 'f', 7);
s += " x:" + QString::number(X, 'f', 2) + " y:" + QString::number(Y, 'f', 2) + " z:" + QString::number(Z, 'f', 2);
qDebug() << "opmap HomePosition WMM .. " << s << endl;
}
delete wmm;
}
// ***************
} }
void OPMapGadgetWidget::onGoHomeAct_triggered() void OPMapGadgetWidget::onGoHomeAct_triggered()