Added angle calculations and obstacle growth