The disclosed embodiments include a method, apparatus, and computer program product configured to performing automated downhole wellbore trajectory control for correcting between an actual wellbore trajectory path and a planned wellbore trajectory path. For example, in one embodiment, a PID controller is configured to obtain real-time data gathered during the drilling operation, determine whether the actual wellbore trajectory path deviates from the planned wellbore trajectory path, and automatically initiate the downhole wellbore trajectory control to change the actual wellbore trajectory path to a modified correction path that is determined using a minimum incremental wellbore energy method.