You can not select more than 25 topics
Topics must start with a letter or number, can include dashes ('-') and can be up to 35 characters long.
51 lines
1.0 KiB
51 lines
1.0 KiB
4 years ago
|
#pragma once
|
||
|
|
|
||
|
|
#include <QThread>
|
||
|
|
#include <QGeoCoordinate>
|
||
|
|
#include <QGeoManeuver>
|
||
|
|
#include <QGeoRouteRequest>
|
||
|
|
#include <QGeoRouteSegment>
|
||
|
|
#include <QGeoRoutingManager>
|
||
|
|
#include <QGeoServiceProvider>
|
||
|
|
#include <QTimer>
|
||
|
|
#include <QMapboxGL>
|
||
|
|
|
||
|
|
#include "cereal/messaging/messaging.h"
|
||
|
|
|
||
|
|
class RouteEngine : public QObject {
|
||
|
|
Q_OBJECT
|
||
|
|
|
||
|
|
public:
|
||
|
|
RouteEngine();
|
||
|
|
|
||
|
|
SubMaster *sm;
|
||
|
|
PubMaster *pm;
|
||
|
|
|
||
|
|
QTimer* timer;
|
||
|
|
|
||
|
|
// Route
|
||
|
|
bool gps_ok = false;
|
||
|
|
QGeoServiceProvider *geoservice_provider;
|
||
|
|
QGeoRoutingManager *routing_manager;
|
||
|
|
QGeoRoute route;
|
||
|
|
QGeoRouteSegment segment;
|
||
|
|
QMapbox::Coordinate nav_destination;
|
||
|
|
|
||
|
|
// Position
|
||
|
|
std::optional<QMapbox::Coordinate> last_position;
|
||
|
|
std::optional<float> last_bearing;
|
||
|
|
bool localizer_valid = false;
|
||
|
|
|
||
|
|
// Route recompute
|
||
|
|
int recompute_backoff = 0;
|
||
|
|
int recompute_countdown = 0;
|
||
|
|
void calculateRoute(QMapbox::Coordinate destination);
|
||
|
|
void clearRoute();
|
||
|
|
bool shouldRecompute();
|
||
|
|
|
||
|
|
private slots:
|
||
|
|
void timerUpdate();
|
||
|
|
void routeCalculated(QGeoRouteReply *reply);
|
||
|
|
void recomputeRoute();
|
||
|
|
};
|