From b88d8c733417b0fa409b225f9f73a7f999709e4f Mon Sep 17 00:00:00 2001
From: Hoop77 <p.badenhoop@gmx.de>
Date: Sun, 29 Apr 2018 21:44:04 +0200
Subject: [PATCH] -

---
 .../src/car/include/lanekeeping/Lanekeeping.h | 36 ++++++++-------
 .../src/car/include/mavLink/MavLink.h         |  4 +-
 .../src/car/src/lanekeeping/Lanekeeping.cpp   | 45 ++++++++++---------
 .../catkin_ws/src/car/src/mavLink/MavLink.cpp |  4 +-
 4 files changed, 47 insertions(+), 42 deletions(-)

diff --git a/modules/catkin_ws/src/car/include/lanekeeping/Lanekeeping.h b/modules/catkin_ws/src/car/include/lanekeeping/Lanekeeping.h
index 9446809b..c94ccd82 100644
--- a/modules/catkin_ws/src/car/include/lanekeeping/Lanekeeping.h
+++ b/modules/catkin_ws/src/car/include/lanekeeping/Lanekeeping.h
@@ -9,21 +9,25 @@
 
 namespace car
 {
-	class Lanekeeping : public nodelet::Nodelet
-	{
-		public:
-			virtual void onInit();
-			Lanekeeping(ros::NodeHandle &nh, std::string &name);
-			Lanekeeping();
-			~Lanekeeping();
-		private:
-			ros::NodeHandle nh_;
-			std::string name_;
-      
-			ros::Publisher laneData;
-      ros::Subscriber camData;
-
-      void camDataCallback(const camDataMsg::ConstPtr& inMsg);
-	};
+class Lanekeeping : public nodelet::Nodelet
+{
+public:
+    virtual void onInit();
+
+    Lanekeeping(ros::NodeHandle & nh, std::string & name);
+
+    Lanekeeping();
+
+    ~Lanekeeping();
+
+private:
+    ros::NodeHandle nh_;
+    std::string name_;
+
+    ros::Publisher laneData;
+    ros::Subscriber camData;
+
+    void camDataCallback(const camDataMsg::ConstPtr & inMsg);
+};
 }
 #endif
diff --git a/modules/catkin_ws/src/car/include/mavLink/MavLink.h b/modules/catkin_ws/src/car/include/mavLink/MavLink.h
index 4b0c17dd..63543688 100644
--- a/modules/catkin_ws/src/car/include/mavLink/MavLink.h
+++ b/modules/catkin_ws/src/car/include/mavLink/MavLink.h
@@ -42,9 +42,9 @@ private:
 
     void onStmDataReceived();
 
-    float convertSpeedToStm(float speed);
+    float convertSpeedToStm(float speed) const;
 
-    float convertSpeedFromStm(float speed);
+    float convertSpeedFromStm(float speed) const;
 
     networking::Networking net;
     veloxProtocol::Connection::Ptr veloxConnection;
diff --git a/modules/catkin_ws/src/car/src/lanekeeping/Lanekeeping.cpp b/modules/catkin_ws/src/car/src/lanekeeping/Lanekeeping.cpp
index 6ef02126..499be717 100644
--- a/modules/catkin_ws/src/car/src/lanekeeping/Lanekeeping.cpp
+++ b/modules/catkin_ws/src/car/src/lanekeeping/Lanekeeping.cpp
@@ -10,27 +10,28 @@ PLUGINLIB_EXPORT_CLASS(car::Lanekeeping, nodelet::Nodelet);
 
 namespace car
 {
-	Lanekeeping::Lanekeeping(ros::NodeHandle &nh, std::string &name) :
-    nh_(nh), 
-    name_(name)
-  { }
-  
-	Lanekeeping::Lanekeeping() {}
-  
-	Lanekeeping::~Lanekeeping() {}
-  
-	void Lanekeeping::onInit()
-	{
-		NODELET_INFO("Lanekeeping::onInit -- START");
-	  laneData = nh_.advertise<laneDataMsg>("laneData", 1);
-	  camData = nh_.subscribe("camData", 1, &Lanekeeping::camDataCallback, this);
-		NODELET_INFO("Lanekeeping::onInit -- END");
-	}
-
-  void Lanekeeping::camDataCallback(const camDataMsg::ConstPtr& inMsg)
-  {
+Lanekeeping::Lanekeeping(ros::NodeHandle & nh, std::string & name) :
+    nh_(nh), name_(name)
+{}
+
+Lanekeeping::Lanekeeping()
+{}
+
+Lanekeeping::~Lanekeeping()
+{}
+
+void Lanekeeping::onInit()
+{
+    NODELET_INFO("Lanekeeping::onInit -- START");
+    laneData = nh_.advertise<laneDataMsg>("laneData", 1);
+    camData = nh_.subscribe("camData", 1, &Lanekeeping::camDataCallback, this);
+    NODELET_INFO("Lanekeeping::onInit -- END");
+}
+
+void Lanekeeping::camDataCallback(const camDataMsg::ConstPtr & inMsg)
+{
     // std::cout << "Lanekeeping recived new cam data ( ).\n";
-  }
-  
-  
+}
+
+
 }
diff --git a/modules/catkin_ws/src/car/src/mavLink/MavLink.cpp b/modules/catkin_ws/src/car/src/mavLink/MavLink.cpp
index 0d6b005d..a38efed0 100644
--- a/modules/catkin_ws/src/car/src/mavLink/MavLink.cpp
+++ b/modules/catkin_ws/src/car/src/mavLink/MavLink.cpp
@@ -65,13 +65,13 @@ void MavLink::onStmDataReceived()
     stmData.publish(msg);
 }
 
-float MavLink::convertSpeedToStm(float speed)
+float MavLink::convertSpeedToStm(float speed) const
 {
     // TODO: convert speed!
     return speed;
 }
 
-float MavLink::convertSpeedFromStm(float speed)
+float MavLink::convertSpeedFromStm(float speed) const
 {
     // TODO: convert speed!
     return speed;
-- 
GitLab