BspSchedule, cost function revision #181

Job	Run time
Build (Release)	1m 57s
Build (Debug)	2m 49s
Build & Test (RelWithDebInfo-noEigen)	5m 11s
Build, Test & Coverage (RelWithDebInfo + Eigen)	6m 15s
	16m 12s

Provide feedback