Working point control optimization, cost on goal state