MapWidget.cc 26 KB
Newer Older
1
/*==================================================================
pixhawk's avatar
pixhawk committed
2 3 4 5
======================================================================*/

/**
 * @file
lm's avatar
lm committed
6
 *   @brief Implementation of MapWidget
pixhawk's avatar
pixhawk committed
7 8
 *
 *   @author Lorenz Meier <mavteam@student.ethz.ch>
lm's avatar
lm committed
9
 *   @author Mariano Lizarraga
pixhawk's avatar
pixhawk committed
10 11 12
 *
 */

lm's avatar
lm committed
13 14
#include <QComboBox>
#include <QGridLayout>
15
#include <QDir>
16

17
#include "QGC.h"
pixhawk's avatar
pixhawk committed
18 19
#include "MapWidget.h"
#include "ui_MapWidget.h"
lm's avatar
lm committed
20 21
#include "UASInterface.h"
#include "UASManager.h"
22 23
#include "MAV2DIcon.h"
#include "Waypoint2DIcon.h"
pixhawk's avatar
pixhawk committed
24

pixhawk's avatar
pixhawk committed
25 26
#include "MG.h"

27

pixhawk's avatar
pixhawk committed
28 29 30
MapWidget::MapWidget(QWidget *parent) :
        QWidget(parent),
        zoomLevel(0),
31 32
        uasIcons(),
        uasTrails(),
33
        mav(NULL),
34
        lastUpdate(0),
