def _set_headlights(self, enabled):
servo.set(self.robot, self.headlight_servo, 1 if enabled else -1)
def _set_yaw(self, yaw):
servo.set(self.robot, self.yaw_servo,
yaw / (pi/3), calibration = self.yaw_calibration)
def _set_vertical_position(self, position):
servo.set(self.robot, self.vertical_servo, position)
def _set_pitch(self, pitch):
servo.set(self.robot, self.pitch_servo,
pitch / (pi/4), calibration = self.pitch_calibration)
def _set_grabber_position(self, position):
servo.set(self.robot, self.left_servo, position)
servo.set(self.robot, self.right_servo, -position)
