sim_core unit test checkpoint

Task @T18 : Added the 50 objects by 50 hz test.. performance looks
good at this point. Only the collision test remains.