Begynt på PID

begynnt å skrive controller. Vi må finne ut hvordan ESC virker før vi
går videre