pixhawk's avatar
pixhawk committed
35 36 37
        m_ui(new Ui::MapWidget)
{
    m_ui->setupUi(this);
38 39 40 41 42 43 44 45 46 47 48 49 50
    mc = new qmapcontrol::MapControl(QSize(320, 240));

    //   VISUAL MAP STYLE
    QString buttonStyle("QAbstractButton { background-color: rgba(20, 20, 20, 45%); border-color: rgba(10, 10, 10, 50%)}");
    mc->setPen(QGC::colorCyan.darker(400));








pixhawk's avatar
pixhawk committed
51

52
    waypointIsDrag = false;
pixhawk's avatar
pixhawk committed
53

pixhawk's avatar
pixhawk committed
54 55
    // Accept focus by clicking or keyboard
    this->setFocusPolicy(Qt::StrongFocus);
pixhawk's avatar
pixhawk committed
56

pixhawk's avatar
pixhawk committed
57
    // create MapControl
58

pixhawk's avatar
pixhawk committed
59
    mc->showScale(true);
60
    mc->showCoord(true);
61
    mc->enablePersistentCache();
62
    mc->setMouseTracking(true); // required to update the mouse position for diplay and capture
pixhawk's avatar
pixhawk committed
63

pixhawk's avatar
pixhawk committed
64
    // create MapAdapter to get maps from
lm's avatar
lm committed
65
    //TileMapAdapter* osmAdapter = new TileMapAdapter("tile.openstreetmap.org", "/%1/%2/%3.png", 256, 0, 17);
pixhawk's avatar
pixhawk committed
66

67
    qmapcontrol::MapAdapter* mapadapter_overlay = new qmapcontrol::YahooMapAdapter("us.maps3.yimg.com", "/aerial.maps.yimg.com/png?v=2.2&t=h&s=256&x=%2&y=%3&z=%1");
pixhawk's avatar
pixhawk committed
68

lm's avatar
lm committed
69
    // MAP BACKGROUND
70 71
    mapadapter = new qmapcontrol::GoogleSatMapAdapter();
    l = new qmapcontrol::MapLayer("Google Satellite", mapadapter);
lm's avatar
lm committed
72
    mc->addLayer(l);
pixhawk's avatar
pixhawk committed
73

lm's avatar
lm committed
74
    // STREET OVERLAY
75
    overlay = new qmapcontrol::MapLayer("Overlay", mapadapter_overlay);
lm's avatar
lm committed
76 77
    overlay->setVisible(false);
    mc->addLayer(overlay);
pixhawk's avatar
pixhawk committed
78

79 80 81 82
    // MAV FLIGHT TRACKS
    tracks = new qmapcontrol::MapLayer("Tracking", mapadapter);
    mc->addLayer(tracks);

lm's avatar
lm committed
83 84
    // WAYPOINT LAYER
    // create a layer with the mapadapter and type GeometryLayer (for waypoints)
85
    geomLayer = new qmapcontrol::GeometryLayer("Waypoints", mapadapter);
86
    mc->addLayer(geomLayer);
pixhawk's avatar
pixhawk committed
87 88 89



90 91 92
    //
    //    Layer* gsatLayer = new Layer("Google Satellite", gsat, Layer::MapLayer);
    //    mc->addLayer(gsatLayer);
pixhawk's avatar
pixhawk committed
93

lm's avatar
lm committed
94 95 96 97
    // SET INITIAL POSITION AND ZOOM
    // Set default zoom level
    mc->setZoom(16);
    // Zurich, ETH
98
    mc->setView(QPointF(8.548056,47.376389));
pixhawk's avatar
pixhawk committed
99

100 101
    // Veracruz Mexico
    //mc->setView(QPointF(-96.105208,19.138955));
pixhawk's avatar
pixhawk committed
102

lm's avatar
lm committed
103 104 105
    // Add controls to select map provider
    /////////////////////////////////////////////////
    QActionGroup* mapproviderGroup = new QActionGroup(this);
106 107 108 109 110
    osmAction = new QAction(QIcon(":/images/mapproviders/openstreetmap.png"), tr("OpenStreetMap"), mapproviderGroup);
    yahooActionMap = new QAction(QIcon(":/images/mapproviders/yahoo.png"), tr("Yahoo: Map"), mapproviderGroup);
    yahooActionSatellite = new QAction(QIcon(":/images/mapproviders/yahoo.png"), tr("Yahoo: Satellite"), mapproviderGroup);
    googleActionMap = new QAction(QIcon(":/images/mapproviders/google.png"), tr("Google: Map"), mapproviderGroup);
    googleSatAction = new QAction(QIcon(":/images/mapproviders/google.png"), tr("Google: Sat"), mapproviderGroup);
lm's avatar
lm committed
111 112 113 114 115 116 117 118
    osmAction->setCheckable(true);
    yahooActionMap->setCheckable(true);
    yahooActionSatellite->setCheckable(true);
    googleActionMap->setCheckable(true);
    googleSatAction->setCheckable(true);
    googleSatAction->setChecked(true);
    connect(mapproviderGroup, SIGNAL(triggered(QAction*)),
            this, SLOT(mapproviderSelected(QAction*)));
pixhawk's avatar
pixhawk committed
119

lm's avatar
lm committed
120
    // Overlay seems currently broken
121 122 123 124 125
    //    yahooActionOverlay = new QAction(tr("Yahoo: street overlay"), this);
    //    yahooActionOverlay->setCheckable(true);
    //    yahooActionOverlay->setChecked(overlay->isVisible());
    //    connect(yahooActionOverlay, SIGNAL(toggled(bool)),
    //            overlay, SLOT(setVisible(bool)));
pixhawk's avatar
pixhawk committed
126

127 128 129 130 131 132
    //    mapproviderGroup->addAction(googleSatAction);
    //    mapproviderGroup->addAction(osmAction);
    //    mapproviderGroup->addAction(yahooActionOverlay);
    //    mapproviderGroup->addAction(googleActionMap);
    //    mapproviderGroup->addAction(yahooActionMap);
    //    mapproviderGroup->addAction(yahooActionSatellite);
pixhawk's avatar
pixhawk committed
133

lm's avatar
lm committed
134 135 136 137
    // Create map provider selection menu
    mapMenu = new QMenu(this);
    mapMenu->addActions(mapproviderGroup->actions());
    mapMenu->addSeparator();
138
    //    mapMenu->addAction(yahooActionOverlay);
pixhawk's avatar
pixhawk committed
139

lm's avatar
lm committed
140 141 142
    mapButton = new QPushButton(this);
    mapButton->setText("Map Source");
    mapButton->setMenu(mapMenu);
143
    mapButton->setStyleSheet(buttonStyle);
pixhawk's avatar
pixhawk committed
144

pixhawk's avatar
pixhawk committed
145
    // display the MapControl in the application
lm's avatar
lm committed
146
    QGridLayout* layout = new QGridLayout(this);
pixhawk's avatar
pixhawk committed
147
    layout->setMargin(0);
148 149
    layout->setSpacing(0);
    layout->addWidget(mc, 0, 0);
pixhawk's avatar
pixhawk committed
150
    setLayout(layout);
pixhawk's avatar
pixhawk committed
151

152
    // create buttons to control the map (zoom, GPS tracking and WP capture)
pixhawk's avatar
pixhawk committed
153
    QPushButton* zoomin = new QPushButton(QIcon(":/images/actions/list-add.svg"), "", this);
154
    zoomin->setStyleSheet(buttonStyle);
pixhawk's avatar
pixhawk committed
155
    QPushButton* zoomout = new QPushButton(QIcon(":/images/actions/list-remove.svg"), "", this);
156
    zoomout->setStyleSheet(buttonStyle);
157
    createPath = new QPushButton(QIcon(":/images/actions/go-bottom.svg"), "", this);
158
    createPath->setStyleSheet(buttonStyle);
159
    clearTracking = new QPushButton(QIcon(""), "", this);
160
    clearTracking->setStyleSheet(buttonStyle);
pixhawk's avatar
pixhawk committed
161
    followgps = new QPushButton(QIcon(":/images/actions/system-lock-screen.svg"), "", this);
162 163 164
    followgps->setStyleSheet(buttonStyle);
    QPushButton* goToButton = new QPushButton(QIcon(""), "T", this);
    goToButton->setStyleSheet(buttonStyle);
pixhawk's avatar
pixhawk committed
165

166 167 168 169 170
    zoomin->setMaximumWidth(30);
    zoomout->setMaximumWidth(30);
    createPath->setMaximumWidth(30);
    clearTracking->setMaximumWidth(30);
    followgps->setMaximumWidth(30);
171
    goToButton->setMaximumWidth(30);
pixhawk's avatar
pixhawk committed
172

173 174 175 176 177
    // Set checkable buttons
    // TODO: Currently checked buttons are are very difficult to distinguish when checked.
    //       create a style and the slots to change the background so it is easier to distinguish
    followgps->setCheckable(true);
    createPath->setCheckable(true);
pixhawk's avatar
pixhawk committed
178

179
    // add buttons to control the map (zoom, GPS tracking and WP capture)
lm's avatar
lm committed
180
    QGridLayout* innerlayout = new QGridLayout(mc);
181 182
    innerlayout->setMargin(3);
    innerlayout->setSpacing(3);
lm's avatar
lm committed
183 184 185 186
    innerlayout->addWidget(zoomin, 0, 0);
    innerlayout->addWidget(zoomout, 1, 0);
    innerlayout->addWidget(followgps, 2, 0);
    innerlayout->addWidget(createPath, 3, 0);
187
    innerlayout->addWidget(clearTracking, 4, 0);
lm's avatar
lm committed
188
    // Add spacers to compress buttons on the top left
189
    innerlayout->addItem(new QSpacerItem(0, 0, QSizePolicy::Expanding, QSizePolicy::Expanding), 5, 0);
190 191 192
    innerlayout->addItem(new QSpacerItem(0, 0, QSizePolicy::Expanding, QSizePolicy::Expanding), 0, 1, 0, 7);
    innerlayout->addWidget(mapButton, 0, 6);
    innerlayout->addWidget(goToButton, 0, 7);
lm's avatar
lm committed
193 194
    innerlayout->setRowStretch(0, 1);
    innerlayout->setRowStretch(1, 100);
pixhawk's avatar
pixhawk committed
195
    mc->setLayout(innerlayout);
pixhawk's avatar
pixhawk committed
196 197


198
    // Connect the required signals-slots
199 200
    connect(zoomin, SIGNAL(clicked(bool)),
            mc, SLOT(zoomIn()));
pixhawk's avatar
pixhawk committed
201

202 203
    connect(zoomout, SIGNAL(clicked(bool)),
            mc, SLOT(zoomOut()));
pixhawk's avatar
pixhawk committed
204

205 206
    connect(goToButton, SIGNAL(clicked()), this, SLOT(goTo()));

pixhawk's avatar
pixhawk committed
207 208 209 210 211 212
    QList<UASInterface*> systems = UASManager::instance()->getUASList();
    foreach(UASInterface* system, systems)
    {
        addUAS(system);
    }

213 214
    connect(UASManager::instance(), SIGNAL(UASCreated(UASInterface*)),
            this, SLOT(addUAS(UASInterface*)));
pixhawk's avatar
pixhawk committed
215 216

    activeUASSet(UASManager::instance()->getActiveUAS());
217
    connect(UASManager::instance(), SIGNAL(activeUASSet(UASInterface*)), this, SLOT(activeUASSet(UASInterface*)));
pixhawk's avatar
pixhawk committed
218

219 220
    connect(mc, SIGNAL(mouseEventCoordinate(const QMouseEvent*, const QPointF)),
            this, SLOT(captureMapClick(const QMouseEvent*, const QPointF)));
pixhawk's avatar
pixhawk committed
221

222
    connect(createPath, SIGNAL(clicked(bool)),
223
            this, SLOT(createPathButtonClicked(bool)));
pixhawk's avatar
pixhawk committed
224 225


226 227
    connect(geomLayer, SIGNAL(geometryClicked(Geometry*,QPoint)),
            this, SLOT(captureGeometryClick(Geometry*, QPoint)));
pixhawk's avatar
pixhawk committed
228

229 230
    connect(geomLayer, SIGNAL(geometryDragged(Geometry*, QPointF)),
            this, SLOT(captureGeometryDrag(Geometry*, QPointF)));
pixhawk's avatar
pixhawk committed
231

232 233
    connect(geomLayer, SIGNAL(geometryEndDrag(Geometry*, QPointF)),
            this, SLOT(captureGeometryEndDrag(Geometry*, QPointF)));
pixhawk's avatar
pixhawk committed
234

235 236 237
    // Configure the WP Path's pen
    pointPen = new QPen(QColor(0, 255,0));
    pointPen->setWidth(3);
238 239
    waypointPath = new qmapcontrol::LineString (wps, "Waypoint path", pointPen);
    mc->layer("Waypoints")->addGeometry(waypointPath);
pixhawk's avatar
pixhawk committed
240

241 242 243 244 245
    //Camera Control
    // CAMERA INDICATOR LAYER
    // create a layer with the mapadapter and type GeometryLayer (for camera indicator)
    camLayer = new qmapcontrol::GeometryLayer("Camera", mapadapter);
    mc->addLayer(camLayer);
pixhawk's avatar
pixhawk committed
246

247
    //camLine = new qmapcontrol::LineString(camPoints,"Camera Eje", camBorderPen);
pixhawk's avatar
pixhawk committed
248

249 250
    drawCamBorder = false;
    radioCamera = 10;
lm's avatar
lm committed
251 252
}

