[SOFT] plot tool: reading line safely + refactoring
[SOFT] Plotting robot distance