CNC drive control