collision testing environment, sort of working but get stuck on corners and walk through walls at times