PID-Regler angefangen
code "review"

splitted code into multiple functions to provide better readability
some refactoring