PM: EM: Create a new function em_compute_costs()

Create a dedicated function which will be easier to maintain and re-use
in future. The upcoming changes for the new EM feature would use it.

Signed-off-by: Lukasz Luba <lukasz.luba@arm.com>