コスト関数の計算を追加（途中）