Bug fix in worm velocity. Adding more documentation to other functions.