Changed velocity to be dvec3