Update wave, position calc & performance

Sine wave updated to fit on screen, robot’s pos is calculated and
correctly compared with road, off screen elements are removed to boost
performance over time