A control system is disclosed for providing a control decision to an autonomous worksite. The control system may include a communication interface configured to collect information related to an index of the autonomous worksite. The control system may also include a storage device configured to store the collected information and a plurality of constraint models. Each constraint model may characterize the mathematical relationship between the index and at least one control variable. The control system may further include a processor coupled to the communication interface and the storage device. The processor may be configured to build an optimization model for optimizing the index, based on the plurality of constraint models and the collected information. The processor may be further configured to determine the at least one control variable associated with the autonomous worksite by solving the optimization model. The processor may also be configured to make a control decision based on the determined control variable, and provide the control decision to the autonomous worksite.