motion control algorithms