 #endif
 
 /* PIN Defines */
-#define AUX_LIGHT_LEFT_POWER_CONTROL_PIN 7
-#define AUX_LIGHT_LEFT_PWM_PIN 5
-#define AUX_LIGHT_RIGHT_POWER_CONTROL_PIN 8
-#define AUX_LIGHT_RIGHT_PWM_PIN 6
+#define AUX_LIGHT_1_POWER_CONTROL_PIN 7
+#define AUX_LIGHT_1_PWM_PIN 5
+#define AUX_LIGHT_2_POWER_CONTROL_PIN 4
+#define AUX_LIGHT_2_PWM_PIN 6
 
 #define AUX_LIGHT_PWM_BRIGHTNESS_OFF  0
-#define AUX_LIGHT_PWM_BRIGHTNESS_LOW  170 // TODO: Determine the correct value here, 191 ~ 75% to reach the 8v number
+#define AUX_LIGHT_PWM_BRIGHTNESS_LOW  170 // TODO: Determine the correct value here to achieve 8v
 #define AUX_LIGHT_PWM_BRIGHTNESS_HIGH 255
 
 /* Globals */


void set_aux_light_state_high()
{
  digitalWrite(AUX_LIGHT_LEFT_POWER_CONTROL_PIN, HIGH);
  digitalWrite(AUX_LIGHT_RIGHT_POWER_CONTROL_PIN, HIGH);  
  analogWrite(AUX_LIGHT_LEFT_PWM_PIN, AUX_LIGHT_PWM_BRIGHTNESS_HIGH);
  analogWrite(AUX_LIGHT_RIGHT_PWM_PIN, AUX_LIGHT_PWM_BRIGHTNESS_HIGH);
}

void set_aux_light_state_low()
{
  digitalWrite(AUX_LIGHT_LEFT_POWER_CONTROL_PIN, HIGH);
  digitalWrite(AUX_LIGHT_RIGHT_POWER_CONTROL_PIN, HIGH);  
  analogWrite(AUX_LIGHT_LEFT_PWM_PIN, AUX_LIGHT_PWM_BRIGHTNESS_LOW);
  analogWrite(AUX_LIGHT_RIGHT_PWM_PIN, AUX_LIGHT_PWM_BRIGHTNESS_LOW);
}


void set_aux_light_state_off()
{
  digitalWrite(AUX_LIGHT_LEFT_POWER_CONTROL_PIN, LOW);
  digitalWrite(AUX_LIGHT_RIGHT_POWER_CONTROL_PIN, LOW);  
  analogWrite(AUX_LIGHT_LEFT_PWM_PIN, AUX_LIGHT_PWM_BRIGHTNESS_OFF);
  analogWrite(AUX_LIGHT_RIGHT_PWM_PIN, AUX_LIGHT_PWM_BRIGHTNESS_OFF);
}

/*

void init_aux_light_controller()
{
  // Set control pins to outputs
  pinMode(AUX_LIGHT_1_POWER_CONTROL_PIN, OUTPUT);
  pinMode(AUX_LIGHT_1_PWM_PIN, OUTPUT);
  pinMode(AUX_LIGHT_2_POWER_CONTROL_PIN, OUTPUT);
  pinMode(AUX_LIGHT_2_PWM_PIN, OUTPUT);  

  // Initially set them to off
  set_aux_light_state_off();