253 254 255 256 257 258 259 260 261 262 263 264 265 266 267 268 269 270 271 272 273 274 275 276 277
void MapWidget::goTo()
{
    bool ok;
         QString text = QInputDialog::getText(this, tr("Please enter coordinates"),
                                              tr("Coordinates (Lat,Lon):"), QLineEdit::Normal,
                                              QString("%1,%2").arg(mc->currentCoordinate().x()).arg(mc->currentCoordinate().y()), &ok);
         if (ok && !text.isEmpty())
         {
             QStringList split = text.split(",");
             if (split.length() == 2)
             {
                 bool convert;
                 double latitude = split.first().toDouble(&convert);
                 ok &= convert;
                 double longitude = split.last().toDouble(&convert);
                 ok &= convert;

                 if (ok)
                 {
                     mc->setView(QPointF(latitude, longitude));
                 }
             }
         }
}

278

lm's avatar
lm committed
279 280 281 282 283 284 285 286
void MapWidget::mapproviderSelected(QAction* action)
{
    //delete mapadapter;
    mapButton->setText(action->text());
    if (action == osmAction)
    {
        int zoom = mapadapter->adaptedZoom();
        mc->setZoom(0);
pixhawk's avatar
pixhawk committed
287

288
        mapadapter = new qmapcontrol::OSMMapAdapter();
lm's avatar
lm committed
289 290
        l->setMapAdapter(mapadapter);
        geomLayer->setMapAdapter(mapadapter);
pixhawk's avatar
pixhawk committed
291

lm's avatar
lm committed
292 293
        mc->updateRequestNew();
        mc->setZoom(zoom);
294
        //        yahooActionOverlay->setEnabled(false);
lm's avatar
lm committed
295
        overlay->setVisible(false);
296
        //        yahooActionOverlay->setChecked(false);
pixhawk's avatar
pixhawk committed
297

lm's avatar
lm committed
298 299 300 301 302
    }
    else if (action == yahooActionMap)
    {
        int zoom = mapadapter->adaptedZoom();
        mc->setZoom(0);
pixhawk's avatar
pixhawk committed
303

304
        mapadapter = new qmapcontrol::YahooMapAdapter();
lm's avatar
lm committed
305 306
        l->setMapAdapter(mapadapter);
        geomLayer->setMapAdapter(mapadapter);
pixhawk's avatar
pixhawk committed
307

lm's avatar
lm committed
308 309
        mc->updateRequestNew();
        mc->setZoom(zoom);
310
        //        yahooActionOverlay->setEnabled(false);
lm's avatar
lm committed
311
        overlay->setVisible(false);
312
        //        yahooActionOverlay->setChecked(false);
lm's avatar
lm committed
313 314 315 316 317 318
    }
    else if (action == yahooActionSatellite)
    {
        int zoom = mapadapter->adaptedZoom();
        QPointF a = mc->currentCoordinate();
        mc->setZoom(0);
pixhawk's avatar
pixhawk committed
319

320
        mapadapter = new qmapcontrol::YahooMapAdapter("us.maps3.yimg.com", "/aerial.maps.yimg.com/png?v=1.7&t=a&s=256&x=%2&y=%3&z=%1");
lm's avatar
lm committed
321
        l->setMapAdapter(mapadapter);
pixhawk's avatar
pixhawk committed
322

lm's avatar
lm committed
323 324
        mc->updateRequestNew();
        mc->setZoom(zoom);
325
        //        yahooActionOverlay->setEnabled(true);
lm's avatar
lm committed
326 327 328 329 330
    }
    else if (action == googleActionMap)
    {
        int zoom = mapadapter->adaptedZoom();
        mc->setZoom(0);
331
        mapadapter = new qmapcontrol::GoogleMapAdapter();
lm's avatar
lm committed
332 333
        l->setMapAdapter(mapadapter);
        geomLayer->setMapAdapter(mapadapter);
pixhawk's avatar
pixhawk committed
334

lm's avatar
lm committed
335 336
        mc->updateRequestNew();
        mc->setZoom(zoom);
337
        //        yahooActionOverlay->setEnabled(false);
lm's avatar
lm committed
338
        overlay->setVisible(false);
339
        //        yahooActionOverlay->setChecked(false);
lm's avatar
lm committed
340 341 342 343 344
    }
    else if (action == googleSatAction)
    {
        int zoom = mapadapter->adaptedZoom();
        mc->setZoom(0);
345
        mapadapter = new qmapcontrol::GoogleSatMapAdapter();
lm's avatar
lm committed
346 347
        l->setMapAdapter(mapadapter);
        geomLayer->setMapAdapter(mapadapter); 
pixhawk's avatar
pixhawk committed
348

lm's avatar
lm committed
349 350
        mc->updateRequestNew();
        mc->setZoom(zoom);
351
        //        yahooActionOverlay->setEnabled(false);
lm's avatar
lm committed
352
        overlay->setVisible(false);
353
        //        yahooActionOverlay->setChecked(false);
lm's avatar
lm committed
354 355 356 357 358
    }
    else
    {
        mapButton->setText("Select..");
    }
359
}
lm's avatar
lm committed
360

