diff --git a/modules/catkin_ws/src/car/include/lanekeeping/Lanekeeping.h b/modules/catkin_ws/src/car/include/lanekeeping/Lanekeeping.h
index 9446809bd234e8f7692655aaffceea9d54ee7c20..c94ccd825eada38afff9c9a3bce7d8fc69f7a4e7 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 4b0c17dd22246714d5c8ad2bb89e73b22abf8621..63543688a278db9677c4c645e026a6a98779df4a 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 6ef021265d0ae9b2cc6b7593d348cfcbc64fc5fa..499be7173cf9149d18137b401e026406d7b77c7a 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 0d6b005d1e658a6c4f825fe17cd6504f20198a77..a38efed00c924116445fb69ebebcae385b436eff 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;