39 lines
414 B
Python
39 lines
414 B
Python
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():
|
|
... |