Fixed bug in computing point velocity