Added better trig... just need to fix transform
Added visual distance calculation