 #include <Event.h>
 #include <Timer.h>
 #include <Encoder.h>
-#include <PololuQik.h>
-#include <SoftwareSerial.h>
-#include <scr_proto/DiffCommand.h>
+//#include <PololuQik.h>
+//#include <SoftwareSerial.h>
+// #include <scr_proto/DiffCommand.h>
 
 // Encoder stuff
 #define LEFT_ENCODER_A_PIN 2

std_msgs::Float64 r_wheel_msg;

// Motors Command Message
scr_proto::DiffCommand motor_msg;

// Initialize Publishers
ros::Publisher left_encoder_pub("left_encoder", &l_enc_msg);

  nh.spinOnce();
  
  // Write Speeds to motor driver
  //pmd.setSpeeds(lm_cmd, rm_cmd);
  
  delay(10);
}
