Merge branch 'memduh' into 'WS2021-clean-up'

Cleaned up controller code, edited repetitive PID-Code

See merge request !53
3 jobs for WS2021-clean-up in 9 minutes and 11 seconds (queued for 1 second)
latest