Added test and fixed simplebroadphase initialisation bug