Fixed laggy velocity forward control problems

Arm would jitter if not sending commmands fast enough.
Modified controller to keep sending current velocity if a new one
hasn't arrived.