UPSTREAM: PM: EM: Introduce em_compute_costs()

Move the EM costs computation code into a new dedicated function,
em_compute_costs(), that can be reused in other places in the future.

This change is not expected to alter the general functionality.

Reviewed-by: Dietmar Eggemann <dietmar.eggemann@arm.com>
Tested-by: Dietmar Eggemann <dietmar.eggemann@arm.com>
Signed-off-by: Lukasz Luba <lukasz.luba@arm.com>
Signed-off-by: Rafael J. Wysocki <rafael.j.wysocki@intel.com>

(cherry picked from commit faf7075b)
Signed-off-by: Lukasz Luba <lukasz.luba@arm.com>
Change-Id: I8aaca3587aa75ad7291c3921a612b0d2cc3641a6