3D graph plotting, updated to show angles
2 graphs in one created, one for velocity, one for position
atan2 used for angles; problem of outlying angles solved
Added auto clear on overflow for the graphs
Documentation: READMEs updated