TODO: Plot line in matlab
Calc works
Communikation to smrcl not working.
Curerntly not following the line