Further debugging of get_worm_velocity