[fix] vel calculation was wrong (only used x)