rooty/LibrePilot
1
0
Fork 0
mirror of https://bitbucket.org/librepilot/librepilot.git synced 2024-12-12 20:08:48 +01:00
Code Issues Releases Activity
5d07b67922
LibrePilot/ground/openpilotgcs/src/plugins/opmap/modelmapproxy.cpp

337 lines
13 KiB
C++
Raw Blame History

/**
******************************************************************************
*
* @file pathplanmanager.cpp
* @author The OpenPilot Team, http://www.openpilot.org Copyright (C) 2010.
* @addtogroup GCSPlugins GCS Plugins
* @{
* @addtogroup OPMapPlugin OpenPilot Map Plugin
* @{
* @brief The OpenPilot Map plugin
*****************************************************************************/
/*
* 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
*/
#include "modelmapproxy.h"
modelMapProxy::modelMapProxy(QObject *parent,OPMapWidget *map,flightDataModel * model,QItemSelectionModel * selectionModel):QObject(parent),myMap(map),model(model),selection(selectionModel)
{
connect(model,SIGNAL(rowsInserted(const QModelIndex&,int,int)),this,SLOT(on_rowsInserted(const QModelIndex&,int,int)));
connect(model,SIGNAL(rowsRemoved(const QModelIndex&,int,int)),this,SLOT(on_rowsRemoved(const QModelIndex&,int,int)));
connect(selection,SIGNAL(currentRowChanged(QModelIndex,QModelIndex)),this,SLOT(on_currentRowChanged(QModelIndex,QModelIndex)));
connect(model,SIGNAL(dataChanged(QModelIndex,QModelIndex)),this,SLOT(on_dataChanged(QModelIndex,QModelIndex)));
connect(myMap,SIGNAL(selectedWPChanged(QList<WayPointItem*>)),this,SLOT(on_selectedWPChanged(QList<WayPointItem*>)));
connect(myMap,SIGNAL(WPValuesChanged(WayPointItem*)),this,SLOT(on_WPValuesChanged(WayPointItem*)));
}
void modelMapProxy::on_WPDeleted(int wp_numberint,WayPointItem * wp)
{
}
void modelMapProxy::on_WPInserted(int wp_number, WayPointItem * wp)
{
}
void modelMapProxy::on_WPValuesChanged(WayPointItem * wp)
{
QModelIndex index;
index=model->index(wp->Number(),flightDataModel::LATPOSITION);
if(!index.isValid())
return;
model->setData(index,wp->Coord().Lat(),Qt::EditRole);
index=model->index(wp->Number(),flightDataModel::LNGPOSITION);
model->setData(index,wp->Coord().Lng(),Qt::EditRole);
index=model->index(wp->Number(),flightDataModel::DISRELATIVE);
model->setData(index,wp->getRelativeCoord().distance,Qt::EditRole);
index=model->index(wp->Number(),flightDataModel::BEARELATIVE);
model->setData(index,wp->getRelativeCoord().bearingToDegrees(),Qt::EditRole);
}
void modelMapProxy::on_currentRowChanged(QModelIndex current, QModelIndex previous)
{
QList<WayPointItem*> list;
WayPointItem * wp=findWayPointNumber(current.row());
if(!wp)
return;
list.append(wp);
myMap->setSelectedWP(list);
}
void modelMapProxy::on_selectedWPChanged(QList<WayPointItem *> list)
{
selection->clearSelection();
foreach(WayPointItem * wp,list)
{
QModelIndex index=model->index(wp->Number(),0);
selection->setCurrentIndex(index,QItemSelectionModel::Select | QItemSelectionModel::Rows);
}
}
modelMapProxy::overlayType modelMapProxy::overlayTranslate(int type)
{
switch(type)
{
case ComboBoxDelegate::MODE_FLYENDPOINT:
case ComboBoxDelegate::MODE_FLYVECTOR:
case ComboBoxDelegate::MODE_DRIVEENDPOINT:
case ComboBoxDelegate::MODE_DRIVEVECTOR:
return OVERLAY_LINE;
break;
case ComboBoxDelegate::MODE_FLYCIRCLERIGHT:
case ComboBoxDelegate::MODE_DRIVECIRCLERIGHT:
return OVERLAY_CIRCLE_RIGHT;
break;
case ComboBoxDelegate::MODE_FLYCIRCLELEFT:
case ComboBoxDelegate::MODE_DRIVECIRCLELEFT:
return OVERLAY_CIRCLE_LEFT;
break;
default:
break;
}
}
void modelMapProxy::createOverlay(WayPointItem *from, WayPointItem *to, modelMapProxy::overlayType type,QColor color)
{
if(from==NULL || to==NULL || from==to)
return;
switch(type)
{
case OVERLAY_LINE:
myMap->WPLineCreate(from,to,color);
break;
case OVERLAY_CIRCLE_RIGHT:
myMap->WPCircleCreate(to,from,true,color);
break;
case OVERLAY_CIRCLE_LEFT:
myMap->WPCircleCreate(to,from,false,color);
break;
default:
break;
}
}
/*
typedef enum { MODE_FLYENDPOINT=0, MODE_FLYVECTOR=1, MODE_FLYCIRCLERIGHT=2, MODE_FLYCIRCLELEFT=3,
MODE_DRIVEENDPOINT=4, MODE_DRIVEVECTOR=5, MODE_DRIVECIRCLELEFT=6, MODE_DRIVECIRCLERIGHT=7,
MODE_FIXEDATTITUDE=8, MODE_SETACCESSORY=9, MODE_DISARMALARM=10 } ModeOptions;
typedef enum { ENDCONDITION_NONE=0, ENDCONDITION_TIMEOUT=1, ENDCONDITION_DISTANCETOTARGET=2,
ENDCONDITION_LEGREMAINING=3, ENDCONDITION_ABOVEALTITUDE=4, ENDCONDITION_POINTINGTOWARDSNEXT=5,
ENDCONDITION_PYTHONSCRIPT=6, ENDCONDITION_IMMEDIATE=7 } EndConditionOptions;
typedef enum { COMMAND_ONCONDITIONNEXTWAYPOINT=0, COMMAND_ONNOTCONDITIONNEXTWAYPOINT=1,
COMMAND_ONCONDITIONJUMPWAYPOINT=2, COMMAND_ONNOTCONDITIONJUMPWAYPOINT=3,
COMMAND_IFCONDITIONJUMPWAYPOINTELSENEXTWAYPOINT=4 } CommandOptions;
*/
void modelMapProxy::refreshOverlays()
{
qDebug()<<"REFRESH OVERLAYS START";
myMap->deleteAllOverlays();
WayPointItem * wp_current=NULL;
WayPointItem * wp_next=NULL;
int wp_jump;
int wp_error;
overlayType wp_next_overlay;
overlayType wp_jump_overlay;
overlayType wp_error_overlay;
for(int x=0;x<model->rowCount();++x)
{
qDebug()<<"REFRESH OVERLAYS WP:"<<x;
wp_current=findWayPointNumber(x);
wp_jump=model->data(model->index(x,flightDataModel::JUMPDESTINATION)).toInt();
wp_error=model->data(model->index(x,flightDataModel::ERRORDESTINATION)).toInt();
wp_next_overlay=overlayTranslate(model->data(model->index(x+1,flightDataModel::MODE)).toInt());
wp_jump_overlay=overlayTranslate(model->data(model->index(wp_jump,flightDataModel::MODE)).toInt());
wp_error_overlay=overlayTranslate(model->data(model->index(wp_error,flightDataModel::MODE)).toInt());
createOverlay(wp_current,findWayPointNumber(wp_error),wp_error_overlay,Qt::red);
switch(model->data(model->index(x,flightDataModel::COMMAND)).toInt())
{
case ComboBoxDelegate::COMMAND_ONCONDITIONNEXTWAYPOINT:
wp_next=findWayPointNumber(x+1);
createOverlay(wp_current,wp_next,wp_next_overlay,Qt::green);
qDebug()<<"REFRESH OVERLAYS"<<"AKI0";
break;
case ComboBoxDelegate::COMMAND_ONCONDITIONJUMPWAYPOINT:
wp_next=findWayPointNumber(wp_jump);
createOverlay(wp_current,wp_next,wp_jump_overlay,Qt::green);
qDebug()<<"REFRESH OVERLAYS"<<"AKI1";
break;
case ComboBoxDelegate::COMMAND_ONNOTCONDITIONJUMPWAYPOINT:
wp_next=findWayPointNumber(wp_jump);
createOverlay(wp_current,wp_next,wp_jump_overlay,Qt::yellow);
qDebug()<<"REFRESH OVERLAYS"<<"AKI2";
break;
case ComboBoxDelegate::COMMAND_ONNOTCONDITIONNEXTWAYPOINT:
wp_next=findWayPointNumber(x+1);
createOverlay(wp_current,wp_next,wp_next_overlay,Qt::yellow);
qDebug()<<"REFRESH OVERLAYS"<<"AKI3";
break;
case ComboBoxDelegate::COMMAND_IFCONDITIONJUMPWAYPOINTELSENEXTWAYPOINT:
wp_next=findWayPointNumber(wp_jump);
createOverlay(wp_current,wp_next,wp_jump_overlay,Qt::green);
wp_next=findWayPointNumber(x+1);
createOverlay(wp_current,wp_next,wp_next_overlay,Qt::green);
qDebug()<<"REFRESH OVERLAYS"<<"AKI4";
break;
}
}
}
WayPointItem * modelMapProxy::findWayPointNumber(int number)
{
if(number<0)
return NULL;
return myMap->WPFind(number);
}
/*
WPDESCRITPTION,LATPOSITION,LNGPOSITION,DISRELATIVE,BEARELATIVE,ISRELATIVE,ALTITUDE,
VELOCITY,MODE,MODE_PARAMS0,MODE_PARAMS1,MODE_PARAMS2,MODE_PARAMS3,
CONDITION,CONDITION_PARAMS0,CONDITION_PARAMS1,CONDITION_PARAMS2,CONDITION_PARAMS3,
COMMAND,JUMPDESTINATION,ERRORDESTINATION
*/
void modelMapProxy::on_rowsRemoved(const QModelIndex &parent, int first, int last)
{
qDebug()<<"modelMapProxy::on_rowsRemoved"<<"first"<<first<<"last"<<last;
for(int x=last;x>first-1;x--)
{
myMap->WPDelete(x);
}
refreshOverlays();
}
void modelMapProxy::on_dataChanged(const QModelIndex &topLeft, const QModelIndex &bottomRight)
{
WayPointItem * item=findWayPointNumber(topLeft.row());
if(!item)
return;
internals::PointLatLng latlng;
int x=topLeft.row();
distBearing distBearing;
double altitude;
bool relative;
QModelIndex index;
QString desc;
switch(topLeft.column())
{
case flightDataModel::COMMAND:
case flightDataModel::CONDITION:
case flightDataModel::JUMPDESTINATION:
case flightDataModel::ERRORDESTINATION:
case flightDataModel::MODE:
refreshOverlays();
break;
case flightDataModel::WPDESCRITPTION:
index=model->index(x,flightDataModel::WPDESCRITPTION);
desc=index.data(Qt::DisplayRole).toString();
item->SetDescription(desc);
break;
case flightDataModel::LATPOSITION:
latlng=item->Coord();
index=model->index(x,flightDataModel::LATPOSITION);
latlng.SetLat(index.data(Qt::DisplayRole).toDouble());
item->SetCoord(latlng);
break;
case flightDataModel::LNGPOSITION:
latlng=item->Coord();
index=model->index(x,flightDataModel::LNGPOSITION);
latlng.SetLng(index.data(Qt::DisplayRole).toDouble());
item->SetCoord(latlng);
break;
case flightDataModel::BEARELATIVE:
distBearing=item->getRelativeCoord();
index=model->index(x,flightDataModel::BEARELATIVE);
distBearing.setBearingFromDegrees(index.data(Qt::DisplayRole).toDouble());
break;
case flightDataModel::DISRELATIVE:
distBearing=item->getRelativeCoord();
index=model->index(x,flightDataModel::DISRELATIVE);
distBearing.distance=index.data(Qt::DisplayRole).toDouble();
break;
case flightDataModel::ISRELATIVE:
index=model->index(x,flightDataModel::ISRELATIVE);
relative=index.data(Qt::DisplayRole).toBool();
if(relative)
item->setWPType(mapcontrol::WayPointItem::relative);
break;
case flightDataModel::ALTITUDE:
index=model->index(x,flightDataModel::ALTITUDE);
altitude=index.data(Qt::DisplayRole).toDouble();
item->SetAltitude(altitude);
break;
case flightDataModel::LOCKED:
index=model->index(x,flightDataModel::LOCKED);
item->setFlag(QGraphicsItem::ItemIsMovable,!index.data(Qt::DisplayRole).toBool());
break;
}
}
void modelMapProxy::on_rowsInserted(const QModelIndex &parent, int first, int last)
{
Q_UNUSED(parent);
for(int x=first;x<last+1;x++)
{
QModelIndex index;
WayPointItem * item;
internals::PointLatLng latlng;
distBearing distBearing;
double altitude;
bool relative;
index=model->index(x,flightDataModel::WPDESCRITPTION);
QString desc=index.data(Qt::DisplayRole).toString();
index=model->index(x,flightDataModel::LATPOSITION);
latlng.SetLat(index.data(Qt::DisplayRole).toDouble());
index=model->index(x,flightDataModel::LNGPOSITION);
latlng.SetLng(index.data(Qt::DisplayRole).toDouble());
index=model->index(x,flightDataModel::DISRELATIVE);
distBearing.distance=index.data(Qt::DisplayRole).toDouble();
index=model->index(x,flightDataModel::BEARELATIVE);
distBearing.setBearingFromDegrees(index.data(Qt::DisplayRole).toDouble());
index=model->index(x,flightDataModel::ISRELATIVE);
relative=index.data(Qt::DisplayRole).toBool();
index=model->index(x,flightDataModel::ALTITUDE);
altitude=index.data(Qt::DisplayRole).toDouble();
item=myMap->WPInsert(latlng,altitude,desc,x);
item->setRelativeCoord(distBearing);
if(relative)
item->setWPType(mapcontrol::WayPointItem::relative);
}
refreshOverlays();
}
void modelMapProxy::deleteWayPoint(int number)
{
model->removeRow(number,QModelIndex());
}
void modelMapProxy::createWayPoint(internals::PointLatLng coord)
{
model->insertRow(model->rowCount(),QModelIndex());
QModelIndex index=model->index(model->rowCount()-1,flightDataModel::LATPOSITION,QModelIndex());
model->setData(index,coord.Lat(),Qt::EditRole);
index=model->index(model->rowCount()-1,flightDataModel::LNGPOSITION,QModelIndex());
model->setData(index,coord.Lng(),Qt::EditRole);
}
void modelMapProxy::deleteAll()
{
model->removeRows(0,model->rowCount(),QModelIndex());
}
Reference in New Issue View Git Blame Copy Permalink