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)