plan_route_plugin.h
Go to the documentation of this file.
1 // *****************************************************************************
2 //
3 // Copyright (c) 2014, Southwest Research Institute® (SwRI®)
4 // All rights reserved.
5 //
6 // Redistribution and use in source and binary forms, with or without
7 // modification, are permitted provided that the following conditions are met:
8 // * Redistributions of source code must retain the above copyright
9 // notice, this list of conditions and the following disclaimer.
10 // * Redistributions in binary form must reproduce the above copyright
11 // notice, this list of conditions and the following disclaimer in the
12 // documentation and/or other materials provided with the distribution.
13 // * Neither the name of Southwest Research Institute® (SwRI®) nor the
14 // names of its contributors may be used to endorse or promote products
15 // derived from this software without specific prior written permission.
16 //
17 // THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS"
18 // AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
19 // IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
20 // ARE DISCLAIMED. IN NO EVENT SHALL <COPYRIGHT HOLDER> BE LIABLE FOR ANY
21 // DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES
22 // (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES;
23 // LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND
24 // ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
25 // (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS
26 // SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
27 //
28 // *****************************************************************************
29 
30 #ifndef MAPVIZ_PLUGINS_PLAN_ROUTE_PLUGIN_H_
31 #define MAPVIZ_PLUGINS_PLAN_ROUTE_PLUGIN_H_
32 
33 // C++ standard libraries
34 #include <string>
35 #include <vector>
36 
37 #include <mapviz/mapviz_plugin.h>
38 
39 // QT libraries
40 #include <QGLWidget>
41 #include <QObject>
42 #include <QWidget>
43 
44 // ROS libraries
45 #include <ros/ros.h>
46 #include <tf/transform_datatypes.h>
47 
48 // Mapviz libraries
49 #include <mapviz/map_canvas.h>
50 #include <swri_route_util/route.h>
51 
52 // Messages
53 #include <geometry_msgs/Pose.h>
54 #include <marti_nav_msgs/Route.h>
55 
56 // QT autogenerated files
57 #include "ui_plan_route_config.h"
58 
59 namespace mapviz_plugins
60 {
62  {
63  Q_OBJECT
64 
65  public:
66 
68  virtual ~PlanRoutePlugin();
69 
70  bool Initialize(QGLWidget* canvas);
71  void Shutdown()
72  {
73  }
74 
75  void Draw(double x, double y, double scale);
76  void Paint(QPainter* painter, double x, double y, double scale);
77 
78  void Transform() {};
79 
80  void LoadConfig(const YAML::Node& node, const std::string& path);
81  void SaveConfig(YAML::Emitter& emitter, const std::string& path);
82 
83  QWidget* GetConfigWidget(QWidget* parent);
84 
86  {
87  return true;
88  }
89 
90  protected:
91  void PrintError(const std::string& message);
92  void PrintInfo(const std::string& message);
93  void PrintWarning(const std::string& message);
94  bool eventFilter(QObject *object, QEvent* event);
95  bool handleMousePress(QMouseEvent *);
96  bool handleMouseRelease(QMouseEvent *);
97  bool handleMouseMove(QMouseEvent *);
98 
99  protected Q_SLOTS:
100  void PublishRoute();
101  void PlanRoute();
102  void Clear();
103 
104  private:
105  void Retry(const ros::TimerEvent& e);
106 
107  Ui::plan_route_config ui_;
108  QWidget* config_widget_;
110 
111  std::string route_topic_;
112 
115 
118 
119  std::vector<geometry_msgs::Pose> waypoints_;
120 
125 
126  qint64 max_ms_;
128  };
129 }
130 
131 #endif // MAPVIZ_PLUGINS_PLAN_ROUTE_PLUGIN_H_
void Retry(const ros::TimerEvent &e)
std::vector< geometry_msgs::Pose > waypoints_
void SaveConfig(YAML::Emitter &emitter, const std::string &path)
void Paint(QPainter *painter, double x, double y, double scale)
swri_route_util::RoutePtr route_preview_
TFSIMD_FORCE_INLINE const tfScalar & y() const
void LoadConfig(const YAML::Node &node, const std::string &path)
void PrintError(const std::string &message)
void PrintInfo(const std::string &message)
void Draw(double x, double y, double scale)
bool eventFilter(QObject *object, QEvent *event)
TFSIMD_FORCE_INLINE const tfScalar & x() const
bool Initialize(QGLWidget *canvas)
void PrintWarning(const std::string &message)
QWidget * GetConfigWidget(QWidget *parent)


mapviz_plugins
Author(s): Marc Alban
autogenerated on Thu Jun 6 2019 19:25:16