Fully Working Simple Move

Simple move working, trapezoidal acceleration curve.