Integrated power management and aftertreatment system control for hybrid electric vehicles with road grade preview