Fix cmakefile, improve plotting and detection of displaced sensor.
Do not print standard deviation. Its not what the name implies and would confuse the user.