This is the code that was working friday the 18th. PID-control should work here with the parameters Kp = 5, Ti = 100, Td = 1
Merge branch 'master' of https://github.com/Soddi/examinationsprojekt