First iteration of line movement, the robots does not move.. need to check what is going on with the transformation matrix