Working baseframe gen and plotting.
Minor comment changes and moved baseframe clearing to dedicated clearing function.
Renabled xygraph plotting.
Working building base frame curvature and derivatives