-Increased speeds parallel to and perpendicular to the path
-Fixed error that was causing the speed reduction for turns to be applied incorrectly
-Fixed test yaw left and test yaw right outputs
-Changed test circle to output directly to the plan as a way of testing the path-following algorithm
-Increased speeds parallel to and perpendicular to the path -Fixed error that was causing the speed reduction for turns to be applied incorrectly -Fixed test yaw left and test yaw right outputs -Changed test circle to output directly to the plan as a way of testing the path-following algorithm