Implementera Pid

Fattar fortf inte hur PID funkar. Den slutade krasha till slut men nu
vet jag inte vad för input clienten vill ha för att skicka till GUI.