apartment.cpp show start/goal states
add initialize function to cost functions