Obstruction collision detection works

Output currently set to test the obstruction map