BspSchedule, cost function revision #172

Job	Run time
Build (Debug)	2m 47s
Build (Release)	1m 59s
Build & Test (RelWithDebInfo-noEigen)	5m 40s
Build, Test & Coverage (RelWithDebInfo + Eigen)	6m 37s
	17m 3s

Provide feedback