import gpiozero as gp
from time import sleep


def system_test():
    ...
# todo Test niet mogelijk. Verwijderen?


def initial():
    ...


def calibrate():
    ...


def read_distance_sensor():
    ...


def read_setpoint():
    ...


def calculate_position():
    ...


def process_pid():
    ...


def calculate_new_servo_pos():
    ...


def send_data_to_servo():
    ...