Thanks to @BluKay for the origional angle script. All I did was add my physics engine to it to see how fast it ran, and it seems to run pretty fast! Fixing some detection bugs for getting stuck in walls...
