Organiserad om lite i electrotest

Plockade ute kod och la det i separata funktioner. Skall nog inte pilla mer nu,
risk att det blir knasigt.