lm's avatar
lm committed
361

362
void MapWidget::createPathButtonClicked(bool checked)
lm's avatar
lm committed
363
{
364
    Q_UNUSED(checked);
pixhawk's avatar
pixhawk committed
365

lm's avatar
lm committed
366 367 368 369
    if (createPath->isChecked())
    {
        // change the cursor shape
        this->setCursor(Qt::PointingHandCursor);
370
        mc->setMouseMode(qmapcontrol::MapControl::None);
pixhawk's avatar
pixhawk committed
371 372


373
        // emit signal start to create a Waypoint global
374
        emit createGlobalWP(true, mc->currentCoordinate());
pixhawk's avatar
pixhawk committed
375

376 377 378 379 380 381 382
        //        // Clear the previous WP track
        //        // TODO: Move this to an actual clear track button and add a warning dialog
        //        mc->layer("Waypoints")->clearGeometries();
        //        wps.clear();
        //        path->setPoints(wps);
        //        mc->layer("Waypoints")->addGeometry(path);
        //        wpIndex.clear();
383 384 385
    }
    else
    {
pixhawk's avatar
pixhawk committed
386

lm's avatar
lm committed
387
        this->setCursor(Qt::ArrowCursor);
388
        mc->setMouseMode(qmapcontrol::MapControl::Panning);
lm's avatar
lm committed
389
    }
pixhawk's avatar
pixhawk committed
390

391
}
392

