Optimized physics functions

What was I on when I did this part? Whatever it was, I want more. Anyway, got rid of dist. We round to float now. Not sure if it's better to use pow() or just multiply numbers together. Benchmarking time. Oh yea, link display code works fine now.