Woriking order system

Working for forward and turning (C01 C03(!))