Schaut doch gut aus.
Und ja: die Kalibrierung ist das A und O an der ganzen Geschichte, ohne die klappt nix.
Trotzdem: ich würde das Programm einfacher schreiben, glaub mir, lang genug werden die Programme später sowieso.