393 394 395 396 397 398 399
/**
 * Captures a click on the map and if in create WP path mode, it adds the WP on MouseButtonRelease
 *
 * @param event The mouse event
 * @param coordinate The coordinate in which it occured the mouse event
 * @note  This slot is connected to the mouseEventCoordinate of the QMapControl object
 */
400

401 402
void MapWidget::captureMapClick(const QMouseEvent* event, const QPointF coordinate)
{
403
    //qDebug() << mc->mouseMode();
404
    if (QEvent::MouseButtonRelease == event->type() && createPath->isChecked())
405
    {
406 407
        // Create waypoint name
        QString str;
pixhawk's avatar
pixhawk committed
408

409
        str = QString("%1").arg(waypointPath->numberOfPoints());
pixhawk's avatar
pixhawk committed
410

411 412
        // create the WP and set everything in the LineString to display the path
        Waypoint2DIcon* tempCirclePoint;
pixhawk's avatar
pixhawk committed
413

414 415 416 417 418 419 420 421 422
        if (mav)
        {
            tempCirclePoint = new Waypoint2DIcon(coordinate.x(), coordinate.y(), 20, str, qmapcontrol::Point::Middle, new QPen(mav->getColor()));
        }
        else
        {
            tempCirclePoint = new Waypoint2DIcon(coordinate.x(), coordinate.y(), 20, str, qmapcontrol::Point::Middle);
        }
        mc->layer("Waypoints")->addGeometry(tempCirclePoint);
pixhawk's avatar
pixhawk committed
423

424 425
        qmapcontrol::Point* tempPoint = new qmapcontrol::Point(coordinate.x(), coordinate.y(),str);
        wps.append(tempPoint);
426
        waypointPath->addPoint(tempPoint);
pixhawk's avatar
pixhawk committed
427

428
        wpIndex.insert(str,tempPoint);
pixhawk's avatar
pixhawk committed
429

430
        // Refresh the screen
431
        mc->updateRequest(tempPoint->boundingBox().toRect());
pixhawk's avatar
pixhawk committed
432

433 434
        // emit signal mouse was clicked
        emit captureMapCoordinateClick(coordinate);
435
    }
pixhawk's avatar
pixhawk committed
436 437
}

438 439
void MapWidget::createWaypointGraphAtMap(const QPointF coordinate)
{
440 441
    if (!wpExists(coordinate))
    {
442 443
        // Create waypoint name
        QString str;
pixhawk's avatar
pixhawk committed
444 445


446
        str = QString("%1").arg(waypointPath->numberOfPoints());
pixhawk's avatar
pixhawk committed
447

448 449 450
        // create the WP and set everything in the LineString to display the path
        //CirclePoint* tempCirclePoint = new CirclePoint(coordinate.x(), coordinate.y(), 10, str);
        Waypoint2DIcon* tempCirclePoint;
pixhawk's avatar
pixhawk committed
451

452 453 454 455 456 457 458 459
        if (mav)
        {
            tempCirclePoint = new Waypoint2DIcon(coordinate.x(), coordinate.y(), 20, str, qmapcontrol::Point::Middle, new QPen(mav->getColor()));
        }
        else
        {
            tempCirclePoint = new Waypoint2DIcon(coordinate.x(), coordinate.y(), 20, str, qmapcontrol::Point::Middle);
        }
pixhawk's avatar
pixhawk committed
460 461


462
        mc->layer("Waypoints")->addGeometry(tempCirclePoint);
pixhawk's avatar
pixhawk committed
463

464 465
        Point* tempPoint = new Point(coordinate.x(), coordinate.y(),str);
        wps.append(tempPoint);
466
        waypointPath->addPoint(tempPoint);
pixhawk's avatar
pixhawk committed
467

468
        wpIndex.insert(str,tempPoint);
tecnosapiens's avatar
tecnosapiens committed
469
        qDebug()<<"Funcion createWaypointGraphAtMap WP= "<<str<<" -> x= "<<tempPoint->latitude()<<" y= "<<tempPoint->longitude();
pixhawk's avatar
pixhawk committed
470

tecnosapiens's avatar
tecnosapiens committed
471
        // Refresh the screen
472
        mc->updateRequest(tempPoint->boundingBox().toRect());
473
    }
pixhawk's avatar
pixhawk committed
474

475 476
    ////    // emit signal mouse was clicked
    //    emit captureMapCoordinateClick(coordinate);
477 478
}

