Compute velocity (not velocity squared) for freely-swimming fish

The compute_velocity function returns squared velocity.` Either the function needs to be renamed or the output changed to velocity (the second would make more sense in my opinion)