The motion control is very simple. Adding an incremental position to the position set point on a periodic basis essentially sets the velocity. In the following code I broke out the "AddToPosition" so that Dilbert s wall following and line following c