479
int MapWidget::wpExists(const QPointF coordinate){
480 481 482 483 484
    for (int i = 0; i < wps.size(); i++){
        if (wps.at(i)->latitude() == coordinate.y() &&
            wps.at(i)->longitude()== coordinate.x()){
            return 1;
        }
485
    }
486
    return 0;
487 488
}

489

490 491
void MapWidget::captureGeometryClick(Geometry* geom, QPoint point)
{
492 493
    Q_UNUSED(geom);
    Q_UNUSED(point);
pixhawk's avatar
pixhawk committed
494

495
    mc->setMouseMode(qmapcontrol::MapControl::None);
pixhawk's avatar
pixhawk committed
496

497 498
}

499 500
void MapWidget::captureGeometryDrag(Geometry* geom, QPointF coordinate)
{
pixhawk's avatar
pixhawk committed
501 502


503
    waypointIsDrag = true;
pixhawk's avatar
pixhawk committed
504

505
    // Refresh the screen
506
    mc->updateRequest(geom->boundingBox().toRect());
pixhawk's avatar
pixhawk committed
507

508 509 510
    int temp = 0;
    qmapcontrol::Point* point2Find;
    point2Find = wpIndex[geom->name()];
pixhawk's avatar
pixhawk committed
511

512 513 514
    if (point2Find)
    {
        point2Find->setCoordinate(coordinate);
pixhawk's avatar
pixhawk committed
515

516 517 518 519
        point2Find = dynamic_cast <qmapcontrol::Point*> (geom);
        if (point2Find)
        {
            point2Find->setCoordinate(coordinate);
pixhawk's avatar
pixhawk committed
520

521 522 523 524 525 526
            // qDebug() << geom->name();
            temp = geom->get_myIndex();
            //qDebug() << temp;
            emit sendGeometryEndDrag(coordinate,temp);
        }
    }
pixhawk's avatar
pixhawk committed
527

528 529
}

530
void MapWidget::captureGeometryEndDrag(Geometry* geom, QPointF coordinate)
531
{
532 533 534
    Q_UNUSED(geom);
    Q_UNUSED(coordinate);
    // TODO: Investigate why when creating the waypoint path this slot is being called
pixhawk's avatar
pixhawk committed
535

536 537 538 539 540 541
    // Only change the mouse mode back to panning when not creating a WP path
    if (!createPath->isChecked())
    {
        waypointIsDrag = false;
        mc->setMouseMode(qmapcontrol::MapControl::Panning);
    }
pixhawk's avatar
pixhawk committed
542

543 544
}

pixhawk's avatar
pixhawk committed
545 546 547 548
MapWidget::~MapWidget()
{
    delete m_ui;
}
lm's avatar
lm committed
549 550 551 552 553 554
/**
 *
 * @param uas the UAS/MAV to monitor/display with the HUD
 */
void MapWidget::addUAS(UASInterface* uas)
{
555
    connect(uas, SIGNAL(globalPositionChanged(UASInterface*,double,double,double,quint64)), this, SLOT(updateGlobalPosition(UASInterface*,double,double,double,quint64)));
lm's avatar
lm committed
556 557
}

558 559 560 561 562
void MapWidget::activeUASSet(UASInterface* uas)
{
    if (uas)
    {
        mav = uas;
563 564 565 566 567
        QColor color = mav->getColor();
        color.setAlphaF(0.6);
        QPen* pen = new QPen(color);
        pen->setWidth(3.0);
        // FIXME Load waypoints of this system
568 569 570
    }
}

lm's avatar
lm committed
571 572 573 574 575 576 577 578 579
/**
 * Updates the global position of one MAV and append the last movement to the trail
 *
 * @param uas The unmanned air system
 * @param lat Latitude in WGS84 ellipsoid
 * @param lon Longitutde in WGS84 ellipsoid
 * @param alt Altitude over mean sea level
 * @param usec Timestamp of the position message in milliseconds FIXME will move to microseconds
 */
