call reset in encoders setup()

ros-mobile-robots · Apr 30, 2021 · afe7fbd · afe7fbd
1 parent f4646a8
commit afe7fbd
Showing 1 changed file with 4 additions and 1 deletion.
diff --git a/diffbot_base/scripts/encoders/encoders/encoders.ino b/diffbot_base/scripts/encoders/encoders/encoders.ino
@@ -28,7 +28,8 @@ Encoder encoderRight(7, 8); // Default pins 7, 8
 ros::NodeHandle  nh;
 
 // ROS Subscriber setup to reset both encoders to zero
-void resetCallback( const std_msgs::Empty& reset){
+void resetCallback( const std_msgs::Empty& reset)
+{
   //digitalWrite(13, HIGH-digitalRead(13));   // blink the led
   // reset both back to zero.
   encoderLeft.write(0);
@@ -54,6 +55,8 @@ void setup()
     nh.spinOnce();
   }
   nh.loginfo("Initialize DiffBot Wheel Encoders");
+  std_msgs::Empty reset;
+  resetCallback(reset);
   delay(1);
 }