Made some nice path generation code and plots to compare the calculated generalized speeds and velocities. Also reworked the rhs function to avoid the global state. The quinitic path is still better, which I think has to do with the smooth velocity profile I have for it.