Obstacle avoidance with an UGV -HELP PLEASE-

It isn't really a set made course, most likely going to be a local park (with trees) and another test using this algorithm specifically would be inside my high school hallways

These are two very different requirements. If the ultimate goal is the park and the distances are large enough, gps and the compass can play a major part. The moment you go indoors though for testing, all that's changed. Can you test outside instead at your school? You can of course do both - use the gps if it's getting signal and revert to dead reckoning if not, but then you've made everything significantly harder.