Got all angles working. Now we just need to calculate forward distances every loop.