solved overlapping + refined path finding

the path should no longer overlap the object

I realized that it was drawing a path even when the space between the
obstacles is too small so I fixed that too

Still have problem with freezing up and the path sticking too close to
obstacles

needs code clean up