Verbetering SoC + test

OPMERKING: Om geen afrondingsfouten te hebben moet de meting om de 5s gebeuren,
wat een slechte nauwkeurigheid oplevert. Meting om 500ms geeft 0.