Fast and Slow Operations

[deltacoder1020]

also, most square root algorithms tend to be fairly slow. one thing you could try is having the robot generate a lookup table (basically an array) of the sines/cosines/tangents for each angle 0-180, and then accessing that when you need it - that way you can run the slow calculations once at startup, and use direct memory-access to get the values at runtime.