Make a worm like mob that moves like a worm

I want to make a cave worm so I have two question

1. How I make the segments move more like a worm and not be just on a line? I can use detect the direction of the head, add the body parts and use NTB variables to set what piece is of what worm, using TP i can make the pieces put back one of another, but this make the worm be a line and not move dynamically.

2. How I make the worm can move on blocks free? My idea is that the worm move in the interior of the blocks and similar to a vex, when a player is on range, do a fast attack to the player