256 строчек голого C++: пишем трассировщик лучей с нуля за несколько часов

По поводу пункта 3: вынесите часть математики за цикл, думаю, чуть-чуть поможет.