First version with operational move_can functicon

The function has not been verified yet and for the first nine steps returns the same velocity every time, 0.5.