Predictive optimal control based energy management of hybrid electric vehicles