A method for performing autonomous operation of a vehicle is provided. The method obtains object data, by a plurality of vehicle onboard sensors; obtains road data, by one or more cameras onboard the vehicle; determines, by at least one processor, an initial vehicle trajectory, based on the object data and the road data; identifies, by the at least one processor, a set of constraints associated with the initial vehicle trajectory; determines a final vehicle trajectory, based on the potential vehicle trajectory and the set of constraints; and transmits the final vehicle trajectory to a steering mechanism onboard the vehicle.