increased min wp speed to 20cm/s
Speed control revisions

Added slowdown to corner WPs