lm's avatar
lm committed
580 581 582
void MapWidget::updateGlobalPosition(UASInterface* uas, double lat, double lon, double alt, quint64 usec)
{
    Q_UNUSED(usec);
583
    Q_UNUSED(alt); // FIXME Use altitude
584 585 586 587 588 589 590 591 592 593 594 595 596 597 598 599 600 601 602 603 604 605 606 607 608 609 610 611 612 613 614 615 616 617 618 619 620 621 622 623 624 625 626 627 628 629 630 631 632

    // create a LineString
    //QList<Point*> points;
    // Points with a circle
    // A QPen can be used to customize the
    //pointpen->setWidth(3);
    //points.append(new CirclePoint(lat, lon, 10, uas->getUASName(), Point::Middle, pointpen));

    MAV2DIcon* p;

    if (!uasIcons.contains(uas->getUASID()))
    {
        // Get the UAS color
        QColor uasColor = uas->getColor();

        // Icon
        QPen* pointpen = new QPen(uasColor);
        qDebug() << uas->getUASName();
        p = new MAV2DIcon(lat, lon, 20, uas->getUASName(), qmapcontrol::Point::Middle, pointpen);
        uasIcons.insert(uas->getUASID(), p);
        tracks->addGeometry(p);

        // Line
        // A QPen also can use transparency

        QList<qmapcontrol::Point*> points;
        points.append(new qmapcontrol::Point(lat, lon, ""));
        QPen* linepen = new QPen(uasColor.darker());
        linepen->setWidth(2);

        // Create tracking line string
        qmapcontrol::LineString* ls = new qmapcontrol::LineString(points, uas->getUASName(), linepen);
        uasTrails.insert(uas->getUASID(), ls);

        // Add the LineString to the layer
        mc->layer("Tracking")->addGeometry(ls);
    }
    else
    {
        p = dynamic_cast<MAV2DIcon*>(uasIcons.value(uas->getUASID()));
        if (p)
        {
            p->setCoordinate(QPointF(lat, lon));
            p->setYaw(uas->getYaw());
        }
        // Extend trail
        uasTrails.value(uas->getUASID())->addPoint(new qmapcontrol::Point(lat, lon, ""));
    }

633 634 635 636
    mc->drawGeometries();

    //mc->updateRequest(QRect(QPoint(0, 0), QPoint(600, 600)));

637 638 639 640
    //mc->updateRequestNew();//(uasTrails.value(uas->getUASID())->boundingBox().toRect());


    // Limit the position update rate
pixhawk's avatar
pixhawk committed
641
    quint64 currTime = MG::TIME::getGroundTimeNow();
642
    if (currTime - lastUpdate > 120)
pixhawk's avatar
pixhawk committed
643 644
    {
        lastUpdate = currTime;
645 646
        // Sets the view to the interesting area
        if (followgps->isChecked())
647
        {
648
            updatePosition(0, lat, lon);
649 650 651
        }
        else
        {
652 653
            // Refresh the screen
            //mc->updateRequestNew();
654
        }
pixhawk's avatar
pixhawk committed
655 656
    }
}
pixhawk's avatar
pixhawk committed
657

lm's avatar
lm committed
658 659 660
/**
 * Center the view on this position
 */
lm's avatar
lm committed
661
void MapWidget::updatePosition(float time, double lat, double lon)
pixhawk's avatar
pixhawk committed
662
{
lm's avatar
lm committed
663
    Q_UNUSED(time);
664
    //gpsposition->setText(QString::number(time) + " / " + QString::number(lat) + " / " + QString::number(lon));
665
    if (followgps->isChecked() && isVisible())
pixhawk's avatar
pixhawk committed
666
    {
lm's avatar
lm committed
667
        mc->setView(QPointF(lat, lon));
pixhawk's avatar
pixhawk committed
668 669 670 671 672 673 674 675 676 677 678 679 680 681
    }
}

void MapWidget::wheelEvent(QWheelEvent *event)
{
    int numDegrees = event->delta() / 8;
    int numSteps = numDegrees / 15;
    // Calculate new zoom level
    int newZoom = mc->currentZoom()+numSteps;
    // Set new zoom level, level is bounded by map control
    mc->setZoom(newZoom);
    // Detail zoom level is the number of steps zoomed in further
    // after the bounding has taken effect
    detailZoom = qAbs(qMin(0, mc->currentZoom()-newZoom));
pixhawk's avatar
pixhawk committed
682

683
    // visual field of camera
684
    updateCameraPosition(20*newZoom,0,"no");
pixhawk's avatar
pixhawk committed
685

pixhawk's avatar
pixhawk committed
686 687 688 689 690 691 692 693 694 695 696 697 698 699 700 701 702 703 704 705 706 707 708 709 710 711 712 713
}

void MapWidget::keyPressEvent(QKeyEvent *event)
{
    switch (event->key()) {
    case Qt::Key_Plus:
        mc->zoomIn();
        break;
    case Qt::Key_Minus:
        mc->zoomOut();
        break;
    case Qt::Key_Left:
        mc->scrollLeft(this->width()/scrollStep);
        break;
    case Qt::Key_Right:
        mc->scrollRight(this->width()/scrollStep);
        break;
    case Qt::Key_Down:
        mc->scrollDown(this->width()/scrollStep);
        break;
    case Qt::Key_Up:
        mc->scrollUp(this->width()/scrollStep);
        break;
    default:
        QWidget::keyPressEvent(event);
    }
}

714
void MapWidget::resizeEvent(QResizeEvent* event )
pixhawk's avatar
pixhawk committed
715
{
716 717
    Q_UNUSED(event);
    mc->resize(this->size());
pixhawk's avatar
pixhawk committed
718 719
}

720 721 722 723 724 725 726 727 728 729
void MapWidget::showEvent(QShowEvent* event)
{
    Q_UNUSED(event);
}

void MapWidget::hideEvent(QHideEvent* event)
{
    Q_UNUSED(event);
}

pixhawk's avatar
pixhawk committed
730 731 732 733 734 735 736 737 738 739 740 741

void MapWidget::changeEvent(QEvent *e)
{
    QWidget::changeEvent(e);
    switch (e->type()) {
    case QEvent::LanguageChange:
        m_ui->retranslateUi(this);
        break;
    default:
        break;
    }
}
742 743

