Implemented waiting time queue to smooth out instantaneous changes. TODO: Investigate why velocity is not setting correctly.