Print tool position
Some code for moving between two points
Add interpolated movement
Move list of given points