void MapWidget::clearWaypoints()
744 745
{
    // Clear the previous WP track
pixhawk's avatar
pixhawk committed
746

747 748
    mc->layer("Waypoints")->clearGeometries();
    wps.clear();
749 750
    waypointPath->setPoints(wps);
    mc->layer("Waypoints")->addGeometry(waypointPath);
751
    wpIndex.clear();
752
    mc->updateRequest(waypointPath->boundingBox().toRect());
pixhawk's avatar
pixhawk committed
753

754 755 756 757
    if(createPath->isChecked())
    {
        createPath->click();
    }
758
}
pixhawk's avatar
pixhawk committed
759

760 761 762 763 764 765 766 767 768 769 770 771
void MapWidget::clearPath()
{
    mc->layer("Tracking")->clearGeometries();
    foreach (qmapcontrol::LineString* ls, uasTrails)
    {
        QPen* linepen = ls->pen();
        delete ls;
        qmapcontrol::LineString* lsNew = new qmapcontrol::LineString(QList<qmapcontrol::Point*>(), "", linepen);
        mc->layer("Tracking")->addGeometry(lsNew);
    }
    // FIXME update this with update request only for bounding box of trails
    mc->updateRequest(QRect(0, 0, width(), height()));
772
}
773 774 775 776 777 778

void MapWidget::changeGlobalWaypointPositionBySpinBox(int index, float lat, float lon)
{
    if(!waypointIsDrag)
    {
        qDebug() <<"indice WP= "<<index <<"\n";
pixhawk's avatar
pixhawk committed
779

780 781 782
        QPointF coordinate;
        coordinate.setX(lon);
        coordinate.setY(lat);
pixhawk's avatar
pixhawk committed
783

784 785 786
        Point* point2Find;
        point2Find = wpIndex[QString::number(index)];
        point2Find->setCoordinate(coordinate);
pixhawk's avatar
pixhawk committed
787

788 789
        point2Find = dynamic_cast <Point*> (mc->layer("Waypoints")->get_Geometry(index));
        point2Find->setCoordinate(coordinate);
pixhawk's avatar
pixhawk committed
790

791
        // Refresh the screen
792
        mc->updateRequest(point2Find->boundingBox().toRect());
793
    }
pixhawk's avatar
pixhawk committed
794 795


796 797
}

798 799
void MapWidget::updateCameraPosition(double radio, double bearing, QString dir)
{
pixhawk's avatar
pixhawk committed
800
    // FIXME Mariano
801 802
    //camPoints.clear();
    QPointF currentPos = mc->currentCoordinate();
803
    //    QPointF actualPos = getPointxBearing_Range(currentPos.y(),currentPos.x(),bearing,distance);
pixhawk's avatar
pixhawk committed
804

805 806
    //    qmapcontrol::Point* tempPoint1 = new qmapcontrol::Point(currentPos.x(), currentPos.y(),"inicial",qmapcontrol::Point::Middle);
    //    qmapcontrol::Point* tempPoint2 = new qmapcontrol::Point(actualPos.x(), actualPos.y(),"final",qmapcontrol::Point::Middle);
pixhawk's avatar
pixhawk committed
807

808 809
    //    camPoints.append(tempPoint1);
    //    camPoints.append(tempPoint2);
pixhawk's avatar
pixhawk committed
810

811
    //    camLine->setPoints(camPoints);
pixhawk's avatar
pixhawk committed
812

813
    QPen* camBorderPen = new QPen(QColor(255,0,0));
814
    camBorderPen->setWidth(2);
pixhawk's avatar
pixhawk committed
815

816
    //radio = mc->currentZoom()
pixhawk's avatar
pixhawk committed
817

818 819 820 821
    if(drawCamBorder)
    {
        //clear camera borders
        mc->layer("Camera")->clearGeometries();
pixhawk's avatar
pixhawk committed
822

823 824
        //create a camera borders
        qmapcontrol::CirclePoint* camBorder = new qmapcontrol::CirclePoint(currentPos.x(), currentPos.y(), radio, "camBorder", qmapcontrol::Point::Middle, camBorderPen);
pixhawk's avatar
pixhawk committed
825

826
        //camBorder->setCoordinate(currentPos);
pixhawk's avatar
pixhawk committed
827

828
        mc->layer("Camera")->addGeometry(camBorder);
829
        // mc->layer("Camera")->addGeometry(camLine);
830
        mc->updateRequestNew();
pixhawk's avatar
pixhawk committed
831

832
    }
833 834 835 836 837
    else
    {
        //clear camera borders
        mc->layer("Camera")->clearGeometries();
        mc->updateRequestNew();
pixhawk's avatar
pixhawk committed
838

839
    }
pixhawk's avatar
pixhawk committed
840 841


842 843 844 845 846 847
}

void MapWidget::drawBorderCamAtMap(bool status)
{
    drawCamBorder = status;
    updateCameraPosition(20,0,"no");
pixhawk's avatar
pixhawk committed
848

849 850 851 852 853
}

QPointF MapWidget::getPointxBearing_Range(double lat1, double lon1, double bearing, double distance)
{
    QPointF temp;
pixhawk's avatar
pixhawk committed
854

855
    double rad = M_PI/180;
pixhawk's avatar
pixhawk committed
856

857 858 859
    bearing = bearing*rad;
    temp.setX((lon1 + ((distance/60) * (sin(bearing)))));
    temp.setY((lat1 + ((distance/60) * (cos(bearing)))));
pixhawk's avatar
pixhawk committed
860

861 862 863
    return temp;
}