linear velocity implemented and tested