An autonomy system for use with a vehicle in an environment. The autonomy system comprising a processor operatively coupled with a memory device, a plurality of sensors operatively coupled with the processor; a vehicle controller, a situational awareness module, a task planning module, and a task execution module. The situational awareness module being configured to determine a state of the environment based at least in part on sensor data from at least one of the plurality of sensors. The task planning module being configured to identify, via the processor, a plurality of tasks to be performed by the vehicle and to generate a task assignment list from the plurality of tasks that is based at least in part on predetermined optimization criteria. The task execution module being configured to instruct the vehicle controller to execute the plurality of tasks in accordance with the task assignment list. The task execution module may be configured to monitor the vehicle or the vehicle controller during execution of the task assignment list to identify any errors.