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

#include <Event.h>
#include <Timer.h>
#include <Encoder.h>
#include <PololuQik.h>
#include <SoftwareSerial.h>
#include <scr_proto/DiffCommand.h>

// Encoder stuff
#define LEFT_ENCODER_A_PIN 2

double R_EncoderAngle = 0; // In revolutions (360.0 degrees = 1.0)

// Motor Callbacks
// void MotorCallback(const scr_proto::DiffCommand& motor_com){
//   lm_cmd = motor_com.left_motor;
//   rm_cmd = motor_com.right_motor;
// }

void updateEncoderReading() {
  // Get raw ticks
